[torque/metapod] Fix compilation error
Add test for Torque computation with Metapod
Add test for Torque computation with Choreonoid (placeholder)
Choose between metapod and choreonoid constraint per constraint