Implemented integration of hdot, fixed error in acceleration equation, improved accuracy