RK4 implemented (and works..)