Stripped most of the stuff not needed for debugging, and rewrote the RK4, RK4step, and force functions.