Fixed bad kinetic energy calc and cleaned code.
Cleaned up code and fixed kinetic energy calc.
Merge branch 'master' of https://github.com/pmhallum/gravity
Cleaned up code and fixed kinetic energy calc.