still working on RK4 implementation, works but using Oiler method