print the path constraints that fail
add get_xyz_orientation function