Started function for runge kutta 4 solver. Work in progress.