adding gazebo plugin
added contact force printout code
Merge branch 'master' into gazebo
prelim links model sdf, joint frame is wrong
full links model
no slip inverse dynamics model
small refactor in project layout, added function to generate robot vars given a state: Robot::gen_vars_from_model