

机械臂速成小指南(二十三):Paul方法求解机械臂运动学逆解(含matlab代码)
🦾🌏🪐以下为正文🦾🌏🪐
六自由度机械臂上位机python代码(带详细注释,含正逆运动学及轨迹规划等)
https://download.csdn.net/download/m0_53966219/87521956?spm=1001.2014.3001.5503六自由度机械臂下位机代码及pcb设计
https://download.csdn.net/download/m0_53966219/88480657?spm=1001.2014.3001.5503
在设计好六自由度机械臂的控制程序(包含上位机及下位机)后,我们需要通过实验来验证机械臂的精度与可行性。
精度的判断显然是需要定量分析的。本篇文章是参考GBT 12642-2013工业机器人性能规范及其试验方法(Industrial robots-Perfo rmance criteria and related test methods)并结合自身经济实力设计的较简陋且不够严谨的位姿重复性实验。同样,仅供参考。
位姿准确度表示指令位姿和从同一方向接近该指令位姿时的实到位姿平均值之间的偏差。位姿准确度分为:
位姿重复性(RP)表示对同一指令位姿从同一方向重复响应n次后实到位姿的一致程度。对某一位姿 ,重复性可表示为:
位置准确度和重复性如下图所示:

姿态准确度和重复性如下图所示:

机器人应装配完毕,并可全面操作。所有必要的校平操作、调整步骤及功能试验均圆满完成。除位姿特性的漂移试验应由冷态开始外,不管制造商是否有规定,其余的试验在试验前应进行适当的预热运行。
若机器人具有由用户使用的、会影响被测特性的设备,或如果只能用特殊函数来记录特性(如离线编程给出的位姿校准设施)的设备,则试验中的状态必须在试验报告中说明,并且(与某种特性有关时)每次试验中均应保持不变。
环境条件包括:温度、相对湿度、电磁场和静电场、射频干扰、大气污染和海拔高度极限。
所有试验项目都应在 100% 额定负载条件下进行,即制造商规定的质量、重心位置和惯性力矩。额定负载条件应在试验报告中注明。为表征机器人与负载有关的性能,可采用将额定负载减至 10% 或由制造商指定的其他数值进行附加试验。如部分测量仪器附加于机器人上,应把其质量和位置当作试验负载的一部分。

所有位姿特性试验都应在指定位姿间可达到的最大速度下进行,即在每种情况下速度补偿均置于100% ,并可在此速度的50%和或10%下进行附加试验。
当机器人在各位姿间运动时,所有关节均应运动。
试验时,应注意不超出制造操作规范。

下图绿色方框中的是库卡公司的KR4R600机械臂说明书中表示的位姿重复精度。

下图在绿色方框中的是2021中国工程机器人大赛暨国际公开赛(RoboWork)桌面机械臂项目规则说明中注明的重复定位精度。

综合上两张图,我们不难发现工业级机械臂的位姿重复性通常可达0.01mm,而桌面级机械臂的位姿重复性可达0.5mm。
我们使用的机械臂也就勉强算个桌面级机械臂,只要最后实验结果达到0.5mm就算合格。
测定位姿重复性的方法分为非接触型测定与接触式测定。其中,非接触式测量精度高、成本高,常应用于工业级机械臂的位姿重复性测试;接触式测量精确度低、成本低,常应用于桌面级机械臂的位姿重复性测量。
我们使用接触式测量就足够了,杀鸡焉用宰牛🔪。
我们可根据记录的数据计算六自由度机械臂的位姿重复性,位姿重复性由位置重复性与姿态重复性 组成。n次响应后末端执行器在空间中形成的实际位姿点阵可看作被包围在一个半径为 ,球心坐标为 的球内,如下图所示。
![]()


在P_f处布置两个用于测量位姿偏差的百分表。布置方式如下图所示,百分表1的测头与基坐标系的 轴平行且反向,百分表2的测头位于基坐标系的平面,与轴夹角为45°且与 轴夹角为135°。
|
|
|
将起始位姿与终止位姿储存于轨迹点寄存器中。

编写指令。

| 机械臂运行速度为50%时位姿重复性实验数据 | ||||||||
| 百分表1 | 百分表2 | ai | bi | 距离li | dx | dy | dz | |
| 0.58 | 0.38 | -0.02 | -0.52 | 0.3 | 0.007534699 | 0.001248 | 0.001185 | 0.001185 |
| 0.59 | 0.39 | -0.01 | -0.51 | 0.42 | 0.175497473 | 0.002055 | 0.167478 | 0.167478 |
| 0.59 | 0.43 | -0.01 | -0.47 | 0.39 | 0.153256856 | 0.002055 | 0.145125 | 0.145125 |
| 0.58 | 0.44 | -0.02 | -0.46 | 0.39 | 0.147763841 | 0.001248 | 0.139786 | 0.139786 |
| 0.55 | 0.43 | -0.05 | -0.47 | 0.39 | 0.152821244 | 2.84E-05 | 0.145125 | 0.145125 |
| 0.6 | 0.45 | 0 | -0.45 | 0.38 | 0.142975471 | 0.003062 | 0.134548 | 0.134548 |
| 0.58 | 0.42 | -0.02 | -0.48 | 0.4 | 0.158506153 | 0.001248 | 0.150563 | 0.150563 |
| 0.53 | 0.43 | -0.07 | -0.47 | 0.39 | 0.152861898 | 0.000215 | 0.145125 | 0.145125 |
| 0.53 | 0.44 | -0.07 | -0.46 | 0.38 | 0.147526581 | 0.000215 | 0.139786 | 0.139786 |
| 0.52 | 0.41 | -0.08 | -0.49 | 0.41 | 0.1639071 | 0.000608 | 0.156101 | 0.156101 |
| 0.53 | 0.43 | -0.07 | -0.47 | 0.39 | 0.152861898 | 0.000215 | 0.145125 | 0.145125 |
| 0.5 | 0.44 | -0.1 | -0.46 | 0.39 | 0.147933169 | 0.001995 | 0.139786 | 0.139786 |
| 0.5 | 0.44 | -0.1 | -0.46 | 0.39 | 0.147933169 | 0.001995 | 0.139786 | 0.139786 |
| 0.48 | 0.43 | -0.12 | -0.47 | 0.4 | 0.153700428 | 0.004182 | 0.145125 | 0.145125 |
| 0.51 | 0.47 | -0.09 | -0.43 | 0.37 | 0.132387902 | 0.001202 | 0.124372 | 0.124372 |