机械臂的控制
1 滑块控制
打开一个命令行,运行:
- mycobot 320-M5 2022版本:
# mycobot 320-M5版本默认串口名为"/dev/ttyUSB0",波特率为115200.部分机型的串口名为 "dev/ttyACM0",若默认串口名发生错误,可将串口名改为"/dev/ttyACM0".
ros2 launch mycobot_320 slider_control.launch.py
- mycobot 320-PI 2022版本:
点击桌面上的ROS2 Shell
图标或者桌面下方栏的对应图标,打开ROS2环境终端:
然后运行命令:
# mycobot 320-PI版本默认串口名为"/dev/ttyAMA0",波特率为115200.
ros2 launch mycobot_320pi slider_control.launch.py
它将打开 rviz 和一个滑块组件,你将看到如下画面(树莓派版本画面略有差异,不影响使用):
接着你可以通过拖动滑块来控制 rviz 中的模型移动。真实的 mycobot 将跟着一起运动。
请注意:由于在命令输入的同时机械臂会移动到模型目前的位置,在您使用命令之前请确保rviz中的模型没有出现穿模现象 不要在连接机械臂后做出快速拖动滑块的行为,防止机械臂损坏
2 模型跟随
除了上面的控制,我们也可以让模型跟随真实的机械臂运动。打开一个命令行运行:
- mycobot 320-M5 2022版本:
# mycobot 320-M5版本默认串口名为"/dev/ttyUSB0",波特率为115200.部分机型的串口名为 "dev/ttyACM0",若默认串口名发生错误,可将串口名改为"/dev/ttyACM0".
ros2 launch mycobot_320 mycobot_follow.launch.py
- mycobot 320-PI 2022版本:
点击桌面上的ROS2 Shell
图标或者桌面下方栏的对应图标,打开ROS2环境终端:
然后运行命令:
# mycobot 320-PI版本默认串口名为"/dev/ttyAMA0",波特率为115200.
ros2 launch mycobot_320pi mycobot_follow.launch.py
它将打开 rviz 展示模型跟随效果。
3 GUI 控制
在前面的基础上,本包还提供了简单的 Gui 控制界面。 该方式意在于真实机械臂相互联动,请连接 mycobot。
打开命令行:
- mycobot 320-M5 2022版本:
# mycobot 320-M5版本默认串口名为"/dev/ttyUSB0",波特率为115200.部分机型的串口名为 "dev/ttyACM0",若默认串口名发生错误,可将串口名改为"/dev/ttyACM0".
ros2 launch mycobot_320 simple_gui.launch.py
- mycobot 320-PI 2022版本:
点击桌面上的ROS2 Shell
图标或者桌面下方栏的对应图标,打开ROS2环境终端:
然后运行命令:
# mycobot 320-PI版本默认串口名为"/dev/ttyAMA0",波特率为115200.
ros2 launch mycobot_320pi simple_gui.launch.py
4 键盘控制
在 mycobot_320
的包中添加了键盘控制的功能,并在 rviz 中实时同步。本功能依赖 pythonApi,所以确保与真实机械臂连接。
打开一个命令行,运行:
- mycobot 320-M5 2022版本:
# mycobot 320-M5版本默认串口名为"/dev/ttyUSB0",波特率为115200.部分机型的串口名为 "dev/ttyACM0",若默认串口名发生错误,可将串口名改为"/dev/ttyACM0".
ros2 launch mycobot_320 teleop_keyboard.launch.py
- mycobot 320-PI 2022版本:
点击桌面上的ROS2 Shell
图标或者桌面下方栏的对应图标,打开ROS2环境终端:
然后运行命令:
# mycobot 320-PI版本默认串口名为"/dev/ttyAMA0",波特率为115200.
ros2 launch mycobot_320pi teleop_keyboard.launch.py
运行效果如下:
命令行中将会输出 mycobot 信息,如下:
[INFO] [launch]: All log files can be found below /home/u20/.ros/log/2022-08-05-10-43-12-301971-u20-VirtualBox-6290
[INFO] [launch]: Default logging verbosity is set to INFO
[INFO] [robot_state_publisher-1]: process started with pid [6293]
[INFO] [rviz2-2]: process started with pid [6295]
[INFO] [follow_display-3]: process started with pid [6297]
[robot_state_publisher-1] Parsing robot urdf xml string.
[robot_state_publisher-1] Link link1 had 1 children
[robot_state_publisher-1] Link link2 had 1 children
[robot_state_publisher-1] Link link3 had 1 children
[robot_state_publisher-1] Link link4 had 1 children
[robot_state_publisher-1] Link link5 had 1 children
[robot_state_publisher-1] Link link6 had 0 children
[robot_state_publisher-1] [INFO] [1659667392.703132973] [robot_state_publisher]: got segment base
[robot_state_publisher-1] [INFO] [1659667392.703485410] [robot_state_publisher]: got segment link1
[robot_state_publisher-1] [INFO] [1659667392.703545198] [robot_state_publisher]: got segment link2
[robot_state_publisher-1] [INFO] [1659667392.703571119] [robot_state_publisher]: got segment link3
[robot_state_publisher-1] [INFO] [1659667392.703587512] [robot_state_publisher]: got segment link4
[robot_state_publisher-1] [INFO] [1659667392.703603744] [robot_state_publisher]: got segment link5
[robot_state_publisher-1] [INFO] [1659667392.703619685] [robot_state_publisher]: got segment link6
[rviz2-2] [INFO] [1659667393.588026632] [rviz2]: Stereo is NOT SUPPORTED
[rviz2-2] [INFO] [1659667393.588472253] [rviz2]: OpenGl version: 3.1 (GLSL 1.4)
[rviz2-2] [INFO] [1659667393.766777360] [rviz2]: Stereo is NOT SUPPORTED
[rviz2-2] Parsing robot urdf xml string.
[follow_display-3] [INFO] [1659667394.310152595] [follow_display]: port:/dev/ttyUSB0, baud:115200
接着,打开另一个命令行,运行:
- mycobot 320-M5 2022版本:
ros2 run mycobot_320 teleop_keyboard
- mycobot 320-PI 2022版本:
点击桌面上的ROS2 Shell
图标或者桌面下方栏的对应图标,打开ROS2环境终端:
然后运行命令:
ros2 run mycobot_320pi teleop_keyboard
你会在命令行中看到如下输出:
Mycobot Teleop Keyboard Controller
---------------------------
Movimg options(control coordinations [x,y,z,rx,ry,rz]):
w(x+)
a(y-) s(x-) d(y+)
z(z-) x(z+)
u(rx+) i(ry+) o(rz+)
j(rx-) k(ry-) l(rz-)
Gripper control:
g - open
h - close
Other:
1 - Go to init pose
2 - Go to home pose
3 - Resave home pose
q - Quit
currently: speed: 30 change percent: 2
在该终端中,您可以通过命令行中的按键控制机械臂的状态和对机械臂进行移动操作。