diff --git a/config/panda_control.yaml b/config/panda_control.yaml index 94c10f3c68067aaab3a2d7795cf361f54cb8fad3..65fcaf7fd3133a7aa88e41a322718ec51db7ecd0 100644 --- a/config/panda_control.yaml +++ b/config/panda_control.yaml @@ -3,7 +3,7 @@ type: joint_state_controller/JointStateController publish_rate: 100 - panda_arm_controller: + position_joint_trajectory_controller: type: position_controllers/JointTrajectoryController joints: - panda_joint1 @@ -26,6 +26,7 @@ - panda_finger_joint2 state_publish_rate: 25 + joint_position_controller: type: panda_simulation/JointPositionController arm_id: panda diff --git a/launch/simulation.launch b/launch/simulation.launch index f1972ca6febee83d8629cf7fce0f94789c6114c1..3678504d36121118c5ae12f4d9d14ab77303f31d 100644 --- a/launch/simulation.launch +++ b/launch/simulation.launch @@ -9,9 +9,8 @@ <arg name="load_gripper" default="true" /> <!-- don't include franka_control, but include the controller stuff from there --> - <param name="robot_description" command="$(find xacro)/xacro --inorder '$(find franka_description)/robots/panda_arm_hand.urdf.xacro'" if="$(arg load_gripper)" /> - <param name="robot_description" command="$(find xacro)/xacro --inorder '$(find franka_description)/robots/panda_arm.urdf.xacro'" unless="$(arg load_gripper)" /> - <rosparam command="load" file="$(find franka_control)/config/default_controllers.yaml" /> + <param name="robot_description" command="$(find xacro)/xacro '$(find franka_description)/robots/panda_arm_hand.urdf.xacro'" if="$(arg load_gripper)" /> + <param name="robot_description" command="$(find xacro)/xacro '$(find franka_description)/robots/panda_arm.urdf.xacro'" unless="$(arg load_gripper)" /> <!--launch GAZEBO with own world configuration --> <include file="$(find gazebo_ros)/launch/empty_world.launch"> diff --git a/src/robot_state_initializer.cpp b/src/robot_state_initializer.cpp index 4c6626d324df001a8563645c605871b40f21483e..49932e2fdbfb3fd90a687c512285bc32cea106c7 100644 --- a/src/robot_state_initializer.cpp +++ b/src/robot_state_initializer.cpp @@ -62,11 +62,11 @@ int main(int argc, char **argv) { srv_switch_controller.request.start_controllers = start_controllers; if (switch_controller_client.call(srv_switch_controller)) { - ROS_INFO_STREAM("Success switching controllers from " << stream_stop_controllers.str() << " to " - << stream_start_controllers.str()); + ROS_INFO_STREAM("Success switching controllers from " << stream_start_controllers.str() << " to " + << stream_stop_controllers.str()); } else { - ROS_WARN_STREAM("Error switching controllers from " << stream_stop_controllers.str() << " to " - << stream_start_controllers.str()); + ROS_WARN_STREAM("Error switching controllers from " << stream_start_controllers.str() << " to " + << stream_stop_controllers.str()); return -1; }