基于非对称变结构的操作臂前向运动学定位方法
摘要:
本发明涉及一种基于非对称变结构的操作臂前向运动学定位方法,包括:步骤1,在操作空间范围内,初始化参数;步骤2,将多个非对称单模块并联而成的操作臂运动扩展分成多个非对称单模块平移旋转的叠加操作;步骤3,设计参数Li,θi之间的关系;步骤4,根据前向运动学约束方程,展开为超越方程,利用角度参数的变换,获得致密的多项式方程;步骤5,根据代数对消方法,利用参数迭代的方式求解最终的多项式方程;步骤6,计算角度表达式中的关键节点;步骤7,根据变几何桁架操作臂的运动末端位姿向量表达式,计算期望位置X,方向n;步骤8,实现目标位姿的初步定位。与现有技术相比,本发明能提高本发明构建系统的测量精度和计算的数值稳定性。
0/0