Add option for switching dynamics on/off

[Woolfrey]

It would be good to have options to skip some of the inverse dynamics if they're not needed. This will speed up the calculations:

• [ ] Inverse dynamics in general (only compute kinematics)
• [ ] Floating base dynamics