moveit!控制双UR3e机械臂

需要把实验室的两台UR3e拼成一个双臂机器人一起做控制。之前从一个双臂开源项目中得到了双UR10的moveit!功能包，经过修改，能够在Gazebo中对双UR3e机器人进行路径规划和控制仿真。但在应用到实际机器人中的时候遇到了各种困难。
机械臂驱动：UR3e需要使用最新的ur_robot_driver驱动，而开源项目中使用了ur_modern_driver驱动，这导致需要自己搭建双机械臂驱动。这需要对ros_control有更好的理解。根据原有的ur3e_bringup.launch进行修改，使用两个节点分别控制两个机械臂，在创建节点时，曾通过在节点名之前加前缀的方式区分节点（如：left_)，经实践后发现这样改会遇到很多麻烦。
然后，建立双机械臂的URDF模型，这一步在之前用gazebo仿真的时候已经完成，过程基本类似。
另外，需要修改ur3e_controllers.yaml。我在这一步困了两周，尝试了很多种方式，最后找到了一种解决方法。分别编写两个yaml(如：left_controller.yaml和right_controller.yaml)，以其中一个为例：

left_arm:            # 在整个文件前写上机器人名称，可以给下面所有定义的控制器加上类名# Settings for ros_control control loophardware_control_loop:loop_hz: &loop_hz 500# Settings for ros_control hardware interface#left_ur_hardware_interface:ur_hardware_interface:       # 程序会在URDF中寻找同名的关节，因此需要在每个关节前加上前缀joints: &robot_joints- left_shoulder_pan_joint- left_shoulder_lift_joint- left_elbow_joint- left_wrist_1_joint- left_wrist_2_joint- left_wrist_3_joint# Publish all joint states ----------------------------------joint_state_controller:type:         joint_state_controller/JointStateControllerpublish_rate: *loop_hz# Publish wrench ----------------------------------force_torque_sensor_controller:type:         force_torque_sensor_controller/ForceTorqueSensorControllerpublish_rate: *loop_hz# Publish speed_scaling factorspeed_scaling_state_controller:type:         ur_controllers/SpeedScalingStateControllerpublish_rate: *loop_hz# Joint Trajectory Controller - position based -------------------------------# For detailed explanations of parameter see http://wiki.ros.org/joint_trajectory_controllerscaled_pos_joint_traj_controller:type: position_controllers/ScaledJointTrajectoryControllerjoints: *robot_jointsconstraints:goal_time: 0.6stopped_velocity_tolerance: 0.05left_shoulder_pan_joint: {trajectory: 0.2, goal: 0.1}left_shoulder_lift_joint: {trajectory: 0.2, goal: 0.1}left_elbow_joint: {trajectory: 0.2, goal: 0.1}left_wrist_1_joint: {trajectory: 0.2, goal: 0.1}left_wrist_2_joint: {trajectory: 0.2, goal: 0.1}left_wrist_3_joint: {trajectory: 0.2, goal: 0.1}stop_trajectory_duration: 0.5state_publish_rate: *loop_hzaction_monitor_rate: 20pos_joint_traj_controller:type: position_controllers/JointTrajectoryControllerjoints: *robot_jointsconstraints:goal_time: 0.6stopped_velocity_tolerance: 0.05left_shoulder_pan_joint: {trajectory: 0.2, goal: 0.1}left_shoulder_lift_joint: {trajectory: 0.2, goal: 0.1}left_elbow_joint: {trajectory: 0.2, goal: 0.1}left_wrist_1_joint: {trajectory: 0.2, goal: 0.1}left_wrist_2_joint: {trajectory: 0.2, goal: 0.1}left_wrist_3_joint: {trajectory: 0.2, goal: 0.1}stop_trajectory_duration: 0.5state_publish_rate: *loop_hzaction_monitor_rate: 20scaled_vel_joint_traj_controller:type: velocity_controllers/ScaledJointTrajectoryControllerjoints: *robot_jointsconstraints:goal_time: 0.6stopped_velocity_tolerance: 0.05left_shoulder_pan_joint: {trajectory: 0.1, goal: 0.1}left_shoulder_lift_joint: {trajectory: 0.1, goal: 0.1}left_elbow_joint: {trajectory: 0.1, goal: 0.1}left_wrist_1_joint: {trajectory: 0.1, goal: 0.1}left_wrist_2_joint: {trajectory: 0.1, goal: 0.1}left_wrist_3_joint: {trajectory: 0.1, goal: 0.1}gains:#!!These values have not been optimized!!left_shoulder_pan_joint:  {p: 5.0,  i: 0.05, d: 0.1, i_clamp: 1}left_shoulder_lift_joint: {p: 5.0,  i: 0.05, d: 0.1, i_clamp: 1}left_elbow_joint:         {p: 5.0,  i: 0.05, d: 0.1, i_clamp: 1}left_wrist_1_joint:       {p: 5.0,  i: 0.05, d: 0.1, i_clamp: 1}left_wrist_2_joint:       {p: 5.0,  i: 0.05, d: 0.1, i_clamp: 1}left_wrist_3_joint:       {p: 5.0,  i: 0.05, d: 0.1, i_clamp: 1}# Use a feedforward term to reduce the size of PID gainsvelocity_ff:left_shoulder_pan_joint: 1.0left_shoulder_lift_joint: 1.0left_elbow_joint: 1.0left_wrist_1_joint: 1.0left_wrist_2_joint: 1.0left_wrist_3_joint: 1.0stop_trajectory_duration: 0.5state_publish_rate: *loop_hzaction_monitor_rate: 20vel_joint_traj_controller:type: velocity_controllers/JointTrajectoryControllerjoints: *robot_jointsconstraints:goal_time: 0.6stopped_velocity_tolerance: 0.05left_shoulder_pan_joint: {trajectory: 0.1, goal: 0.1}left_shoulder_lift_joint: {trajectory: 0.1, goal: 0.1}left_elbow_joint: {trajectory: 0.1, goal: 0.1}left_wrist_1_joint: {trajectory: 0.1, goal: 0.1}left_wrist_2_joint: {trajectory: 0.1, goal: 0.1}left_wrist_3_joint: {trajectory: 0.1, goal: 0.1}gains:#!!These values have not been optimized!!left_shoulder_pan_joint:  {p: 5.0,  i: 0.05, d: 0.1, i_clamp: 1}left_shoulder_lift_joint: {p: 5.0,  i: 0.05, d: 0.1, i_clamp: 1}left_elbow_joint:         {p: 5.0,  i: 0.05, d: 0.1, i_clamp: 1}left_wrist_1_joint:       {p: 5.0,  i: 0.05, d: 0.1, i_clamp: 1}left_wrist_2_joint:       {p: 5.0,  i: 0.05, d: 0.1, i_clamp: 1}left_wrist_3_joint:       {p: 5.0,  i: 0.05, d: 0.1, i_clamp: 1}# Use a feedforward term to reduce the size of PID gainsvelocity_ff:left_shoulder_pan_joint: 1.0left_shoulder_lift_joint: 1.0left_elbow_joint: 1.0left_wrist_1_joint: 1.0left_wrist_2_joint: 1.0left_wrist_3_joint: 1.0stop_trajectory_duration: 0.5state_publish_rate: *loop_hzaction_monitor_rate: 20# Pass an array of joint velocities directly to the jointsjoint_group_vel_controller:type: velocity_controllers/JointGroupVelocityControllerjoints: *robot_jointsrobot_status_controller:type: industrial_robot_status_controller/IndustrialRobotStatusControllerhandle_name: industrial_robot_status_handlepublish_rate: 10

这样在运行bringup之后可以得到类名相同的两组param和node

NODES/left_arm/controller_stopper (controller_stopper/node)ros_control_controller_spawner (controller_manager/spawner)ros_control_stopped_spawner (controller_manager/spawner)ur_hardware_interface (ur_robot_driver/ur_robot_driver_node)ur_robot_state_helper (ur_robot_driver/robot_state_helper)/right_arm/controller_stopper (controller_stopper/node)ros_control_controller_spawner (controller_manager/spawner)ros_control_stopped_spawner (controller_manager/spawner)ur_hardware_interface (ur_robot_driver/ur_robot_driver_node)ur_robot_state_helper (ur_robot_driver/robot_state_helper)/joint_state_publisher (joint_state_publisher/joint_state_publisher)robot_state_publisher (robot_state_publisher/robot_state_publisher)

还遇到了controller的名字不一样的问题。需要保证server端和client端的名称保持一致（具体一下哪边是client哪边是server）
参考：https://blog.csdn.net/ha010/article/details/109274459
https://blog.csdn.net/qq_50598558/article/details/114702163

另外出现了WARN:Controller Spawner couldn’t find the expected controller_manager ROS interface.的问题，这是因为前面提到的命名空间不统一的问题。
参考：https://blog.csdn.net/CCsLife/article/details/106086854

目前的情况是，打开bringup和moveit没有问题，执行路径规划也没有问题，但是无法执行，控制真是机械臂。
报错如下：Controller right_arm/scaled_pos_joint_traj_controller failed with error code PATH_TOLERANCE_VIOLATED
这个问题还未解决。

3月31日，问题解决了！
PATH_TOLERANCE_VIOLATED问题出现之后的某天突然想到，rviz中的机器人模型并没有和实际机器人同步，还是最开始的那个姿势，所以一定是joint_states出现了问题。
查看joint_states的话题内容，发现都是0，难怪会出现超过约束的问题。
查看joint_states的info，发现根本没有发布者，只有订阅者。
查看目前的双臂驱动rqt_graph:

和能正常使用的单机械臂驱动的rqt_graph比较之后发现了两个问题：
(1)驱动节点有一些不一样的地方，应该是这样：

这个问题出在了bringup的最后：
注释中提示
Make sure to start this in the namespace of the hardware interface
而我并没有把该节点在ur_hardware_interface命名空间中，应修改为：

  <!-- Make sure to start this in the namespace of the hardware interface --><node ns="right_arm/ur_hardware_interface" name="ur_robot_state_helper" pkg="ur_robot_driver" type="robot_state_helper" respawn="false" output="screen"></node><!-- Make sure to start this in the namespace of the hardware interface --><node ns="left_arm/ur_hardware_interface" name="ur_robot_state_helper" pkg="ur_robot_driver" type="robot_state_helper" respawn="false" output="screen"></node>

修改之后，仍然没有joint_states
查看rostopic list，发现原来是节点发布的话题多了一个类名！

马上加上remap

<remap from="/left_arm/joint_states" to="/joint_states"/>

大功告成！

折磨了我近一个月的双臂驱动终于完成了。

moveit!控制双UR3e机械臂相关推荐

双轴机械臂调试：步进电机42HS348E,BH32角度传感器，MCU:STC8H1K28
■ 前言这款双轴机械臂是应用于实验室中进行自动样品转换的执行机构.为了能够在一定范围内将试剂瓶(试管) 完成自动搬运,需要完成对样品的抓取,提升和放下.水平移动(二维) 等功能.使用带有肘关节.肩关 ...
双轴机械臂串口控制命令开发与测试：STM32F103控制板,简易调试命令集合
▌01 底层串口控制命令 1.调试说明本文是继调试机械臂一体化控制电路博文中对于两轴机械臂+机械爪整体控制板设计与机械爪控制调试在基于STM32F103双轴机械臂完整电路板控制下进行串口 ...
组装肩部带有减速器双轴机械臂组装与调试
➤ 00背景在增加了机械爪的双轴机械臂安装调试之后, 发现进行平顺控制效果不好 ,因此在原来的基础上进行了如下的改动: 肩部和肘部的角度传感器采用了: 角度编码器 ST-3806-15-RS 读 ...
双轴机械臂中的闭环步进电机平顺控制算法： 42HS48EIS，57HS
■ 实验背景在两轴机械臂+机械爪整体控制板设计与机械爪控制调试的基础上对于机械臂各关节进行了双关节机械臂+机械爪运动控制 ,其中存在的主要问题还是肩关节运动不平稳的情况. ▲ 机械臂肩部运动 ...
双关节机械臂+机械爪运动控制
01控制调试基础在博文两轴机械臂+机械爪整体控制板设计与机械爪控制调试中给出了双轴机械臂整体控制电路板的设计以及初步调试的过程.本文则完成对于双臂运动的控制调试. 控制调试包括两部分的内容: 机械 ...
双轴机械臂位置闭环控制：STC8H1K28，42HS48EIS,BH32
■ 背景介绍对于一款用于化学实验室样品操作机械臂的调试过程中,在博文双轴机械臂调试:步进电机42HS348E,BH32角度传感器,MCU:STC8H1K28 可以看到初步的通过带有闭环控制的 ...
基于STC8H1K28的双轴机械臂驱动模块:步进电机42HS348E,BH32角度传感器
作者:卓晴博士,清华大学自动化系更新时间:2020-08-08 Saturday ■ 设计背景这是一款用于化学实验室样品上样器的机械臂.设置有肘关节.肩关节以及上下移动关节. ▲ 双轴机械臂结构 ...
Moveit!入门——古月居机械臂开发笔记（二）
Moveit!入门--古月居机械臂开发笔记(二) 引言 ROS机械臂开发_机器视觉与物体抓取 1.ROS中的运动学插件 2.Moveit!碰撞检测规划场景 3.Pick and Place 4.RO ...
Moveit!入门——古月居机械臂开发笔记（一）
Moveit!入门--古月居机械臂开发笔记(一) 引言 Moveit!与机械臂控制 1.创作机械臂模型 2.生成配置文件 3.如何使用Moveit!实现机械臂仿真(gazebo) 完善模型在gaze ...

moveit!控制双UR3e机械臂

moveit!控制双UR3e机械臂相关推荐

最新文章

热门文章