Working on implementing Runge Kutta 4th order