Remove ball CoM abstraction code
implemented code to calculate dynamics information.
Finished coding ZMP calculations (not verified)
Graphics code refactored.