Delta并联机器人因其高速运动能力在食品分拣、药品包装等轻工领域有着广泛应用。其运动学模型的精确建立是实现精准控制的前提。
一、动平台与静平台几何模型
Delta机器人的结构由静平台、动平台和三组平行支链组成。静平台位于顶部安装有三个驱动电机,动平台位于底部通过球铰与三条支链连接。每条支链由主动臂和从动臂组成,主动臂与电机输出轴固连,从动臂由两根平行连杆构成。建立几何模型时需要定义静平台半径R、动平台半径r、主动臂长度L1和从动臂长度L2这四个基本参数。坐标系的建立通常将静平台中心设置为世界坐标系原点,Z轴竖直向下。三个驱动电机的角度为输入变量,动平台中心的空间位置为输出变量。
二、矢量环方程
位置反解的矢量环方程是Delta运动学的基础。从静平台中心到动平台中心的矢量关系可以写成闭环形式。基于闭环矢量方程可以推导出每个主动臂角度与动平台位置之间的运算关系。位置反解具有唯一解,给定动平台位置可以直接计算出三个电机转角,这是Delta机器人实时控制的依据。位置正解则相对复杂,已知三个电机转角求解动平台位置,通常采用解析法或数值法求解。
三、雅可比矩阵
雅可比矩阵建立了关节速度与末端速度之间的映射关系。Delta机器人的雅可比矩阵可以通过对闭环矢量方程求导得到。雅可比矩阵的条件数可以用来评估机构的运动灵巧度,条件数越接近1机构的运动传递性能越好。雅可比矩阵的行列式值为零对应机构的奇异位形。此外雅可比矩阵还用于操作力的计算,末端所受外力可以通过雅可比矩阵的转置映射到各关节驱动力矩。
四、工作空间分析
Delta机器人的工作空间是动平台中心可达位置的集合。与串联机器人相比Delta的工作空间相对有限,约为静平台圆周范围内的下方区域。通过蒙特卡洛法和边界搜索算法可以生成工作空间的几何形状。优化工作空间通常需要调整L1与L2的比例,一般L1与L2在0.8至1.2范围内可获得较优结果。
五、奇异位形规避
奇异位形是并联机器人运动学中的关键问题。在奇异位形附近机构的运动性能急剧下降,可能产生失控的力或运动。通过轨迹规划中施加奇异约束、优化杆长比等方式可以有效规避奇异区域。综上所述,Delta机器人运动学模型的建立和求解是实现高速高精度控制的理论基础。 |