Tmp commit bone length ok
Integrate choreonoid computation to positional constraint
Add output