【精编_推荐】三轴惯性陀螺测试转台控制系统的研制

三轴惯性陀螺测试转台控制系统的研制
摘要：介绍了三轴惯性陀螺测试转台的工作方式及其控制系统的功能，研究了以８０５１单片机为系统控制核心的转台控制器的硬件及软件设计问题，提出了采用８０５１单片机及Ｉｎｔｅｌ８２５４定时／计数器对步进电机进行开环位置及速度控制的解决方案。

关键词：陀螺测试转台单片机步进电机运动控制
导航系统是飞行器的重要组成部分。

惯性陀螺仪表普遍应用于各种类型的飞行器的导航系统中，它反映了飞行器的飞行姿态以及其它重要导航信息，保证了人为或自动驾驶仪对飞行器进行控制的安全性与准确性。

为了确保惯性陀螺仪表工作的可靠性，需要对仪表进行定期的校验，用测试转台测试陀螺仪表是比较常用的方法。

某机场所使用的测试转台大部分存在老化严重以及功能单一的问题，尤其是部分转台还是老式的手动转台，很难保证校准精度，所以需要研制新型数字化的低成本的高精度陀螺测试转台及其控制系统。

１陀螺测试转台及其控制系统介绍
陀螺测试转台主要由高精度转台及其控制系统组成。

三轴转台由ψ轴转台、θ轴转台、φ轴转台三个子系统组成，分别实现三个轴的转动。

各子系统由台体、驱动系统、转动系统以及执行机构组成。

选用步进电机作为各子系统驱动装置，经蜗轮蜗杆及齿轮减速后输出旋转运动。

转台的三个子系统中，θ轴转台固定在
ψ轴转台的转盘上，φ轴转台固定在θ轴转台的转盘上。

将被测试陀螺仪表固定于φ轴转台的转盘上，按测试要求控制转台各轴进行旋转，模拟飞机飞行中的各种姿态，陀螺仪表则输出相应的姿态信息，比较转台的姿态与仪表的输出即可校对仪表偏差。

各子系统的运转由其控制器控制。

控制器的主要功能是接收操作人员的控制指令，对控制面板输入的控制参数进行计算或转换，变为步进电机的运转控制信号，输出到测试转台；转台在控制器的控制下可工作在速度、转角、自动等模式；转台控制器能够与上位计算机进行串行通讯，并执行上位计算机的控制指令。

转台与控制器之间通过航空插头连接起来，其传输的信号包括步进电机的驱动信号和惯性陀螺仪的反馈信号。

２转台控制系统的硬件设计
转台控制系统主要由面板控制模块、控制面板及液晶显示屏、各子系统轴控模块、步进电机驱动器和机箱、电源等组成，图１为系统硬件组成示意图。

面板控制模块和各子系统轴控模块均采用ＡｔｍｅｌＡＴ８９Ｃ５２单片机作为控制核心。

液晶屏采用ＳＥＩＫＯＥＰＳＯＮ公司生产的ＳＥＤ１３３５液晶显示屏及其控制电路，其显示ＲＡＭ具有字符和图形显示特区，通过字符发生器不仅可以调用固化的１６０种点阵字符，还可以扩展其它需要的字符。

步进电机驱动器采用ＲＯＲＺＥ公司的ＲＤ－０２３ＭＳ两相步进电机驱动器。

２．１控制面板的管理
面板控制模块选用四片８２５５通用扩展并口作为单片机与各子系统轴模块和面板按键、指示灯之间的接口。

单片机的Ｐ０口作为数据传输端口，Ｐ２口作为各８２５５的片选及端口选择地址。

与各子系统轴模块通讯的三片８２５５的Ａ口和Ｂ口分别作为数据的发送口和接收口，Ｃ口提供握手信号。

ＡＴ８９Ｃ５２单片机的串口通过１４８８－１４８９ＲＳ２３２电平转换电路与上位计算机的串口连接。

２．２面板模块与轴控模块的通信
面板模块与轴控模块之间通过两片８２５５完成运转参数和状态信息的传递。

图２所示为轴控模块８２５５与面板模块８２５５的接口电路示意图。

电路中使用了ＲＳ触发器７４ＬＳ７４，通过发送、查询、接收、置位等方式，控制数据在两片８２５５之间传输。

触发器１的输出信号Ｑ１作为面板模块８２５５向轴控模块８２５５传送数据的状态标志位，当Ｑ１为“１”时表示面板模块所要传送的数据已经准备好，为“０”时表示数据已被轴控模块接收或数据未到达状态。

触发器１由面板模块８２５５的Ｃ０和轴控模块８２５５的Ｃ４共同控制，由面板８２５５的Ｃ４和轴控模块８２５５的Ｃ０查询Ｑ１的状态。

同理，触发器２控制由轴控模块８２５５发送到面板模块８２５５的数据，Ｑ２的输出值表示数据传送的状态。

２．３步进电机脉冲产生及控制电路
系统采用８２５４定时／计数器产生控制步进电机运转的方波脉冲，并对输出脉
冲进行计数。

将８２５４的计数器０设定在方波发生器工作方式，计数器２设定在计数器方式。

图３为用８２５４分频产生控制脉冲的原理图。

由ＡＴ８９Ｃ５２内部定时／计数器２产生的方波脉冲送入８２５４计数器０进行分频并输出控制脉冲。

计数器２对输出的脉冲进行计数。

当脉冲数与计数器２的计数值相等时计数器２的输出端产生电平变化，并被ＡＴ８９Ｃ５２的Ｐ１．１口监测查询。

当ＡＴ８９Ｃ５２的晶体振荡频率为２４ＭＨｚ时，通过调节其ＲＣＡＰ２Ｈ和ＲＣＡＰ２Ｌ的值可使其定时／计数器２产生９２Ｈｚ～６ＭＨｚ的方波脉冲。

通过对８２５４计数器０的数据寄存器写入分频值Ｎ，使其输出相应频率的方波脉冲来控制步进电机的转速，计数器２通过记录计数器１输出的脉冲数量来控制电机的转角。

步进电机的输出转速由下式决定：
ω＝Δ·fo/N(度／秒)(１)
步距角Δ＝[360/(200·i·m)]（度／脉冲）(２)
式中，步进电机旋转一周的步数为２００；
ｉ为转台传动机构减速比；
ｍ为步进电机驱动器细分数；
ｆ０为输入８２５４的脉冲源频率；
Ｎ为分频数，即写入８２５４计数器０的值。

表1各轴分频值N的设定
转轴转速范围i m Δ(度/脉冲) 分频数N
/s 高速（fo=6MHz）低速(=10kHz) 轴0.01～50 20 50 0.0018 216～63529 112～1800 轴0.05～5 480 50 0.000075 90～9000 --
轴0.05～5 280 50 0.00012857 154～15428 --
各子系统写入８２５４计数器０的分频值如表１所示。

由于对８２５４计数器写入的分频值只能为正整数，而通过计算得出的分频值Ｎ不一定为正整数，因此要对输入８２５４计数器０的分频值进行四舍五入。

产生的驱动脉冲频率大小具有舍入误差，其大小不超过：
±(1/2)/N×１００％(３)
三轴的最小分频值Ｎ＝９０（θ轴），转速最大误差为０．５６％。

３转台控制系统的软件设计
３．１面板模块软件的设计
面板模块程序流程图如图４所示。

上电
开始后，软件首先对ＡＴ８９Ｃ５２的
内部寄存器、液晶显示屏以及８２５５
并口进行初始化。

程序用一个字节作为
系统工作状态寄存器，寄存器中各标志
位分别记录串口以及面板的锁定及解
锁情况以及各运转轴的当前运转方向
和高低速状态。

液晶显示初始化设定Ｌ
ＣＤ的显示边界及范围，以及清空液晶显示模块显存。

串行通讯的波特率定为９６００ｂｉｔ／ｓ。

面板初始化完成后，软件将同时检测面板各按键信号并等待串口的中断信号，当检测到一种信号后，将另一种信号屏蔽。

在“ψ轴（或θ轴、φ轴）”键按下后，系统锁定在面板工作方式，并关闭串口中断。

进入面板工作方式后，软件按流程执行转轴选择、模式设定、参数设定、运转执行等功能。

控制面板按键包括ψ、θ、φ轴选择键，运转模式选择键，数字键，确定、停止键以及手动控制键。

读取控制面板按键信号后，将选取的运转轴、运转模式以及设定的速度角度等参数记录于指定的寄存器中。

待软件检测到“运行”键按下后，将数据送入与相应轴通讯的８２５５寄存器中，并将该８２５５的Ｃ０位置高，通知轴控模块读取。

面板控制模块与上位计算机之间制定了串行通讯协议。

串行通讯指令采用ＡＳＣ。