双驱动六点支承平台设计及调平算法

调平是精密仪器及机械领域常见的-类问题。如经纬仪、陀螺罗盘以及雷达等仪器设备的工作都需要-个水平基准[1 ]。调平对充分发挥这些仪器设备的精度和工作能力，提高其机动性具有重要意义。

因此，作为军事及民用等领域广泛应用的-项基醇术，平台调平受到国内外相关研究人员的普遍关注。

三点支承是精密机械设计中的-个重要概念，它是指不共线的三点可以确定-个平面。因此，具有三个可调支承点的调平机构是-种自然的设计方案，-个容易忽视的问题是：三点支承平台属于欠约束、欠驱动系统。在自然状态下仍具有某些自由度，平台的稳定性差，不利于设备的精度保持；在输入状态下，平台处于欠驱动状态，为实现平台调平，需要考虑平台运动的几何因素及平台支承与底面之间的摩擦力，在控制上比较复杂L4 ]。针对这-问题，提出了-种双驱动六点支承平台，并介绍了该平台的调平算法及实验结果。

1 双驱动六点支承平台历史上有两种六点支承夹具，分别称为 3 V夹具和 Kelvin夹具[6 ]，如图 1和图 2所示。

图 1 3 V夹具Fig.1 3 V clamp图 2 Kelvin夹具Fig.2 Kelvin clamp这两种夹具主要用于精密定位，已经存在 100多年了。它们在自然状态下均具有确定位姿，不存在三点支承结构的欠约束问题。因此，考虑用它来做调平机构的支承。然而这两种夹具均是圆周对称结构 ，加入三个螺旋输入后，在调平时会出现运动干涉，而使用正交结构则有可能避免这-问题。鉴于这些原因，提出了双驱动六点支承平台结构，如图 3所示。

1点球头支图 3 双驱动六点支承平台Fig.3 Leveling stages with six-point supports and two inputs· 88 · 光 学 仪 器 第 35卷该平台仅具有两个直线位移输入组件，减少了驱动元件的数目。所谓六点是指球头 S 与平面形成-点接触，sz与V型槽形成两点接触，s。与锥孔形成 3个非冗余约束点，由此形成六个非冗余接触点。这种约束模式保证了机构的确定位姿和确定运动，由此解决了三点支承平台的欠约束和欠驱动问题。需要说明的是这里的六点是指六个非冗余约束点。

在结构上，双驱动六点支承平台包括动平台、底座、加速度计、直线位移组件以及球头支杆。在电机的驱动下，直线位移组件的球头支承产生直线位移，用以驱动平台转动。球头支杆的球头与底座上的锥孔构成平台的运动支点。

2 调平算法调平的目的是使仪器工作的基准面与水平面重合。所谓水平面是指与重力加速度方向垂直的平面。

因此，调平本质上是使平台的法线与重力加速度方向重合。从这-角度出发，本文提出-种基于重力加速度方向矢量的调平算法。如图4所示平台处于水平状态，则平台法线矢量N与重力加速度方向矢量G重合。如图5所示平台处于非水平状态。此时平台的法线矢量 N与重力加速度矢量G之间存在-个夹角。本质上，如果使平台的法线矢量与重力加速度矢量重合，那么就实现了调平。因此，无需直接关注平台的运动变化，而仅需关注平台的法线矢量与重力加速度矢量是否重合，由此将平台的调平问题转化为平台法线矢量的空间运动变换问题。

皿 图 4 平台水平状态Fig.4 Leveling conditions of stages图 5 平台倾斜状态Fig.5 Tilt conditions of stages平设平台的法线矢量N和重力加速度矢量G分别为：N - ( ) (1)G - ( g g ) (2)设存在过渡矢量M，则平台法线矢量 N绕 轴转动 到过渡矢量M，然后过渡矢量M绕 轴转动 到重力加速度矢量G。且设过渡矢量M-(rn ) ，分别确定平台法线矢量 N和过渡矢量M 在z轴的投影，过渡矢量M和重力加速度矢量G在 轴的投影。令 和 分别表示z轴和 轴方向的单位矢量，则：霹 N-Ⅺ M (3)M - G (4)可得：m - (5) (6)则：m - 、/1- ；-g； (7)第2期 王大志，等：双驱动六点支承平台设计及调平算法 ·89·由此可得过渡矢量：M - ( g ) (8)设法线矢量N绕z轴转动 到过渡矢量M，然后过度矢量M绕Y轴转动 到重力加速度矢量G，Px与Qx分别是N和M 在垂直于z轴方向平面的投影，则：- N- NX0- (0 )Qx-M-xo 慨 0-(0 g 、/1-n -g；)可得转动角度 ：c。 - 二鱼/1-，z ·/ 同理，设 Py和Q 分别是M 和G在垂直 轴方向平面的投影，则Py-M-YoTMYo-( 0 /l- - ) (12)- O'o- (＆ 0 ) (13)可得转动角度 ：。s。 - 墨三± 二堡二重 (14) ∞叩转角 和 的存在证明了仅通过两个输人可以实现平台的调平，同时给出了实现调平的转动角度。

在此基础上编写了调平软件，软件主要包括控制卡初始化，数据采集、平台转角等程序拈。

通过调用初始化函数可对控制卡进行初始化；数据采集拈的功能是为了获取平台的重力加速度数据；平台转角拈可使系统根据转角并通过脉冲当量计算电机需要发送的脉冲数。调平程序流程如图 6所示。

当平台倾角不大于0.002。时即认为平台达到水平，并以此作为程序的判断条件。

3 调平实验调平实验旨在验证两输入调平算法，并对平台重复精度进行测试。调平实验系统主要包括平台本体、加速度计、步进电机、驱动器、控制卡以及 PC机～加速度计量值通过三角关系转化可得角度值，倾角模型如图7所示。

3.1 两输入调平算法验证首先通过传感器测量平台当前的倾角 和0 ，可以将加速度计量值转化为倾角；然后，根据双输入调平算法可计算两驱动器的直线位移 △和 。那么，当两直线驱动器相应的伸长或缩短 △ 和 △ 时，理论上，平台应达到水平，即平(9)(10)(11)图 6 调平程序流程图Fig.6 Flow chart of leveling programaxg sina图7 倾角模型Fig.7 The tilt model第 2期 王大志，等：双驱动六点支承平台设计及调平算法 ·91 ·平台在两个方向的重复精度分别为ax-0.001 o和 -0.001 1。，两个方向的水平重复精度优于0.001 7。。

4 结 论双驱动六点支承平台采用机电式自动调平，水平重复精度优于0.001 7。，调平范围 ±5。。相比于三点支承平台，该平台具有如下几个特点：(1)六点支承结构，即在自然状态下具有确定位姿，在输入状态下具有确定运动，由此解决了传统三点支承平台的欠约束和欠驱动问题；(2)仅使用两个驱动，并可联动输入进行调平，减少了驱动元件的数目，简化了系统的结构；(3)使用加速度计作为传感元件，相对于倾角传感器，该方法更加简单、响应速度快；(4)重力加速度矢量调平算法具有物理概念清晰，数学方法严格的特点，可准确建立平台的运动模型。

此外，本文的工作深化了对调平问题的认识，分析了三点确定-个平面”与调平”的问题。三点可以确定-个平面，但这并不意味着调平需要使用三个脚螺旋。三点确定-个平面仅是-个几何概念，它与物体的调平是不同的两个问题。从运动学的角度，调平是对物体两个转动自由度的调整。

双驱动六点支承平台是-种新型二自由度球面并联机构，动平台的运动属于二自由度定点运动。由于光束在空间的指向仅需两个参数即可确定。因此，平台的这种二自由度定点运动对光束的指向控制具有潜在的应用价值。例如用作大口径反射镜架8 0]或并联光电跟踪平台等，未来将就这方面的研究进行报道。