HPP Constraints Definition of basic geometric constraints for motion planning position, orientation of a frame,