Commited Sat. July 12, 2008 at 06:51:54 PM EDT
center of mass should be based on current servo positions for non-leg joints (like the arm, was being zeroed)
We'll want to use target instead of current positions for the leg joints, but need to fix IK bug first