Setting MoveIt Goal State in RViz
I am looking to programatically move the orange goal state in MoveIt, but I cannot update the displayed goal state.
I can, however, create a goal state, and plan a path to it. The goal pose in the rviz window will never change. My current code is as follows:
global group group = MoveGroupCommander("left_arm")
global end_effector_link
end_effector_link = group.get_end_effector_link()
new_pose = group.get_current_pose().pose
print(new_pose)
new_pose.position.x = new_pose.position.x + 0.1
new_pose.position.y = new_pose.position.y - 0.1
new_pose.position.z = new_pose.position.z - 0.1
print('Setting Pose Target')
group.set_pose_target(new_pose, end_effector_link)
print('Planning position Target')
group.plan()
Is it possible to achieve my desired output with Python? Or would I have better luck using C++?
Thank you!