fixed unit test in knowrob_motion_constraints