主权项 |
一种基于非对称变结构的操作臂前向运动学定位方法,其特征在于,包括以下步骤:步骤1,在操作空间范围内,初始化参数θ<sub>0</sub>、L<sub>0</sub>和X<sub>0</sub>,其中,θ<sub>0</sub>表示对应于角度参数集合Θ={θ<sub>1</sub>,θ<sub>2</sub>,θ<sub>3</sub>}的初始状态,L<sub>0</sub>表示对应于主动杆长参数集合L={L<sub>1</sub>,L<sub>2</sub>,L<sub>3</sub>}的初始状态,L<sub>1</sub>=||A<sub>2</sub>B<sub>2</sub>||表示A<sub>2</sub>B<sub>2</sub>的长度,L<sub>2</sub>=||B<sub>2</sub>C<sub>2</sub>||表示B<sub>2</sub>C<sub>2</sub>的长度,L<sub>3</sub>=||A<sub>2</sub>C<sub>2</sub>||表示A<sub>2</sub>C<sub>2</sub>的长度,X<sub>0</sub>表示对应于操作臂移动平台的中心位置向量参数集合X={X<sub>i</sub>|i=1,…,n}的初始状态,n依赖非对称单模块个数;步骤2,通过模块化设计,将多个非对称单模块并联而成的操作臂运动扩展分成多个非对称单模块平移旋转的叠加操作;步骤3,根据Denavit‑Hartenberg方程,设计主动杆长参数L={L<sub>1</sub>,L<sub>2</sub>,L<sub>3</sub>}与角度参数Θ={θ<sub>1</sub>,θ<sub>2</sub>,θ<sub>3</sub>}之间的函数关系;步骤4,根据前向运动学约束方程,展开为超越方程,利用角度参数的变换,获得致密的多项式方程;步骤5,根据代数对消方法,利用参数迭代的方式求解最终的多项式方程,由于角度参数约束条件的限制,从多个多项式方程解中获得唯一可行解;步骤6,根据几何辅助线分析方法,获取关键节点的角度参数表达式,利用多项式方程解,计算角度表达式中的关键节点A<sub>2</sub>,B<sub>2</sub>,C<sub>2</sub>;步骤7,分析该非对称并联变结构的几何结构,获得变结构的内在三角拓扑关系X,n;根据变几何桁架操作臂的运动末端位姿向量表达式,计算期望位置X,方向n;步骤8,根据上述开环操作过程,利用目标位姿信息,实现目标位姿的初步定位。 |