一种适用于坦克动力舱装配的六自由度并联调姿机构逆解方法技术

本发明专利技术公开了一种适用于坦克动力舱装配的六自由度并联调姿机构逆解方法，属于位移传感器技术领域，包括建立六自由度并联调姿平台的数学模型，根据四个工艺球和四个定位器建立笛卡尔坐标系P{x,y,z}和O{X，Y，Z}，然后根据工艺球的球绞点在底部笛卡尔坐标系O中的矢量公式和定位器j个驱动轴位移逆解公式计算出底部平台上的第一定位器、第二定位器、第三定位器和第四定位器分别在空间坐标系中x，y，z三个方向上的理论轴向位移，解决了提高坦克动力舱装配过程的效率低和精度低的技术问题。

An inverse method for six degree of freedom parallel position adjustment mechanism for tank power cabin assembly

The invention discloses an inverse solution method of six-degree-of-freedom parallel attitude adjusting mechanism suitable for tank power cabin assembly, which belongs to the technical field of displacement sensor, including the establishment of mathematical model of six-degree-of-freedom parallel attitude adjusting platform, the establishment of Cartesian coordinate system P{x, y, z} and O{X, Y, Z} according to four process balls and four locators, and then the establishment of a Cartesian coordinate system P{x, y, Z} Vector formula of spherical twist point in bottom Cartesian coordinate system O and inverse formula of displacement of J driving axes of positioner are used to calculate the theoretical axial displacement of the first positioner, the second positioner, the third positioner and the fourth positioner in the space coordinate system x, y and z, respectively. The technical problems of low efficiency and low accuracy in the assembly process of the kV cabin.

【技术实现步骤摘要】
一种适用于坦克动力舱装配的六自由度并联调姿机构逆解方法
本专利技术属于机器人控制
，特别涉及一种适用于坦克动力舱装配的六自由度并联调姿机构逆解方法。
技术介绍
随着中国军事技术的崛起，军工企业也引来了新一代技术革新。在坦克动力舱装配中，发动机与综合传动箱配合面的轴孔对接的智能化过程，一直是众多工程师们正在解决的工作重点及难点，传统的对接过程费时费力，安装的合格率较低，同时对工人的安全也可能造成一定的伤害，六自由度并联调姿机构可以提高了坦克动力舱装配过程的效率和精度。传统的装配方法自动化程度低、生产效率低下、质量不够稳定、对不同部件适应性差。现有文献研究的并联调姿机构主要分为3个定位器和6个定位器来进行位姿控制，还没有出现通过4定位器进行位姿并联调姿机构的相关研究。
技术实现思路
本专利技术的目的是提供一种适用于坦克动力舱装配的六自由度并联调姿机构逆解方法，解决了基于4定位器的并联调姿机构逆解方法定位的技术问题。为实现上述目的，本专利技术采用以下技术方案：一种适用于坦克动力舱装配的六自由度并联调姿机构逆解方法，包括如下步骤：步骤1：建立六自由度并联调姿平台，六自由度并联调姿平台为矩形调姿平台，其设有第一工艺球、第二工艺球、第三工艺球、第四工艺球、动平台、底部平台、第一定位器、第二定位器、第三定位器和第四定位器，第一定位器、第二定位器、第三定位器和第四定位器均设在底部平台上；四个定位器与四个球铰中小固定；步骤2：建立六自由度并联调姿平台的数学模型，在数学模型中设定端点A1代表第一定位器，端点A2代表第二定位器，端点A3代表第三定位器，端点A4代表第四定位器，端点B1代表第一工艺球、端点B2代表第二工艺球、端点B3代表第三工艺球、端点B4代表第四工艺球，以端点A1、端点A2、端点A3和端点A4为顶点建立四边形A1A2A3A4，在底部平台设立笛卡尔坐标系O{X，Y，Z}，O{X，Y，Z}的原点位于四边形A1A2A3A4的中心点上，O{X，Y，Z}的X轴正方向定义为沿端点A1指向端点A2的方向，O{X，Y，Z}的Z轴正向垂直于底座平面；以端点B1、端点B2、端点B3和端点B4为顶点建立四边形B1B2B3B4，建立调姿系统机构坐标系P{x,y,z}，P{x,y,z}的原点位于四边形B1B2B3B4的中心点上，P{x,y,z}的x轴正向定义为沿端点B1指向端点B2的方向，P{x,y,z}的z轴正向垂直于四边形B1B2B3B4所在平面；步骤3：通过以下公式计算出工艺球的球绞点在定位器参考点中的矢量di：其中为坐标系P{x,y,z}相对于坐标系O{X，Y，Z}的旋转变换矩阵，的求解公式如下：步骤4：第一工艺球、第二工艺球、第三工艺球和第四工艺球相对于第一定位器、第二定位器、第三定位器和第四定位器的距离分别为d1,d2,d3,d4，其d1,d2,d3,d4为根据六自由度并联调姿平台的大小尺寸获得的已知量，端点A1～A4与B1～B4的坐标，在逆运算的实际工程中均为已知量；在初始状态下向量ai与向量bi均可以很容易得到，对应第一定位器、第二定位器、第三定位器和第四定位器的向量a1～a4与向量b1～b4均可作为已知条件，P向量[PxPyPz]为坦克动力舱装配调姿平台的位置坐标；步骤5：根据一下公式计算各个定位器轴向驱动位移：li,j＝diej,i＝1,2,3,4,j＝1,2,3；其中j表示定位器的第j个驱动轴，i表示第i个定位器，即第一定位器、第二定位器、第三定位器和第四定位器中的任意一个，ej为定位器各驱动的单位方向矢量，ej的取值为以下公式计算得出：ex＝[1,0,0]T,ey＝[0,1,0]T,ez＝[0,0,1]T；其中T为矩阵的转置。步骤6：分别计算出第一定位器、第二定位器、第三定位器和第四定位器在X,Y,Z轴上的运动情况：第一定位器在x,y,z方向上的运动为L1(x,y,z)＝Ro*b1+P-a1；第二定位器在x,y,z方向上的运动为L2(x,y,z)＝Ro*b2+P-a2；第三定位器在x,y,z方向上的运动为L3(x,y,z)＝Ro*b3+P-a3；第四定位器在x,y,z方向上的运动为L4(x,y,z)＝Ro*b4+P-a4；步骤7：根据步骤2到步骤6的结论得出底部平台上的第一定位器、第二定位器、第三定位器和第四定位器分别在空间坐标系中x，y，z三个方向上的理论轴向位移。所述位姿表示为所述动平台的位置和姿态，姿态通过围绕所述坐标系P{x,y,z}的x,y,z轴的转动所表示。本专利技术所述的一种适用于坦克动力舱装配的六自由度并联调姿机构逆解方法，解决了基于4定位器的并联调姿机构逆解方法定位的技术问题，降低了生产成本，提高安全性，本专利技术采用4定位器的并联调姿机构逆解方法，比现有文献研究的并联调姿机构主要分为3个定位器更加准确，比6个定位器的成本更加低廉，安全性更高，本专利技术是利用空间向量的内在关系进行研究，大大降低了算法的复杂度，便于计算理解，在MATLAB上得到了验证。附图说明图1是六自由度并联调姿机构的结构示意图；图2是本专利技术的调姿平台的数学模型；图3是本专利技术的调姿平台单一支路矢量链路图；图中：第一定位器1、第二定位器2、第三定位器3、第四定位器4、第一工艺球5、第二工艺球6、第三工艺球7、第四工艺球8、动平台9。具体实施方式如图1-3所示的一种适用于坦克动力舱装配的六自由度并联调姿机构逆解方法，包括如下步骤：步骤1：建立六自由度并联调姿平台，六自由度并联调姿平台为矩形调姿平台，其设有第一工艺球5、第二工艺球6、第三工艺球7、第四工艺球8、动平台9、底部平台、第一定位器1、第二定位器2、第三定位器3和第四定位器4，第一定位器1、第二定位器2、第三定位器3和第四定位器4均设在底部平台上；第一定位器1、第二定位器2、第三定位器3和第四定位器4上均设有一个伸缩杆，第一定位器1的伸缩杆上、第二定位器2的伸缩杆上、第三定位器3的伸缩杆上和第四定位器4的伸缩杆上分别铰接有第一工艺球5、第二工艺球6、第三工艺球7和第四工艺球8，第一工艺球5、第二工艺球6、第三工艺球7和第四工艺球8还均与动平台9铰接；如图1所示，第一工艺球5、第二工艺球6、第三工艺球7和第四工艺球8分别故设在第一定位器1、第二定位器2、第三定位器3和第四定位器4的上边，第一工艺球5、第二工艺球6、第三工艺球7和第四工艺球8均与动平台9铰接。步骤2：建立六自由度并联调姿平台的数学模型，在数学模型中设定端点A1代表第一定位器1，端点A2代表第二定位器2，端点A3代表第三定位器3，端点A4代表第四定位器4，端点B1代表第一工艺球5、端点B2代表第二工艺球6、端点B3代表第三工艺球7、端点B4代表第四工艺球8，以端点A1、端点A2、端点A3和端点A4为顶点建立四边形A1A2A3A4，在底部平台设立笛卡尔坐标系O{X，Y，Z}，O{X，Y，Z}的原点位于四边形A1A2A3A4的中心点上，O{X，Y，Z}的X轴正方向定义为沿端点A1指向端点A2的方向，O{X，Y，Z}的Z轴正向垂直于底座平面；以端点B1、端点B2、端点B3和端点B4为顶点建立四边形B1B2B3B4，建立调姿系统机构坐标系P{x,y,z}，P{x,y,z}的原点位于四边形B1B2B3B4的中心点上，P{x,y本文档来自技高网...

【技术保护点】
1.一种适用于坦克动力舱装配的六自由度并联调姿机构逆解方法，其特征在于：包括如下步骤：步骤1：建立六自由度并联调姿平台，六自由度并联调姿平台为矩形调姿平台，其设有第一工艺球(5)、第二工艺球(6)、第三工艺球(7)、第四工艺球(8)、动平台(9)、底部平台、第一定位器(1)、第二定位器(2)、第三定位器(3)和第四定位器(4)，第一定位器(1)、第二定位器(2)、第三定位器(3)和第四定位器(4)均设在底部平台上；第一工艺球(5)、第二工艺球(6)、第三工艺球(7)和第四工艺球(8)分别设在第一定位器(1)、第二定位器(2)、第三定位器(3)和第四定位器(4)的上方；步骤2：建立六自由度并联调姿平台的数学模型，在数学模型中设定端点A1代表第一定位器(1)，端点A2代表第二定位器(2)，端点A3代表第三定位器(3)，端点A4代表第四定位器(4)，端点B1代表第一工艺球(5)、端点B2代表第二工艺球(6)、端点B3代表第三工艺球(7)、端点B4代表第四工艺球(8)，以端点A1、端点A2、端点A3和端点A4为顶点建立四边形A1A2A3A4，在底部平台设立笛卡尔坐标系O{X，Y，Z}，O{X，Y，Z}的原点位于四边形A1A2A3A4的中心点上，O{X，Y，Z}的X轴正方向定义为沿端点A1指向端点A2的方向，O{X，Y，Z}的Z轴正向垂直于底座平面；以端点B1、端点B2、端点B3和端点B4为顶点建立四边形B1B2B3B4，建立调姿系统机构坐标系P{x,y,z}，P{x,y,z}的原点位于四边形B1B2B3B4的中心点上，P{x,y,z}的x轴正向定义为沿端点B1指向端点B2的方向，P{x,y,z}的z轴正向垂直于四边形B1B2B3B4所在平面；步骤3：通过以下公式计算出工艺球的球绞点在底部笛卡尔坐标系O{X，Y，Z}中的矢量di：...

【技术特征摘要】
1.一种适用于坦克动力舱装配的六自由度并联调姿机构逆解方法，其特征在于：包括如下步骤：步骤1：建立六自由度并联调姿平台，六自由度并联调姿平台为矩形调姿平台，其设有第一工艺球(5)、第二工艺球(6)、第三工艺球(7)、第四工艺球(8)、动平台(9)、底部平台、第一定位器(1)、第二定位器(2)、第三定位器(3)和第四定位器(4)，第一定位器(1)、第二定位器(2)、第三定位器(3)和第四定位器(4)均设在底部平台上；第一工艺球(5)、第二工艺球(6)、第三工艺球(7)和第四工艺球(8)分别设在第一定位器(1)、第二定位器(2)、第三定位器(3)和第四定位器(4)的上方；步骤2：建立六自由度并联调姿平台的数学模型，在数学模型中设定端点A1代表第一定位器(1)，端点A2代表第二定位器(2)，端点A3代表第三定位器(3)，端点A4代表第四定位器(4)，端点B1代表第一工艺球(5)、端点B2代表第二工艺球(6)、端点B3代表第三工艺球(7)、端点B4代表第四工艺球(8)，以端点A1、端点A2、端点A3和端点A4为顶点建立四边形A1A2A3A4，在底部平台设立笛卡尔坐标系O{X，Y，Z}，O{X，Y，Z}的原点位于四边形A1A2A3A4的中心点上，O{X，Y，Z}的X轴正方向定义为沿端点A1指向端点A2的方向，O{X，Y，Z}的Z轴正向垂直于底座平面；以端点B1、端点B2、端点B3和端点B4为顶点建立四边形B1B2B3B4，建立调姿系统机构坐标系P{x,y,z}，P{x,y,z}的原点位于四边形B1B2B3B4的中心点上，P{x,y,z}的x轴正向定义为沿端点B1指向端点B2的方向，P{x,y,z}的z轴正向垂直于四边形B1B2B3B4所在平面；步骤3：通过以下公式计算出工艺球的球绞点在底部笛卡尔坐标系O{X，Y，Z}中的矢量di：其中为坐标系P{x,y,z}相对于坐标系O{X，Y，Z}的旋转变换矩阵，的求解公式如下：其中：坦克动力舱装配调姿平台在α，β，γ为在坐...

【专利技术属性】
技术研发人员：钱荣盛，党海平，方平进，罗海江，邬晨昊，
申请(专利权)人：常州固高智能控制技术有限公司，
类型：发明
国别省市：江苏,32