Ready for external constraints
Working revolute constraints & example