一种空间多自由度定位装置及其空间位置解算方法制造方法及图纸

本发明专利技术公开了一种空间多自由度定位装置及其空间位置解算方法。所述装置包括底板平台、第一三维转台、第二三维转台、第一转台底座、第二转台底座、伺服电机、丝杠和导轨，导轨铺设在底板平台上，第一三维转台安设在第一转台底座上，第一转台底座固定在底板平台的一端，第二三维转台安设在第二转台底座上，第二转台底座可以沿导轨做靠近或远离第一转台底座的运动，两个目标物体分别固定在第一三维转台和第二三维转台上。所述空间位置解算方法根据本发明专利技术装置的机械结构特点，通过固定在夹具上两物体间期望的空间位置姿态关系解算出装置上每个运动部件的运动量。本发明专利技术能够实现空间中两个物体之间的复杂相对位置姿态的定位。

A Spatial Multi-DOF Location Device and Its Spatial Position Solution Method

The invention discloses a spatial multi-degree-of-freedom positioning device and a spatial position calculation method thereof. The device comprises a bottom platform, a first three-dimensional turntable, a second three-dimensional turntable, a first turntable base, a second turntable base, a servo motor, a screw and a guide rail. The guide rail is laid on the bottom platform, the first three-dimensional turntable base is laid on the first turntable base, the first turntable base is fixed at one end of the bottom platform, the second three-dimensional turntable is laid on the second turntable base, and the second turntable is laid on the first turntable base. The base can move close to or far from the base of the first turntable along the guide rail. The two target objects are fixed on the first three-dimensional turntable and the second three-dimensional turntable respectively. According to the mechanical structure characteristics of the device, the method calculates the motion of each moving part of the device by the desired spatial position and attitude relationship between the two objects fixed on the fixture. The invention can realize the location of complex relative position and attitude between two objects in space.

【技术实现步骤摘要】
一种空间多自由度定位装置及其空间位置解算方法
本专利技术属于部件空间定位领域，特别涉及了一种空间多自由度定位装置及其空间位置解算方法。
技术介绍
现代工业、国防及航空航天等领域中某些场合需要模拟出两个物体间的空间位置姿态关系，以方便测量、定位、组装和设计等。在宇宙空间中航天飞行器之间经常要做出特定的相对位置姿态以完成某项工作，例如两个卫星之间的对接、空间站中伸出的机械臂需要抓住远处的某个物体、两个飞船要以特定的姿态与转角做相对运动等，这些在前期都需要大量的模拟。由于科技水平的限制，目前人类不可能前往太空做实验，因此在地面实验室就需要有可以模拟飞行器与飞行器之间空间位置姿态关系的设备。另外一些工业应用，如雷达、导弹跟踪做俯仰、偏航、翻滚运动的飞行器、一些发动机管路系统设计等，都需要能够做出空间多自由度运动的设备进行辅助设计。现有的定位装置一般用于水管、燃气管道的安装，这类管道的管接头一般不需要在空间中有复杂的位置姿态关系，因此上述定位装置实现不了模拟三维空间内了两个物体之间的位置姿态，不适用于上述应用背景。
技术实现思路
为了解决上述
技术介绍
提出的技术问题，本专利技术旨在提供一种空间多自由度定位装置及其空间位置解算方法，实现空间中两个物体之间的复杂相对位置姿态的定位。为了实现上述技术目的，本专利技术的技术方案为：一种空间多自由度定位装置，包括底板平台、第一三维转台、第二三维转台、第一转台底座、第二转台底座、伺服电机、丝杠和导轨，所述导轨铺设在底板平台上，第一三维转台安设在第一转台底座上，第一转台底座固定在底板平台的一端，第二三维转台安设在第二转台底座上，所述伺服电机设置在第一转台底座的内部，丝杠的顶端和底端通过支撑座固定在底板平台上，且丝杠与导轨平行，丝杠的顶端通过联轴器与伺服电机轴相连，丝杠上设有螺母座，当丝杠旋转时，螺母座沿丝杠移动，第二转台底座固定在螺母座上，导轨上设有能沿导轨滑动的滑块，且该滑块安装在第二转台底座底部，使得第二转台底座能够在导轨上滑动，在伺服电机带动下，第二转台底座带着第二三维转台沿着导轨滑动，两个目标物体分别固定在第一三维转台和第二三维转台上。进一步地，该装置还包括第一夹具、第一夹具底座、第二夹具和第二夹具底座，所述第一夹具底座和第二夹具底座分别安设在第一三维转台和第二三维转台的中央，第一夹具和第二夹具分别安设在第一夹具底座和第二夹具底座上，两个目标物体分别固定在第一夹具和第二夹具上。进一步地，第一三维转台和第二三维转台均能实现俯仰、偏航和翻滚三个自由度的运动，通过伺服电机和丝杠能够控制第一三维转台和第二三维转台之间的距离，从而实现七个自由度的运动。基于上述空间多自由度定位装置的空间位置解算方法，为每个目标部件标定X、Y和Z轴，设两个目标部件处的坐标系分别为{A}和{B}，这两个坐标系间的坐标变换矩阵为ATB，这是一个给定的4×4矩阵，表示空间两个物体的相对位置和姿态；设第一三维转台和第二三维转台的回转中心处的坐标系分别为{A’}和{B’}，则这两个坐标系中的X、Y和Z三个坐标轴即对应三维转台的三个转轴，三维转台可分别绕这三个轴做俯仰、偏航和翻滚运动；设{A’}坐标系的Z轴、Y轴、X轴的转角分别为α1、β1、γ1，即第一三维转台的俯仰、偏航和翻滚的角度，{B’}坐标系的Z轴、Y轴、X轴的转角分别为α2、β2、γ2，即第二三维转台的俯仰、偏航和翻滚的角度，{A’}、{B’}两坐标系间距离为L，即两套三维转台中心处的距离，设两套三维转台处于零位时的基坐标系分别为{A”}和{B”}，la和lb分别为零位置时{A}相对{A”}的偏移距离和{B}相对于{B”}的偏移距离；设{B”}的原点为P，即P点在{B”}内的坐标为B”P＝[0000]T，则BP＝BTB'B'P＝BTB'[RZ(α2)RY(β2)RX(γ2)]-1B”P＝[lb000]T其中，BP、B'P分别为P点在{B}、{B’}内的坐标，BTB'为{B}和{B’}之间的坐标变换矩阵，RZ(*)、RY(*)和RX(*)分别为绕Z、Y和X轴旋转的变换矩阵；引入中间变量m、n、k：根据得A”P＝A”TB”B”P＝[L001]T，而其中，AP、A'P、A”P分别为P点在{A}、{A’}、{A”}内的坐标，A”TB”表示{A”}与{B”}之间的坐标变换矩阵；联立得方程组：k(sinα1sinγ1+cosα1cosγ1sinβ1)-n(cosγ1sinα1-cosα1sinβ1sinγ1)+cosα1cosβ1la+cosα1cosβ1m＝L(1)n(cosα1cosγ1+sinα1sinβ1sinγ1)-k(cosα1sinγ1-sinβ1cosγ1sinα1)+cosβ1sinα1la+cosβ1sinα1m＝0(2)kcosβ1cosγ1-msinβ1-lasinβ1+ncosβ1sinγ1＝0(3)预先给定α1、β1、γ1、L这4个变量中的其中一个变量的值，代入上述方程组，得到方程组的解，即其余3个变量的值；然后将α1、β1、γ1、L代入以下方程，解出α2、β2、γ2：(A”TB”)-1RZ(α1)RY(β1)RX(γ1)A'TAATB(B'TB)-1＝RZ(α2)RY(β2)RX(γ2)(4)其中，A'TA表示{A}和{A’}之间的坐标变换矩阵；至此7个自由度变量全部解出。进一步地，在α1、β1、γ1、L这4个变量中预先给定γ1的值，代入方程(1)-(4)，从而求解出另外6个变量的值；根据装置结构知L≥la+lb，当方程组解得|L|＜la+lb时，重新给定γ1的值求解方程组，当方程组解得L＜-(la+lb)时，令α1＝α1+180°，再重新计算L，使之最终满足L≥la+lb的条件。采用上述技术方案带来的有益效果：本专利技术提出的空间多自由度定位装置的结构，其中每套三维转台可以做出独立的俯仰、偏航和翻滚三个自由度的运动，而伺服电机可以牵引移动转台在底板平台上沿导轨做水平运动，这就可以改变两个三维转台间的距离，于是整套装置可以做出空间七个自由度的运动，因此由两套三维转台上夹具固定的两个物体之间可以在空间中做出任意的相对位置姿态。通过本专利技术提出的空间位置解算方法来控制装置，可以保证两个物体之间期望的相对位置姿态经过装置的一次性运动形成。附图说明图1为空间多自由度定位装置的结构示意图；图2为空间多自由度定位装置的零位示意图；图3为空间多自由度定位装置的坐标系标定示意图；图4为空间位置解算方法流程图；图5为空间多自由度定位装置执行某一工序后的示意图。具体实施方式以下将结合附图，对本专利技术的技术方案进行详细说明。本专利技术设计的空间多自由度定位装置，如图1所示，包括底板平台1；第一三维转台201、第二三维转台202；第一转台底座301、第二转台底座302；丝杠4；伺服电机5；第一夹具601、第二夹具602；第一夹具底座701、第二夹具底座702；导轨8。空间多自由度定位装置的初始状态如图2所示，本专利技术中将这种状态称作零位状态，此时两套三维转台的状态如110和120所示，两套三维转台各个轴的运动量为0。两个夹具底座处于水平状态，并且两个夹具水平贴靠在一起，如400所示。在定位装置上建立如图3所示的坐标系，在上位机的人机交互界面中输入给定的代表两个目标物体空间本文档来自技高网...

【技术保护点】
1.一种空间多自由度定位装置，其特征在于：该装置包括底板平台、第一三维转台、第二三维转台、第一转台底座、第二转台底座、伺服电机、丝杠和导轨，所述导轨铺设在底板平台上，第一三维转台安设在第一转台底座上，第一转台底座固定在底板平台的一端，第二三维转台安设在第二转台底座上，所述伺服电机设置在第一转台底座的内部，丝杠的顶端和底端通过支撑座固定在底板平台上，且丝杠与导轨平行，丝杠的顶端通过联轴器与伺服电机轴相连，丝杠上设有螺母座，当丝杠旋转时，螺母座沿丝杠移动，第二转台底座固定在螺母座上，导轨上设有能沿导轨滑动的滑块，且该滑块安装在第二转台底座底部，使得第二转台底座能够在导轨上滑动，在伺服电机带动下，第二转台底座带着第二三维转台沿着导轨滑动，两个目标物体分别固定在第一三维转台和第二三维转台上。

【技术特征摘要】
1.一种空间多自由度定位装置，其特征在于：该装置包括底板平台、第一三维转台、第二三维转台、第一转台底座、第二转台底座、伺服电机、丝杠和导轨，所述导轨铺设在底板平台上，第一三维转台安设在第一转台底座上，第一转台底座固定在底板平台的一端，第二三维转台安设在第二转台底座上，所述伺服电机设置在第一转台底座的内部，丝杠的顶端和底端通过支撑座固定在底板平台上，且丝杠与导轨平行，丝杠的顶端通过联轴器与伺服电机轴相连，丝杠上设有螺母座，当丝杠旋转时，螺母座沿丝杠移动，第二转台底座固定在螺母座上，导轨上设有能沿导轨滑动的滑块，且该滑块安装在第二转台底座底部，使得第二转台底座能够在导轨上滑动，在伺服电机带动下，第二转台底座带着第二三维转台沿着导轨滑动，两个目标物体分别固定在第一三维转台和第二三维转台上。2.根据权利要求1所述空间多自由度定位装置，其特征在于：该装置还包括第一夹具、第一夹具底座、第二夹具和第二夹具底座，所述第一夹具底座和第二夹具底座分别安设在第一三维转台和第二三维转台的中央，第一夹具和第二夹具分别安设在第一夹具底座和第二夹具底座上，两个目标部件分别固定在第一夹具和第二夹具上。3.根据权利要求1所述空间多自由度定位装置，其特征在于：第一三维转台和第二三维转台均能实现俯仰、偏航和翻滚三个自由度的运动，通过伺服电机和丝杠能够控制第一三维转台和第二三维转台之间的距离，从而实现七个自由度的运动。4.基于权利要求1所述空间多自由度定位装置的空间位置解算方法，其特征在于：为每个目标部件标定X、Y和Z轴，设两个目标部件处的坐标系分别为{A}和{B}，这两个坐标系间的坐标变换矩阵为ATB，这是一个给定的4×4矩阵，表示空间两个物体的相对位置和姿态；设第一三维转台和第二三维转台的回转中心处的坐标系分别为{A’}和{B’}，则这两个坐标系中的X、Y和Z三个坐标轴即对应三维转台的三个转轴，三维转台可分别绕这三个轴做俯仰、偏航和翻滚运动；设{A’}坐标系的Z轴、Y轴、X轴的转角分别为α1、β1、γ1，即第一三维转台的俯仰、偏航和翻滚的角度，{B’}坐标系的Z轴、Y轴、X轴的转角分别为α2、β2、γ2，即第二三维转台的俯仰、偏航和翻滚的角度，{A’}、{B’}两坐标系间距离为L，即两套三维转台中心处的距离，设...

【专利技术属性】
技术研发人员：付兴贺，陈泽华，刘凯，
申请(专利权)人：东南大学，
类型：发明
国别省市：江苏,32