move this function from the fix_start_state_bounds request adapter from moveit_ros