三轴惯性陀螺测试转台控制系统的研制

1、25/25三轴惯性陀螺测试转台控制系统的研制摘要：介绍了三轴惯性陀螺测试转台的工作方式及其控制系统的功能，研究了以单片机为系统控制核心的转台控制器的硬件及软件设计问题，提出了采用单片机及 定时计数器对步进电机进行开环位置及速度控制的解决方案。 关键词：陀螺测试转台 单片机 步进电机 运动控制导航系统是飞行器的重要组成部分。惯性陀螺仪表普遍应用于各种类型的飞行器的导航系统中，它反映了飞行器的飞行姿态以及其它重要导航信息，保证了人为或自动驾驶仪对飞行器进行控制的安全性与准确性。为了确保惯性陀螺仪表工作的可靠性，需要对仪表进行定期的校验，用测试转台测试陀螺仪表是比较常用的方法。某机场所使用的测试转台

2、大部分存在老化严重以及功能单一的问题，尤其是部分转台还是老式的手动转台，很难保证校准精度，所以需要研制新型数字化的低成本的高精度陀螺测试转台及其控制系统。 陀螺测试转台及其控制系统介绍陀螺测试转台主要由高精度转台及其控制系统组成。三轴转台由轴转台、轴转台、轴转台三个子系统组成，分别实现三个轴的转动。各子系统由台体、驱动系统、转动系统以及执行机构组成。选用步进电机作为各子系统驱动装置，经蜗轮蜗杆及齿轮减速后输出旋转运动。转台的三个子系统中，轴转台固定在轴转台的转盘上，轴转台固定在轴转台的转盘上。将被测试陀螺仪表固定于轴转台的转盘上，按测试要求控制转台各轴进行旋转，模拟飞机飞行中的各种姿态，陀螺仪

3、表则输出相应的姿态信息，比较转台的姿态与仪表的输出即可校对仪表偏差。各子系统的运转由其控制器控制。控制器的主要功能是接收操作人员的控制指令，对控制面板输入的控制参数进行计算或转换，变为步进电机的运转控制信号，输出到测试转台；转台在控制器的控制下可工作在速度、转角、自动等模式；转台控制器能够与上位计算机进行串行通讯，并执行上位计算机的控制指令。转台与控制器之间通过航空插头连接起来，其传输的信号包括步进电机的驱动信号和惯性陀螺仪的反馈信号。 转台控制系统的硬件设计转台控制系统主要由面板控制模块、控制面板及液晶显示屏、各子系统轴控模块、步进电机驱动器和机箱、电源等组成，图为系统硬件组成示意图。面板控

4、制模块和各子系统轴控模块均采用 单片机作为控制核心。液晶屏采用 公司生产的液晶显示屏及其控制电路，其显示具有字符和图形显示特区，通过字符发生器不仅可以调用固化的种点阵字符，还可以扩展其它需要的字符。步进电机驱动器采用公司的两相步进电机驱动器。 控制面板的管理面板控制模块选用四片通用扩展并口作为单片机与各子系统轴模块和面板按键、指示灯之间的接口。单片机的口作为数据传输端口，口作为各的片选及端口选择地址。与各子系统轴模块通讯的三片的口和口分别作为数据的发送口和接收口，口提供握手信号。单片机的串口通过 电平转换电路与上位计算机的串口连接。 面板模块与轴控模块的通信面板模块与轴控模块之间通过两片完成运

5、转参数和状态信息的传递。图所示为轴控模块与面板模块的接口电路示意图。电路中使用了触发器，通过发送、查询、接收、置位等方式，控制数据在两片之间传输。触发器的输出信号作为面板模块向轴控模块传送数据的状态标志位，当为“”时表示面板模块所要传送的数据已经准备好，为“”时表示数据已被轴控模块接收或数据未到达状态。触发器由面板模块的和轴控模块的共同控制，由面板的和轴控模块的查询的状态。同理，触发器控制由轴控模块发送到面板模块的数据，的输出值表示数据传送的状态。 步进电机脉冲产生及控制电路系统采用定时计数器产生控制步进电机运转的方波脉冲，并对输出脉冲进行计数。将的计数器设定在方波发生器工作方式，计数器设定在

6、计数器方式。图为用分频产生控制脉冲的原理图。由内部定时计数器产生的方波脉冲送入计数器进行分频并输出控制脉冲。计数器对输出的脉冲进行计数。当脉冲数与计数器的计数值相等时计数器的输出端产生电平变化，并被的口监测查询。当的晶体振荡频率为时，通过调节其和的值可使其定时计数器产生的方波脉冲。通过对计数器的数据寄存器写入分频值，使其输出相应频率的方波脉冲来控制步进电机的转速，计数器通过记录计数器输出的脉冲数量来控制电机的转角。步进电机的输出转速由下式决定：fo/N(度秒)()步距角360/(200im)（度脉冲）()式中，步进电机旋转一周的步数为；为转台传动机构减速比；为步进电机驱动器细分数；为输入的脉冲

7、源频率；为分频数，即写入计数器的值。表1 各轴分频值N的设定转 轴转速范围/sim(度/脉冲)分频数N高速（fo=6MHz）低速(=10kHz)轴0.015020500.0018216635291121800轴0.055480500.000075909000-轴0.055280500.0001285715415428-各子系统写入计数器的分频值如表所示。由于对计数器写入的分频值只能为正整数，而通过计算得出的分频值不一定为正整数，因此要对输入计数器的分频值进行四舍五入。产生的驱动脉冲频率大小具有舍入误差，其大小不超过：(1/2)/N ()三轴的最小分频值（轴），转速最大误差为。 转台控制系统的软

8、件设计面板模块软件的设计面板模块程序流程图如图所示。上电开始后，软件首先对的内部寄存器、液晶显示屏以及并口进行初始化。程序用一个字节作为系统工作状态寄存器，寄存器中各标志位分别记录串口以及面板的锁定及解锁情况以及各运转轴的当前运转方向和高低速状态。液晶显示初始化设定的显示边界及范围，以及清空液晶显示模块显存。串行通讯的波特率定为。面板初始化完成后，软件将同时检测面板各按键信号并等待串口的中断信号，当检测到一种信号后，将另一种信号屏蔽。在“轴（或轴、轴）”键按下后，系统锁定在面板工作方式，并关闭串口中断。进入面板工作方式后，软件按流程执行转轴选择、模式设定、参数设定、运转执行等功能。控制面板按键

9、包括、轴选择键，运转模式选择键，数字键，确定、停止键以及手动控制键。读取控制面板按键信号后，将选取的运转轴、运转模式以及设定的速度角度等参数记录于指定的寄存器中。待软件检测到“运行”键按下后，将数据送入与相应轴通讯的寄存器中，并将该的位置高，通知轴控模块读取。面板控制模块与上位计算机之间制定了串行通讯协议。串行通讯指令采用码的形式，上位计算机指令和控制器返回信息都以“”字符开头。面板模块检测到串口接收到字符“”时，则认为上位计算机开始发送信息，信息以回车符结束。“”后面是转轴标识符，用“”或“”或“”表示，分别对应、三个转轴。转轴标识符后依次为速度、转角、时间的码表示值。程序将接收到的上位控制

10、指令中的码参数值转换为轴控模块可识别的十六进制参数值，并发送到相应的轴控模块。 轴控模块软件的设计子系统轴控模块程序流程图如图所示。程序开始后先初始化各口和各计数器的工作方式。软件通过查询的口，检测是否得到了由面板模块发送来的数据。轴控模块接收到面板模块发来的指令后，将速度、角度数据经计算转换成为计数器的分频值和计数器所需要记录的脉冲数。参数转换完成后，程序根据设定指令进入相应运转模式。当各转轴转速达到或超过时，为了使步进电机在有外加负载及高速运转下不丢步，确保在高速启动或停止时保持稳定，程序对步进电机的高速启动和停止进行了加减速控制。程序采用匀加减速方法。由式()可知，分频值是角速度的反比例

11、函数，设定为加速过程的初始速度和减速过程的最终速度，并设定加减速过程中每隔速度差值，所以有：(f0)/1(f0)/2(f0)/21N1/2(f1)/i(f0)/i1N1/i即每经过延时循环送给定时器的分频值就是将对应的分频值除以当前的循环次数得到的。程序将每一步加减速送入的值保存到起始地址为的内存单元中，制成分频值的数表。在加速过程中，依次将分频值送入计数器中，一直到从数表中读入的分频数不大于设定速度对应的分频值，并将作为最终分频值为止。减速过程则与加速过程相反。摘要：介绍了三轴惯性陀螺测试转台的工作方式及其控制系统的功能，研究了以单片机为系统控制核心的转台控制器的硬件及软件设计问题，提出了采

12、用单片机及 定时计数器对步进电机进行开环位置及速度控制的解决方案。 关键词：陀螺测试转台 单片机 步进电机 运动控制导航系统是飞行器的重要组成部分。惯性陀螺仪表普遍应用于各种类型的飞行器的导航系统中，它反映了飞行器的飞行姿态以及其它重要导航信息，保证了人为或自动驾驶仪对飞行器进行控制的安全性与准确性。为了确保惯性陀螺仪表工作的可靠性，需要对仪表进行定期的校验，用测试转台测试陀螺仪表是比较常用的方法。某机场所使用的测试转台大部分存在老化严重以及功能单一的问题，尤其是部分转台还是老式的手动转台，很难保证校准精度，所以需要研制新型数字化的低成本的高精度陀螺测试转台及其控制系统。 陀螺测试转台及其控制

13、系统介绍陀螺测试转台主要由高精度转台及其控制系统组成。三轴转台由轴转台、轴转台、轴转台三个子系统组成，分别实现三个轴的转动。各子系统由台体、驱动系统、转动系统以及执行机构组成。选用步进电机作为各子系统驱动装置，经蜗轮蜗杆及齿轮减速后输出旋转运动。转台的三个子系统中，轴转台固定在轴转台的转盘上，轴转台固定在轴转台的转盘上。将被测试陀螺仪表固定于轴转台的转盘上，按测试要求控制转台各轴进行旋转，模拟飞机飞行中的各种姿态，陀螺仪表则输出相应的姿态信息，比较转台的姿态与仪表的输出即可校对仪表偏差。各子系统的运转由其控制器控制。控制器的主要功能是接收操作人员的控制指令，对控制面板输入的控制参数进行计算或转

14、换，变为步进电机的运转控制信号，输出到测试转台；转台在控制器的控制下可工作在速度、转角、自动等模式；转台控制器能够与上位计算机进行串行通讯，并执行上位计算机的控制指令。转台与控制器之间通过航空插头连接起来，其传输的信号包括步进电机的驱动信号和惯性陀螺仪的反馈信号。 转台控制系统的硬件设计转台控制系统主要由面板控制模块、控制面板及液晶显示屏、各子系统轴控模块、步进电机驱动器和机箱、电源等组成，图为系统硬件组成示意图。面板控制模块和各子系统轴控模块均采用 单片机作为控制核心。液晶屏采用 公司生产的液晶显示屏及其控制电路，其显示具有字符和图形显示特区，通过字符发生器不仅可以调用固化的种点阵字符，还可

15、以扩展其它需要的字符。步进电机驱动器采用公司的两相步进电机驱动器。 控制面板的管理面板控制模块选用四片通用扩展并口作为单片机与各子系统轴模块和面板按键、指示灯之间的接口。单片机的口作为数据传输端口，口作为各的片选及端口选择地址。与各子系统轴模块通讯的三片的口和口分别作为数据的发送口和接收口，口提供握手信号。单片机的串口通过 电平转换电路与上位计算机的串口连接。 面板模块与轴控模块的通信面板模块与轴控模块之间通过两片完成运转参数和状态信息的传递。图所示为轴控模块与面板模块的接口电路示意图。电路中使用了触发器，通过发送、查询、接收、置位等方式，控制数据在两片之间传输。触发器的输出信号作为面板模块向

16、轴控模块传送数据的状态标志位，当为“”时表示面板模块所要传送的数据已经准备好，为“”时表示数据已被轴控模块接收或数据未到达状态。触发器由面板模块的和轴控模块的共同控制，由面板的和轴控模块的查询的状态。同理，触发器控制由轴控模块发送到面板模块的数据，的输出值表示数据传送的状态。 步进电机脉冲产生及控制电路系统采用定时计数器产生控制步进电机运转的方波脉冲，并对输出脉冲进行计数。将的计数器设定在方波发生器工作方式，计数器设定在计数器方式。图为用分频产生控制脉冲的原理图。由内部定时计数器产生的方波脉冲送入计数器进行分频并输出控制脉冲。计数器对输出的脉冲进行计数。当脉冲数与计数器的计数值相等时计数器的输

17、出端产生电平变化，并被的口监测查询。当的晶体振荡频率为时，通过调节其和的值可使其定时计数器产生的方波脉冲。通过对计数器的数据寄存器写入分频值，使其输出相应频率的方波脉冲来控制步进电机的转速，计数器通过记录计数器输出的脉冲数量来控制电机的转角。步进电机的输出转速由下式决定：fo/N(度秒)()步距角360/(200im)（度脉冲）()式中，步进电机旋转一周的步数为；为转台传动机构减速比；为步进电机驱动器细分数；为输入的脉冲源频率；为分频数，即写入计数器的值。表1 各轴分频值N的设定转 轴转速范围/sim(度/脉冲)分频数N高速（fo=6MHz）低速(=10kHz)轴0.015020500.001

18、8216635291121800轴0.055480500.000075909000-轴0.055280500.0001285715415428-各子系统写入计数器的分频值如表所示。由于对计数器写入的分频值只能为正整数，而通过计算得出的分频值不一定为正整数，因此要对输入计数器的分频值进行四舍五入。产生的驱动脉冲频率大小具有舍入误差，其大小不超过：(1/2)/N ()三轴的最小分频值（轴），转速最大误差为。 转台控制系统的软件设计面板模块软件的设计面板模块程序流程图如图所示。上电开始后，软件首先对的内部寄存器、液晶显示屏以及并口进行初始化。程序用一个字节作为系统工作状态寄存器，寄存器中各标志位分别

19、记录串口以及面板的锁定及解锁情况以及各运转轴的当前运转方向和高低速状态。液晶显示初始化设定的显示边界及范围，以及清空液晶显示模块显存。串行通讯的波特率定为。面板初始化完成后，软件将同时检测面板各按键信号并等待串口的中断信号，当检测到一种信号后，将另一种信号屏蔽。在“轴（或轴、轴）”键按下后，系统锁定在面板工作方式，并关闭串口中断。进入面板工作方式后，软件按流程执行转轴选择、模式设定、参数设定、运转执行等功能。控制面板按键包括、轴选择键，运转模式选择键，数字键，确定、停止键以及手动控制键。读取控制面板按键信号后，将选取的运转轴、运转模式以及设定的速度角度等参数记录于指定的寄存器中。待软件检测到“

20、运行”键按下后，将数据送入与相应轴通讯的寄存器中，并将该的位置高，通知轴控模块读取。面板控制模块与上位计算机之间制定了串行通讯协议。串行通讯指令采用码的形式，上位计算机指令和控制器返回信息都以“”字符开头。面板模块检测到串口接收到字符“”时，则认为上位计算机开始发送信息，信息以回车符结束。“”后面是转轴标识符，用“”或“”或“”表示，分别对应、三个转轴。转轴标识符后依次为速度、转角、时间的码表示值。程序将接收到的上位控制指令中的码参数值转换为轴控模块可识别的十六进制参数值，并发送到相应的轴控模块。 轴控模块软件的设计子系统轴控模块程序流程图如图所示。程序开始后先初始化各口和各计数器的工作方式。

21、软件通过查询的口，检测是否得到了由面板模块发送来的数据。轴控模块接收到面板模块发来的指令后，将速度、角度数据经计算转换成为计数器的分频值和计数器所需要记录的脉冲数。参数转换完成后，程序根据设定指令进入相应运转模式。当各转轴转速达到或超过时，为了使步进电机在有外加负载及高速运转下不丢步，确保在高速启动或停止时保持稳定，程序对步进电机的高速启动和停止进行了加减速控制。程序采用匀加减速方法。由式()可知，分频值是角速度的反比例函数，设定为加速过程的初始速度和减速过程的最终速度，并设定加减速过程中每隔速度差值，所以有：(f0)/1(f0)/2(f0)/21N1/2(f1)/i(f0)/i1N1/i即每

22、经过延时循环送给定时器的分频值就是将对应的分频值除以当前的循环次数得到的。程序将每一步加减速送入的值保存到起始地址为的内存单元中，制成分频值的数表。在加速过程中，依次将分频值送入计数器中，一直到从数表中读入的分频数不大于设定速度对应的分频值，并将作为最终分频值为止。减速过程则与加速过程相反。 性能指标及结论表列出了控制器控制转台运转的模式及技术指标。经过调试运行，测试转台能够在规定模式下按要求运转。转台控制器交互性良好，每次输入指令前液晶屏上都有信息提示相应操作。各轴子系统在高速下经加减速后均运转平稳，无丢步现象。同时，能够利用上位计算机的图形界面设定运转指令参数，并通过串口发送指令给转台控制器，控制转台运转。以单片机为控制核心的三轴惯性陀螺测试转台及其控制系统的研制，不仅使测试设备成本降低，而且在测试功能、测试指标及测试精度上均满足了仪表校验的要求。表2 控制器控制功能及指标功 能说 明指 标速度模式控制转台各轴按指定的速度和时间段运转轴子系统：0.01/s50/s轴子系统：0.01/s5/s轴子系统：0.01/s5/s位置模式控制转台轴按指定的速度运转某一角度各子系统转角苗：0.01999自动模式设定转台各轴运转的速度和时间，在此时间内各轴按指定的速