OpenMANIPULATOR-X入门教程-12.应用:主从机同步

主从机同步

在此示例中,如果用户持有主 OpenMANIPULATOR,则从属 OpenMANIPULATOR-X会像主机器人一样移动。记录模式允许您在移动主 OpenMANIPULATOR-X时保存轨迹并将其播放到从属OpenMANIPULATOR。

 

设置OpenMANIPULATOR-X

由于您需要在一台PC上控制两个OpenManipulator,因此请使用两个U2D2和两个OpenManipulators进行连接,如下所示。

OpenManipulator_master_slave_connection.png

OpenManipulator_master_slave.png

Master OpenMANIPULATOR-X(主机)

Master OpenMANIPULATOR-X是由用户控制的机器人。这很容易移动,因为没有扭矩施加到dynamixel上。主机Master OpenMANIPULATOR-X 的DYNAMIXEL将ID设置为如下,波特率为1000000 bps。

 

关节名称

ID

关节1

21

关节2

22

关节3

23

关节4

24

爪手

25

 

Slave OpenMANIPULATOR-X(从机)

Slave OpenMANIPULATOR-X 与Master OpenMANIPULATOR 同步移动。从机OpenMANIPULATOR-X 的舵机设置ID 如下,波特率为1000000 bps。这与默认的 OpenMANIPULATOR-X 设置相同。

 

 

关节名称

ID

关节1

11

关节2

12

关节3

13

关节4

14

爪手

15

 

 

安装功能包

在终端窗口中运行以下命令。

cd ~/catkin_ws/src/

git clone https://github.com/ROBOTIS-GIT/open_manipulator_applications.git

cd ~/catkin_ws && catkin_make

 

 

如果catkin_make命令已经完成且没有任何错误,则所有准备工作都已完成。

 

警告:

请在运行 OpenMANIPULATOR-X 之前检查每个关节位置。

如果任何关节超出可操作范围,机器人将不会操作。

下图描述了 OpenMANIPULATOR-X 在启动时的推荐姿势。

请在控制器打开扭矩之前调整姿势。

open_manipulator_start_pose.png

打开一个新终端并输入以下命令以运行控制器Slave OpenMANIPULATOR-X

这 dynamixel_usb_port 是设置从属 OpenMANIPULATOR-X 端口的参数。

请检查您的操作系统并使用分配给U2D2的相应USB端口。

roslaunch open_manipulator_controller open_manipulator_controller.launch dynamixel_usb_port:=/dev/ttyUSB0

如果从属OpenMANIPULATOR-X控制器成功启动,终端将打印以下消息。

 

打开另一个终端并输入以下命令以运行控制器Master OpenMANIPULATOR-X.

这 usb_port 是设置主 OpenMANIPULATOR-X 端口的参数。

请检查您的操作系统并使用分配给 U2D2 的相应串行端口。

roslaunch open_manipulator_master_slave open_manipulator_master.launch usb_port:=/dev/ttyUSB1

如果主控制器OpenMANIPULATOR-X已成功启动,终端将打印以下消息。

 

终端中将出现以下消息。当前控制模式和机器人状态(关节角度、工具位置)将更新。

 

 

有四种控制模式可供选择。请在终端中选择并输入号码。

 

1 : 主从模式

主机器人和从机器人同步移动。

2 : 开始记录轨迹

主机器人和从属机器人同步移动,控制器记录运动轨迹。

3 : 停止记录轨迹

结束录制。

4 : 播放录制的轨迹

在第二种模式下记录的轨迹仅由从属机器人再现。