fixed some stuff

RK4 should be correct now.