Delta并联机构运动学分析

    运动学分析(Kinematic Analysis)包括正向运动学分析(Forward Kinematic Analysis)和逆向运动学分析(Inverse Kinematic Analysis)。正向运动分析即在已知机构各关节角度以及杆件长度的情况下下，求解末端的位置与姿态；而逆向运动学分析正好相反，在已经末端位姿与杆件长度的情况下，求解各关节的角度。机械系统中的机构可以分析串联机构与并联机构，串联机构的正向运动学求解容易，而逆向运动学求解比较困难；而并联机构，则逆向运动不求解比较容易，而是正向运动学求解比较困难。

    常用的运动学求解方法有D-H法、几何法等。Delta机构是典型的并联机构，其由固定平台、浮动平台以及连接固定平台与浮动平台的三条完全一致的支链构成，三条支链在固定平台与浮动平台之间呈120度均匀分布。每一条支链由主动杆与被动杆组成。对于Delta机构而言，其最终只有在个平动自由度，即浮动平台的三个自由度。而主动杆只做转动，浮动平台只做平做，被动杆既有旋转，也有平动。

    由于Delta机构属于典型的并联机构，因此，Delta机构具有并联机构的特征，即正向运动学求解困难，而逆向运动学求解较为容易。在正向驱动中，即机器人轨迹规划等操作中，需要的是机构的逆向运动学。而在反向驱动中，即力反馈操作中，需要的是机构的正向运动学。

    根据几何法，建立Delta机构的模型与坐标系，在固定平台的中心点建立固定坐标系OXYZ，在浮动平台的中心建立浮动坐标系O'X'Y'Z'。主动杆与固定平台的交点为A，被动杆与浮动平台的交点为B,主动杆与被动杆的交点为C。主动杆的升序为Lb,被动杆的长度为La,在固定坐标系，把A，B࿰