Fix bug in orientation constraint construction.
Creation of position and orientation constraints return void.
Add idl interface to select path planner and path optimizer types.