Feature/odefixes

Addresses ODE issues discussed in prev. pull request:
 - [x] Add GetJointForceTorque function and implementation for ODE
 - [x] Apply COM offsets between OpenRAVE world and ODE world to properly handle <com> tags in mass definitions