基于DSP的旋转调制惯导系统电机控制方法

王智覃方君佟林黄春福

（海军工程大学电气工程学院，武汉 430033）

摘要：本文对旋转调制惯导系统的旋转机构电机，设计一种以DSP28335处理器为核心的电机控制方法。通过DSP28335的增强型PWM模块输出电机控制信号，经过光耦隔离后进入封装好的LMD18200直流电机专用驱动芯片控制端口，进而完成对直流力矩电机的无极调速与转向控制。采用Renishow圆光栅作为系统反馈元件，圆光栅与电机转轴固连，其输出的标准正交编码脉冲通过DSP28335的增强型QEP模块采集，进而获得电机转轴的位置与转速信息。检测的电机转速与设定转速的误差作为积分分离PID控制器的输入，通过调整PWM波的占空比完成电机平稳控制。最后预处理计算机再通过串口实现与上位机的通讯。

关键词：惯导系统；旋转调制；电机控制；DSP；PID

中图分类号：U666.12 文献标志码：A

Motor Control Method for Rotary Modulation Inertial Navigation System on Based on DSP

Wang Zhi，QIN Fang-jun，TONG Lin，Huang Chun-fu

（School of Electrical Engineering, Naval University of Engineering, Wuhan 430033 China）

Abstract: In this paper, a motor control method based on DSP28335 processor is designed for the rotary modulation inertial navigation system for the rotating unit body. The motor control signal is outputted by the enhanced PWM module of DSP28335. After optocoupler isolation, it enters the control port of the packaged LMD18200 DC motor driver chip, and then completes the stepless speed regulation and steering control of the DC torque motor. The Renishow circular grating is used as the feedback component of the system. The circular grating is fixed to the motor shaft. The output of the standard quadrature coded pulse is collected by the enhanced QEP module of the DSP28335, and the position and speed information of the motor shaft is obtained.

The error between detected motor speed and the set speed are used as the input of the integral separation PID controller, and the motor smooth control is completed by adjusting the duty ratio of the PWM wave. Finally, the pre-processing computer then communicates with the host computer through the serial port.

Key words: inertail natvigation system; rotary modulation; motor control; DSP; PID

1引言

提高惯性导航系统精度，最根本的方法往往是通过提高惯性器件陀螺仪和加速度计的精度来实现，然而更换现有的惯性元件成本巨大，因此在现有陀螺和加速度计精度的基础上采用旋转调制技术已成为提高导航精度的必然选择。旋转调制技术实质上是采用误差自补偿的方法^[1]，将整个IMU安装在旋转机构上，通过旋转机构绕一个轴或者多个轴周期性转动，使得惯性器件的输出误差呈周期性变化，从而在导航解算过程中得到平均和抑制。而整个旋转调制系统的硬件基础是旋转机构的电机控制，旋转电机控制精度直接影响到导航系统的精度。因此本文针对光纤陀螺的旋转机构采用单轴正反旋转调制方式对电机控制电路进行设计，在不增加成本下提高导航系统精度。

2 系统总体设计

系统选用单轴正反连续旋转方式，旋转轴铅垂，调制水平面内的陀螺仪及加速度计。旋转机构电机采用某公司生产的J78LYX23B直流力矩电机。IMU旋转机构转角和转速反馈采用Renishow公司的圆光栅，其分辨率为，精度为，输出标准正交脉冲。电机核心控制器选用TI公司C2000系列的TMS320F28335DSP板，其内部集成了增强型正交编码脉冲模块(eQEP)，由该模块与光栅配合使用，可以控制电机完成高精度位置反馈和快速响应。

旋转单元体由力矩电机控制，圆形光栅固定于电机转轴上，电机控制DSP的Eqep模块^[2]直接读取光栅输出的正交编码脉冲信号，完成电机的转角与转速测量。同时电机控制DSP要将光栅反馈的转角与转速信息通过SCI完成与预处理机的实时通讯。预处理机将电机控制信号发送到电机控制DSP，该DSP根据接收到的电机控制字通过自带的PWM通道输出其相应占空比的PWM信号完成电机的转速与转向控制^[3]，并且要根据设定的转速和光栅反馈的实时转速的偏差进行PID控制。另外当电流值超出设定值上限，要通过控制继电器切断电机电源，保护电机设备。最后预处理计算机通过串口实现与上位机的通讯。系统总体设计流程如图1所示。

图1 系统总体设计

3 基于PWM信号的电机控制方法

3.1 电机转向与转速控制

PWM控制是指用DSP产生的PWM波去控制由功率开关管组成的H桥电机驱动电路^[4]。H桥驱动部分组件如图2所示，通过控制三极管Q1和Q4同时导通实现电机正转，或者控制Q2和Q3同时导通实现电机反转。但是如果三极管Q1和Q2或Q3和Q4同时导通，那么电流就会从正极穿过两个三极管直接回到负极，短路电流将损坏三极管。因此为了防止误接，常使用一个“使能”信号同四个与门相连控制整个电路的开关，同时为了保证任何时候在H桥的同侧腿上都只有一个三极管能导通，使用两个非门作为方向输入。另外为了为避免电机反电动势的危害，需要在每个晶体管两端接引流二极管。

图2 经典H桥驱动

PWM来控制直流电机转速，一般采用调节电枢电压的方式。实际上PWM的占空比决定输出到直流电机的平均电压，电机的转速取决于平均电压。脉冲宽度越大即占空比越大，提供给电机的平均电压越大，电机转速就高。反之，脉冲宽度越小，则占空比就越小，提供给电机的平均电压越小，电机转速就低。所以PWM波控制电机转速是通过改变比较寄存器的值来改变PWM波占空比进而实现电枢电压的无级连续调节。而直流电机的换向则是通过改变H桥控制电路中功率管的导通顺序实现的。

本系统采用封装好的H桥电机驱动LMD18200芯片。LMD18200是美国国家半导体公司(NS)推出的专用于直流电动机驱动的H桥组件^[4]。芯片上集成有CMOS控制电路和DMOS功率器件，可以与主处理器、电机和光栅构成一个完整的运动控制系统。LMD18200内部集成了四个DMOS管，组成一个标准的H型驱动桥，工作电流2~3A，峰值电流6A 。由于LMD18200芯片工作电压较高，而芯片控制端信号由DSP直接产生，如果电路发生问题，电流可能会直接流入DSP管脚，对处理器造成损害，所以DSP输出的控制信号需经过光耦隔离电路再控制LMD18200芯片，同时光耦隔离电路还可以起到防止电机运行所产生的噪音对处理器及其电路产生影响。LMD18200芯片共有3路控制信号输入口，分别是PWM端口、DIR方向端口和BRAKE刹车端口。DIR高电平正转，低电平反转。BRAKE高电平刹车，低电平工作。PWM端口如果输入高电平则全速运行，如果输入PWM信号则是调速运行。LMD18200驱动芯片真值表见表1。

表1 LMD18200逻辑真值表

PWM	DIR	BRAKE	电机状态
H	H	L	正转
H	L	L	反转
*	*	H	刹车

3.2 PWM的产生

2000系列的DSP之所以能在电气控制领域被广泛使用，除了其DSP内核外，主要是因为集成了众多适合电气检测与控制的外设设备， PWM模块就是其中之一。PWM信号的一个重要用途就是作为数字电机的控制信号，PWM信号通过控制功率开关器件的导通和关闭，达到控制电机的目的。在电机控制系统中采用PWM控制方式可以为电机绕组提供良好的谐波电压和电流，避免电磁干扰，并且能够显著提高功率因数。

F28335的PWM是个加强模块，共有6个ePWM子模块，每个子模块都有两路PWM输出^[5]。本系统只使用其中一个子模块产生PWM波，来实现功率开关器件的开关控制。PWM周期是由时间基准周期寄存器TBPRD和时间基准计数器的工作方式共同确定，而比较寄存器用来确定ePWM的占空比，通过更新比较寄存器CMP的值来改变占空比，进而实现对电机转向和转速控制。PWM软件程序设计如图3所示。而F28335核心处理器输出的PWM控制信号的负载能力有限，为了达到更好的控制效果，输出的信号要经过功率放大器以提升其驱动负载的能力^[6]。

图3 PWM设计流程

3.3 PID控制

电机控制主要涉及到QEP模块采样光栅的输出脉冲，该模块主要是根据DSP捕获的两路光栅正交编码脉冲信号获得电机转轴的转向和位置，即根据两路信号的相位差获得转向信息，根据捕获的脉冲个数可以决定电机转轴的绝对位置信息^[7]。

DSP根据设定的转速和光栅反馈的电机实际转速进行PID计算，然后产生相应占空比的PWM波控制电机。例如当光栅反馈的实际速度比设定速度慢的时候，提高PWM的占空比，使电机实际速度增加，反之相反，如此可以达到良好的调速效果。

在PID控制中，增大比例参数P可以加快响应速度，减小稳态误差（无法消除），不过相应的会增加曲线的波动。适当增加积分参数I可以减弱或消除自控系统的静差，但过大会使稳定性变差。微分参数D可以抑制系统的超调，增加系统稳定性。

值得注意的是，积分环节的引用目的是消除系统的稳态静差，提高控制精度，但旋转调制系统的旋转机构要经常执行旋转单元体的正反旋转，在电机旋转换向时，短时间内电机设定转速与实际转速由于过渡过程会差生较大偏差，从而引起较大的超调量，这样会使电机换向过程产生不平稳，同时也增大了调节时间，这对高精度的旋转调制系统是不允许的。因此PID控制器要采用积分分离PID控制，即需要在电机换向过程中取消积分过程，只进行PD控制。积分分离PID控制流程如图4所示。

图4 积分分离PID控制流程

4 软件设计

DSP通常使用TI公司提供的集成开发环境CCS，采用C语言进行编写。在开发过程中，可使用TI为F28335用户提供的利用结构体和联合体定义片内各个寄存器的头文件库，用户可以方便的用C语言对DSP内部的寄存器进行访问。DSP28335程序空间和数据空间是统一编址的，通过配置cmd文件完成对存储空间的划分^[8]。

一个完整的控制程序一般包括主程序与中断服务程序两个部分。本电机控制系统的主程序负责完成外设的初始化以及PID调节器的初始化等工作，而中断服务程序负责完成电机控制系统的计算与控制。在实现电机控制的过程中主要涉及的内容如图5所示。

图5 电机控制流程

5 结语

当今控制系统逐渐由模拟化向数字化转变，硬件结构越来越简单，且控制精度越来越高。旋转调制式惯导系统的旋转机构电机控制要求系统具有响应速度快、可靠性高、转速调级平稳、反转过程平稳且角度误差小等特点。而DSP在指令处理速度上比普通微处理器有很大提升，可使很多复杂控制算法在嵌入式硬件中实现，使得电机的控制性能和精度大幅提升。同时DSP28335集成了较多适合电气检测与控制的外设设备，为系统开发提供了极大的便利。因此基于DSP28335的电机控制系统能充分发挥其外设资源丰富特点，减少附加电路，达到精简系统结构的目的，同时将其用于精度较高的惯性导航旋转电机控制系统也能很好地发挥其采用哈佛结构和多级流水线机制^[8]的强大控制和高速信号处理特点。