arbitrary num dof joints enabled.  Walking code needs a 'reorient to upright walking mode'
locomotion planner now plans for 2 feet
updated universal joint model
ankles are unstable, joints apply excessive forces and interpenetrate floor, likely due to VIIP
changed cc files to cpp
working on getting biped to walk a few steps, adding in some balancing code