MPlib
MPlib copied to clipboard
Investigate Continuous Joint
Does it work and how is represented?
Yes, it does work in OMPL. The SO2 object correctly represents the joint rotation. If we were to support this in constrained planning, then it is indeed possible to have two numbers $u, v$ to represent the angle and make sure $arccos(u)=arcsin(v)$ as a secondary constraint.