Finished implementing and testing Runge-Kutta 4 method