cannot make set_pose_target work
New to moveit so I dont know where I am going wrong with this, but I am trying to make set_pose_target() work but it always shows me that no motion plan was found and aborts. set_position_target() works.
I have position_target = [X, Y, Z]
and pose_target = [X, Y, Z, qx, qy, qz]
When I do arm_group.set_position_target(position_target)
it works but when I do arm_group.set_pose_target(pose_target)
it fails to find a motion plan, no matter what input I give it. I even tried to manually go to my target in rviz, and use arm_group.get_current_pose(end_effector_link).pose
to print out the correct pose but when I put the same poses in code it fails to find a motion plan. I also tried
pose_goal = geometry_msgs.msg.Pose()
pose_goal.orientation.w = 0
pose_goal.orientation.x = 0
pose_goal.orientation.y = -0.707
pose_goal.orientation.z = 0.707
pose_goal.position.x = arr[0]
pose_goal.position.y = arr[1]
pose_goal.position.z = arr[2]
arm_group.set_pose_target(pose_goal)