Added comments and fixed force code

Added comments and Javadoc
Fixed addForce and update so they store current force as newtons, not
the next displacement