forked from duISIR/chonk_pushing
-
Notifications
You must be signed in to change notification settings - Fork 0
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
add 6DOF and motion planning and orientation planning
- Loading branch information
Showing
7 changed files
with
3,639 additions
and
2 deletions.
There are no files selected for viewing
67 changes: 67 additions & 0 deletions
67
...l_pick_localsensorAD_6DOF_obstacle_wholetrajectory_withOrientation_turn_experiment.launch
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,67 @@ | ||
| <?xml version="1.0"?> | ||
|
|
||
| <launch> | ||
| <!-- set global arguments --> | ||
| <arg name="robot_name" default="chonk"/> | ||
| <param name="robot_description_wholebody" command="$(find xacro)/xacro --inorder '$(find chonk_pushing)/urdf/chonk_pushing_wholebody.urdf'"/> | ||
|
|
||
|
|
||
| <!-- Spawn position controller --> | ||
| <node | ||
| name="trajectory_controller" | ||
| pkg="controller_manager" | ||
| type="spawner" | ||
| ns="/$(arg robot_name)" | ||
| args="/$(arg robot_name)/trajectory_controller" | ||
| respawn="false" | ||
| output="screen" | ||
| /> | ||
|
|
||
| <!-- Launch a mux to send commands to the robot only from one source/controller --> | ||
| <node | ||
| name="mux_joint_position" | ||
| pkg="topic_tools" | ||
| type="mux" | ||
| ns="/$(arg robot_name)" | ||
| args="trajectory_controller/command | ||
| streaming_controller/command | ||
| DefaultPositionController/command | ||
| ActionCmdPosePositionController/command | ||
| ActionCmdConfigPositionController/command | ||
| ActionTeleop2DPositionController/command | ||
| mux:=mux_joint_position" | ||
| /> | ||
| <!-- Action Service Node for commanding end-effector poses --> | ||
| <node | ||
| name="action_server_cmd_config" | ||
| pkg="chonk_pushing" | ||
| ns="/$(arg robot_name)" | ||
| type="action_server_cmd_config_wholetrajectory.py" | ||
| output="screen" | ||
| > | ||
| <param name="cmd_topic_name" type="string" value="/$(arg robot_name)/ActionCmdConfigPositionController/command"/> | ||
| <remap from="/joint_states" to="/$(arg robot_name)/joint_states"/> | ||
| <remap from="/mux_selected" to="/$(arg robot_name)/mux_joint_position/selected"/> | ||
| </node> | ||
| <!-- Action Service Node for planning joint positions and build MPC to track the planning results --> | ||
| <node | ||
| name="action_server_cmd_pose_MPC_BC_operational_AD" | ||
| pkg="chonk_pushing" | ||
| ns="/$(arg robot_name)" | ||
| type="action_server_cmd_pose_MPC_BC_operational_pick_localsensorAD_6DOF_obstacle_wholetrajectory_withOrientation_turn_experiment.py" | ||
| output="screen" | ||
| > | ||
| <param name="link_donkey" type="string" value="link_donkey"/> | ||
| <!-- <param name="link_ee_right" type="string" value="RARM_END_EFFECTOR_finger"/> | ||
| <param name="link_ee_left" type="string" value="LARM_END_EFFECTOR_finger"/>--> | ||
| <param name="link_ee_right" type="string" value="RARM_END_EFFECTOR_grasp"/> | ||
| <param name="link_ee_left" type="string" value="LARM_END_EFFECTOR_grasp"/> | ||
| <!-- <param name="link_sensor_right" type="string" value="RARM_changer_link_base"/> | ||
| <param name="link_sensor_left" type="string" value="LARM_changer_link_base"/>--> | ||
| <param name="link_head" type="string" value="CAMERA_HEAD_HEADING_Link"/> | ||
| <param name="link_gaze" type="string" value="gaze_ref"/> | ||
| <param name="cmd_topic_name" type="string" value="/$(arg robot_name)/ActionCmdPosePositionController/command"/> | ||
| <remap from="/joint_states" to="/$(arg robot_name)/joint_states"/> | ||
| <remap from="/mux_selected" to="/$(arg robot_name)/mux_joint_position/selected"/> | ||
| </node> | ||
| </launch> |
98 changes: 98 additions & 0 deletions
98
...lsensorAD_6DOF_obstacle_wholetrajectory_withOrientation_turn_experiment_compliance.launch
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,98 @@ | ||
| <?xml version="1.0"?> | ||
|
|
||
| <launch> | ||
| <!-- set global arguments --> | ||
| <arg name="robot_name" default="chonk"/> | ||
| <param name="robot_description_wholebody" command="$(find xacro)/xacro --inorder '$(find chonk_pushing)/urdf/chonk_pushing_wholebody.urdf'"/> | ||
|
|
||
|
|
||
| <!-- Spawn position controller --> | ||
| <node | ||
| name="trajectory_controller" | ||
| pkg="controller_manager" | ||
| type="spawner" | ||
| ns="/$(arg robot_name)" | ||
| args="/$(arg robot_name)/trajectory_controller" | ||
| respawn="false" | ||
| output="screen" | ||
| /> | ||
|
|
||
| <!-- Launch a mux to send commands to the robot only from one source/controller --> | ||
| <node | ||
| name="mux_joint_position" | ||
| pkg="topic_tools" | ||
| type="mux" | ||
| ns="/$(arg robot_name)" | ||
| args="trajectory_controller/command | ||
| streaming_controller/command | ||
| DefaultPositionController/command | ||
| ActionCmdPosePositionController/command | ||
| ActionCmdConfigPositionController/command | ||
| ActionTeleop2DPositionController/command | ||
| mux:=mux_joint_position" | ||
| /> | ||
| <!-- Action Service Node for commanding end-effector poses --> | ||
| <node | ||
| name="action_server_cmd_config" | ||
| pkg="chonk_pushing" | ||
| ns="/$(arg robot_name)" | ||
| type="action_server_cmd_config_wholetrajectory.py" | ||
| output="screen" | ||
| > | ||
| <param name="cmd_topic_name" type="string" value="/$(arg robot_name)/ActionCmdConfigPositionController/command"/> | ||
| <remap from="/joint_states" to="/$(arg robot_name)/joint_states"/> | ||
| <remap from="/mux_selected" to="/$(arg robot_name)/mux_joint_position/selected"/> | ||
| </node> | ||
| <!-- Action Service Node for planning joint positions and build MPC to track the planning results --> | ||
| <node | ||
| name="action_server_cmd_pose_MPC_BC_operational_AD" | ||
| pkg="chonk_pushing" | ||
| ns="/$(arg robot_name)" | ||
| type="action_server_cmd_pose_MPC_BC_operational_pick_localsensorAD_6DOF_obstacle_wholetrajectory_withOrientation_turn_experiment_compliance.py" | ||
| output="screen" | ||
| > | ||
| <param name="link_donkey" type="string" value="link_donkey"/> | ||
| <!-- <param name="link_ee_right" type="string" value="RARM_END_EFFECTOR_finger"/> | ||
| <param name="link_ee_left" type="string" value="LARM_END_EFFECTOR_finger"/>--> | ||
| <param name="link_ee_right" type="string" value="RARM_END_EFFECTOR_grasp"/> | ||
| <param name="link_ee_left" type="string" value="LARM_END_EFFECTOR_grasp"/> | ||
| <!-- <param name="link_sensor_right" type="string" value="RARM_changer_link_base"/> | ||
| <param name="link_sensor_left" type="string" value="LARM_changer_link_base"/>--> | ||
| <param name="link_head" type="string" value="CAMERA_HEAD_HEADING_Link"/> | ||
| <param name="link_gaze" type="string" value="gaze_ref"/> | ||
| <param name="cmd_topic_name" type="string" value="/$(arg robot_name)/ActionCmdPosePositionController/command"/> | ||
| <remap from="/joint_states" to="/$(arg robot_name)/joint_states"/> | ||
| <remap from="/mux_selected" to="/$(arg robot_name)/mux_joint_position/selected"/> | ||
| </node> | ||
| <!-- Action Service Node for teleoperating robot in 2D --> | ||
| <node | ||
| name="action_server_teleop_2d" | ||
| pkg="chonk_pushing" | ||
| ns="/$(arg robot_name)" | ||
| type="action_server_teleop_2d.py" | ||
| output="screen" | ||
| > | ||
| <param name="link_ee_right" type="string" value="RARM_END_EFFECTOR_finger"/> | ||
| <param name="link_ee_left" type="string" value="LARM_END_EFFECTOR_finger"/> | ||
| <param name="link_head" type="string" value="CAMERA_HEAD_HEADING_Link"/> | ||
| <param name="link_ref" type="string" value="teleop_ref"/> | ||
| <param name="link_gaze" type="string" value="gaze_ref"/> | ||
| <param name="cmd_topic_name" type="string" value="/$(arg robot_name)/ActionTeleop2DPositionController/command"/> | ||
| <param name="x_min" type="double" value="0.2"/> | ||
| <param name="x_max" type="double" value="0.8"/> | ||
| <param name="y_min" type="double" value="-0.5"/> | ||
| <param name="y_max" type="double" value="0.5"/> | ||
| <!-- <param name="roll_min" type="double" value="-25"/> | ||
| <param name="roll_max" type="double" value="25"/> | ||
| <param name="pitch_min" type="double" value="-20"/> | ||
| <param name="pitch_max" type="double" value="70"/> --> | ||
| <param name="roll_min" type="double" value="0"/> | ||
| <param name="roll_max" type="double" value="0"/> | ||
| <param name="pitch_min" type="double" value="0"/> | ||
| <param name="pitch_max" type="double" value="0"/> | ||
| <param name="yaw_min" type="double" value="-120"/> | ||
| <param name="yaw_max" type="double" value="120"/> | ||
| <remap from="/joint_states" to="/$(arg robot_name)/joint_states"/> | ||
| <remap from="/mux_selected" to="/$(arg robot_name)/mux_joint_position/selected"/> | ||
| </node> | ||
| </launch> |
Oops, something went wrong.