介绍
今天，我将向大家展示一个我独立设计并实现的机械臂模型。这个模型的核心功能是实现实时的手势追踪——只需用手轻轻拖拽，机械臂就能立即跟随你的动作进行移动。
我之所以想要创造这样一个模型，是因为在一些危险环境中，我们可以用机械臂来代替人工进行作业，从而避免人员的生命安全受到威胁。
你可能会问，为什么不直接使用远程的键盘控制、手柄控制或者APP控制，而要选择手动拖拽的方式呢？我觉得只有手动操作，才能最大程度上满足我们对动作精准度的需求。因此，我决定开始尝试制作这个模型，并初步完成了整个demo。
我希望，通过这个demo，我能向大家展示出机械臂的无限可能性，同时也希望能激发出大家对未来科技的无限憧憬。
机械臂设备
mechArm 270 M5
mechArm 270 是一款六自由度的机械臂，它精巧的结构设计，能够放入一个书包里，携带和方便。较为重要的一点是开放了很多控制的API，用python能够快速开始对机械臂的控制。没有很复杂的操作，甚至还有图形编程，这对一些不是很懂代码的人也能够快速上手控制机械臂。
mechArm是一款桌面型的仿工业结构的机械臂，工作最大半径在270mm，负载250g，重复定位精度控制在±0.5mm。
Project
介绍完基础的设备，我们就开始介绍我时如何制作这个demo过程的记录。
使用的环境
操作系统：windows11
编程语言：python3.9+
python lib：pymycobot，time
pymycobot是大象机器人的一个开源库，专门用来控制大象机器人的机械臂。一段简单的控制代码例子。
Code：
#Main methods used
#Create objects to communicate with the robotic arm.
MyCobot(serial,baud)
# angles control robot,
send_angles([list_angles],speed)
# coords control robot
send_coords([list_coords],speed,mode)
Example:
import time
from pymycobot.mycobot import MyCobot
# create a object
mc = MyCobot("com7",115200)
# angles control
mc.send_angles([0,0,0,0,0,0],100)
time.sleep(1)
mc.send_angles([90,90,90,90,90,90],100)
time.sleep(1)
简单介绍了下如何使用python来控制mechArm，是不是很容易呢。
分析问题
开始项目之前要搭建框架，了解我们具体需要解决什么问题才能够实现。对此我做了一个项目的流程图。下面我将手动施教的机械臂简称为R1，跟随运动的机械臂简称为R2。
Control robotic arm：上边已经提到了如何控制机械臂，使用pymycobot库提供的方法就可以实现了。
Motion Control methods：R1机械臂可以用手拖动，时时刻刻返回当前机械臂的角度信息，R2机械臂接收R1的机械臂角度信息进行控制。
Communication between robotic arms：整个项目中这一步骤是比较重要的一步。建立好之后，机械臂能够发送信息就能够很轻易的实现了。
接下来主要讲解Motion Control methods和communication between robotic arms。
Motion Control methods
- 获取实时角度信息
pymycobot提供了”get_angles()"方法可以过去当前机械臂的角度信息。
# Can obtain the current angle information of the robotic arm in real time
get_angles()
# example
print("real-time angles:",mc.get_anlges())
result: real-time angles:[0,0,0,0,0,0]
# Continuously obtain the current angle
while True:
angels = mc.get_angles()
print(angles)
time.sleep(0.1) #Go to the next step every 0.1s
- 机械臂的刷新模式设置
机械臂的刷新模式：主要分为两种插补模式和非插补模式，是指在运动轨迹规划中，控制机械臂末端执行器的移动方式。如果没有设置任何模式，机械臂可能无法正确执行预期的运动，并且可能导致以下后果：
- 运动不平滑
- 运动不准确
- 运动不连续
插补模式：插补模式可以实现平滑连续的轨迹规划，确保机械臂末端执行器的位置和姿态在运动过程中平滑过渡。
非插补模式：非插补模式是指机械臂在运动过程中只关注特定的目标点，而不进行插值计算。在非插补模式下，机械臂的位置和姿态会在关键点之间直接跳跃，而不会经过平滑的过渡。
在进行多个机械臂同时使用插补模式进行运动时，可能会出现等待或排队的情况，所以我们选择使用非插补模式。
#Set refresh mode
set_fresh_mode(1/0)
1：no interpolation
0：interpolation
mc.set_fresh_mode(1)
我们将前面的整合在一起的代码如下
Code:
import time
from pymycobot.mycobot import MyCobot
mc = MyCobot("COM7", 115200) #release arm
mb = MyCobot("COM11", 115200) #move arm
mb.set_fresh_mode(1) #no interpolation
time.sleep(1)
mc.release_all_servos() #release robot
time.sleep(1)
speed = 100
while True:
angles = mc.get_angles() #get release arm angles
mb.send_angles(angles, speed) #send angles to move arm
time.sleep(0.1)
Communication between robotic arms：
我们的方案是两台机械臂接入同一个PC，用串口连接的方式.
# build connection
from pymycobot.mycobot import MyCobot
mc = MyCobot("COM7", 115200)
mb = MyCobot("COM11", 115200)
用最基础的usb数据线进行连接，我们电脑上就有两个机械臂的串口号，可以对他们分别发送指令任务。
让我们一起来看看效果如何
总结
根据内容可以看出来虽然说是能够做到百分之七八十的同步。也会因为一些其他的因素所影响 ，造成了不小的延迟。造成延迟的原因可能有几个方面，比如说数据处理和传输的速度，机械臂的反应速度，软件的优化，硬件的性能等等，这些都是可能 产生延迟的因素。
除此之外，还有一个很大的局限性就是，它们的通信通过串口进行连接的，如果距离稍微远一点的话就没办法在用这种方法去使用，实用性不强，后期我会尝试使用蓝牙，WiFi等无限连接的方式来尝试控制。
本次记录就更新到这里，如果你有更好的想法，无论是优化的功能或者说是其他的建议欢迎在下方留言。
