Compass Biped class and model

On class file worked mostly on adding comments and tidying up.
Updated the equations of motion and GRFs.
On model file, wrote E-L equations of motion, transformed them to
non-dimensional, checked GRF calculations and wrote impact equations.