Add FK for Right Leg
Test FK.
Add getBody() to WorldModel.
Add getTorso() to Body.
Delete RealPos from WMObject.
Edit main() to test FK.