modified rk4 fixed