Delta机器人的运动学分析

Delta机器人的运动学分析

@(1@Personal)[DeltaRobot,BLOG]

暂时放出位置分析，稍后更新速度及加加速度分析。

---

约定

机构简述

The delta robot consists of two platforms: the upper one (1) with three motors (3) mounted on it, and smaller one (8) with an end effector (9). The platforms are connected through three arms with parallelograms, the parallelograms restrain the orientation of the lower platform to be parallel to the working surface (table, conveyor belt and so on). The motors (3) set the position of the arms (4) and, thereby, the XYZ-position of the end effector, while the fourth motor (11) is used for rotation of the end effector. You can find more detailed description of delta robot design in the corresponding Wikipedia article.

参数

名称	意义
$b$	基座中心到电机的距离
$a$	主动臂长度
$f$	从动臂长度
$p$	移动平台中心到链接点的距离
$E_{1、2、3}$	肘关节
$\{B\}$	基座所在平面
$B_0$	移动平台中心位置
$B_{1、2、3}$	电机位置
$\{P\}$	移动平台所在平面
$P_0$	移动平台中心位置
$P_{1、2、3}$	从动臂和移动平台连接点

机构坐标系

机构坐标系是一个笛卡尔坐标系统，原点与$B_0$重合，且$B_1$在y轴上，xy平面与$\{B\}$重合。

轴坐标系

顺时针旋转为角度正方向。

---

前期分析

假设$P_0$坐标为$(x,y,z)$;三轴转角为$(\theta_1,\theta_2,\theta_3)$。

约束环

为方便理解，Delta机器人的机械结构可以解耦成3个独立的运动学约束环。下图是以1轴为基准的约束环：

$$\begin{equation}\label{eq1} \{B_0P_1\}=\{B_0B_1\}+\{B_1E_1\}+\{E_1P_1\}=\{B_0P_0\}+\{P_0P_1\} \end{equation}$$
这里需要注意，由于Delta结构的特性， $\{B_1E_1\}$在yz平面上， $\{P_0P_1\}$平衡于y轴。

为求解方便，将等式$\eqref{eq1}$变换为$\{E_1P_1\}$的表达式：

{ E1P1}={ B0P0}+{ P0P1}−{ B0B1}−{