燕山大学 已有样品
更新于2024-08-06 10:57:32
本发明公开一种含UP副支链的并联机构的运动学正解求解方法,其包括以下步骤:S1:在UP支链的U副的两个转轴上安装角度传感器;S2:建立分支坐标系;S3:建立定坐标系和动坐标系;S4:在初始状态各坐标系位姿关系已知的条件下,建立它们之间的位姿坐标关系;S5:构建并联机构各个分支杆长约束方程;S6:结合U副上的角度传感器测得的数据,分析UP支链,确定动平台上的分支坐标系原点在空间的位置矢量;S7:根据闭环矢量方程,构造分支杆长表达式;S8:结合S5构造并联机构的求解位置正解方程组;S9:求出位置正解求解式;S10:得到位置正解唯一解。本发明所提方法通过测量U副的转角值,可将高次方程简化,整个求解过程简单高效、具有普遍适用性。