Fixed RK solver bug. Need to improve intial guess, though