超声电机驱动的捷联式三自由度自稳平台驱动控制器制造技术

本发明专利技术公开了一种超声电机驱动的捷联式三自由度自稳平台驱动控制器，它主要包括了嵌入式微处理器、功率放大与匹配电路以及参数采集电路。由嵌入式微处理器的内部产生的时钟信号经过ePWM模块的时钟单元分配产生6路ePWM信号。微处理器的内部模块可以根据传感器所采集的平台运动参数进行姿态解算，并根据解算结果对ePWM信号的频率进行实时调节，实现对驱动自稳平台超声电机的高性能、高稳定性控制的目标。并且嵌入式微处理器可以实现与上位机的实时通信，实现远程控制指令的发送与接收以及实时监控电机的运行状态。本发明专利技术可以同时控制三个方向上超声电机的实时联动，控制电路结构简单、成本较低，利于驱动电路的集成化和小型化。

Drive controller of Strapdown three freedom self stabilizing platform driven by ultrasonic motor

The invention discloses a strapdown three degree of freedom self stabilizing platform driving controller driven by an ultrasonic motor, which mainly comprises an embedded microprocessor, a power amplification and matching circuit and a parameter acquisition circuit. The clock signal generated by the embedded microprocessor is assigned to the 6 channel ePWM signal through the clock unit of the ePWM module. The internal module of microprocessor can be attitudeoperator according to the motion parameters collected by the sensor, and according to the calculation results of the frequency of the ePWM signal to achieve real-time regulation, to drive self stabilized platform of ultrasonic motor with high stability and high performance, control objectives. And the embedded microprocessor can realize the real-time communication with the host computer, realize the sending and receiving of the remote control instruction, and monitor the running state of the motor in real time. The invention can control the real-time linkage of the ultrasonic motor in three directions at the same time, the control circuit is simple in structure and low in cost, which is beneficial to the integration and miniaturization of the driving circuit.

【技术实现步骤摘要】
超声电机驱动的捷联式三自由度自稳平台驱动控制器
本专利技术涉及超声电机驱动控制领域，具体是一种超声电机驱动的捷联式三自由度自稳平台驱动控制器。
技术介绍
超声电机是一种新型电机，它利用了压电材料的逆压电效应，在压电材料上施加交流信号产生交变电场，进而激发出压电材料在超声频段内的振动，并将这一振动放大，通过摩擦作用转换为电机转子的运动，作为功率输出并驱动其他负载。与传统电机相比，超声电机具有低转速、大力矩、响应速度快、断电自锁、无电磁干扰等优点。采用三台超声电机驱动的三自由度自稳平台可以实现平台的高精度快速跟踪定位，在航空航天领域有着广泛的应用前景。超声电机需要由两路正交相位的超声频段的交流信号来驱动工作。三自由度平台需要由三个电机驱动转动，传统做法采用三个独立的驱动控制器分别驱动三个电机，然后再使用一个微控制器来实现平台的传感器信号采集和定位跟踪，整体上平台驱动控制系统体积较大，不易实现调压、调频、调相组合的控制方法，控制算法效率较低，且故障率较高。
技术实现思路
本专利技术为了解决现有技术的问题，提供了一种超声电机驱动的捷联式三自由度自稳平台驱动控制器，通过一个DSP芯片产生六路ePWM信号同时控制平台上三相超声电机，控制电路结构简单，成本较低，使用一块DSP芯片不存在同步性问题且控制精度较高，同时采用捷联式结构可以简化平台上的机械结构，更有利于驱动电路集成化、小型化。本专利技术包括嵌入式微处理器和功率放大匹配电路，嵌入式微处理器将其内部时钟信号在ePWM模块分别分配至第一ePWM模块、第二ePWM模块、第三ePWM模块、第四ePWM模块、第五ePWM模块和第六ePWM模块；第一、第二ePWM模块的输出信号经过功率放大匹配电路中进行功率放大和匹配后向待控制的第一超声电机产生两路相位差为π/2（90°）的驱动信号；第三、第四ePWM模块的输出信号经过功率放大匹配电路中进行功率放大和匹配后向待控制的第二超声电机产生两路相位差为π/2（90°）的驱动信号；第五、第六ePWM模块的输出信号经过功率放大匹配电路中进行功率放大和匹配后向待控制的第三超声电机产生两路相位差为π/2（90°）的驱动信号。进一步改进，所述的嵌入式微处理器连接有参数采集电路，所述的参数采集电路包括陀螺仪传感器模块、第一磁旋转编码器模块、第二磁旋转编码器模块和第三磁旋转编码器模块；陀螺仪传感器模块安装在自稳平台基座上通过I2C总线与嵌入式微处理器相连接，测量基座运动的角速度；第一磁旋转编码器模块安装在第一超声电机转轴上，通过SPI与嵌入式微处理器相连接，测量第一超声电机的转动角度；第二磁旋转编码器模块安装在第二超声电机转轴上，通过SPI与嵌入式微处理器相连接，测量第二超声电机的转动角度；第三磁旋转编码器模块安装在第三超声电机转轴上，通过SPI与嵌入式微处理器相连接，测量第三超声电机的转动角度；进一步改进，所述的嵌入式微处理器连接有速度补偿处理单元，速度补偿处理单元包含补偿模块开关和速度调节单元，所述的速度调节单元包括第一速度调节模块、第二速度调节模块和第三速度调节模块；以上所述的ePWM模块，功率放大匹配单元、超声电机、三轴稳定平台、参数采集电路组成一个闭环系统，实现了超声电机的高性能转速控制。待控制的第一超声电机的转速由第一速度调节模块手动控制，第一速度调节模块的输出信号进入嵌入式微处理器的ADC模块；所述的第一速度调节模块通过第一开关实现第一超声电机是否转动及转动转向的控制。待控制的第二超声电机的转速由第二速度调节模块手动控制，第二速度调节模块的输出信号进入嵌入式微处理器的ADC模块；所述的第二速度调节模块通过第二开关实现第二超声电机是否转动及转动转向的控制。待控制的第三超声电机的转速可以由第三速度调节模块手动控制，第三速度调节模块的输出信号进入嵌入式微处理器的ADC模块。所述的第三速度调节模块通过第三开关实现第三超声电机是否转动及转动转向的控制。进一步改进，所述的功率放大匹配电路中，同一待控制的电机上输入的两路驱动信号分别经过两个MOSFET管进行推挽放大后再经过升压变压器升压，在通过一个并联电感匹配后施加于待控制的电机。所述的MOSFET管和升压变压器之间设有脉冲吸收电路。本专利技术中用到的陀螺仪传感器以及三块磁旋转编码器分别采集稳定平台的基体与各轴电机的运动参数，这些参数分别通过I2C模块和SPI模块传输给DSP芯片，运用DSP强大的运算能力对采集到的的运动参数进行姿态解算，根据姿态解算的结果配合实时控制算法实现对稳定平台电机转速与转向的控制，进而实现平台的精确闭环控制，完成平台的机械系统与控制系统的配合。驱动核心采用了运算功能强大的DSP芯片（型号为TMS320F28069），DSP芯片内部采用程序和数据分开的哈佛结构，具有专门的乘法器，可以用来快速实现各种数据处理算法。本专利技术有益效果在于：本专利技术将超声电机这一上个世纪80年代发展起来的新型作动器运用到三轴稳定平台上，结合稳定平台的需要发挥出超声电机断电自锁、高速响应、高精度定位控制的优点。通过一个DSP芯片产生六路ePWM信号同时控制平台上三相超声电机，控制电路结构简单，成本较低，使用一块DSP芯片不存在同步性问题且控制精度较高，同时采用捷联式结构可以简化平台上的机械结构，更有利于驱动电路集成化、小型化。附图说明图1为本专利技术的控制器总体原理框图。图2为本专利技术驱动控制器结构图。图3为本专利技术控制流程图。具体实施方式下面结合附图和具体实施方式，对本专利技术作进一步说明。如图1所示，本例所实施的超声电机驱动三自由度稳定平台的驱动控制器主要包含一个控制核心DSP芯片，两个参数采集模块：角速度传感器与角度传感器，以及一个功率放大匹配模块。如图2所示，所述的微处理器DSP将其内部时钟信号在ePWM模块分别分配至第一ePWM模块、第二ePWM模块、第三ePWM模块、第四ePWM模块、第五ePWM模块、第六ePWM模块；第一、第二ePWM模块的输出信号经过功放/匹配电路后经过功率放大和匹配后向待控制的第一超声电机产生两路相位差为π/2的驱动信号；第三、第四ePWM模块的输出信号经过功放/匹配电路后经过功率放大和匹配后向待控制的第二超声电机产生两路相位差为π/2的驱动信号；第五、第六ePWM模块的输出信号经过功放/匹配电路后经过功率放大和匹配后向待控制的第三超声电机产生两路相位差为π/2的驱动信号。稳定平台的基座运动参数由陀螺仪传感器采集，并通过I2C接口输入到微处理器芯片。待控制的第一超声电机所安装框架的运动参数由第一磁旋转编码器采集，并通过SPI接口输入微处理器芯片，在芯片内部结合基座运动参数以及第一电机所安装框架的转动角度通过捷联算法得到该框架的转动速度。待控制的第二超声电机所安装框架的运动参数由第二磁旋转编码器采集，并通过SPI接口输入微处理器芯片，在芯片内部结合基座运动参数以及第一和第二电机所安装框架的转动角度通过捷联算法得到该框架的转动速度。待控制的第三超声电机所安装框架的运动参数由第三磁旋转编码器采集，并通过SPI接口输入微处理器芯片，在芯片内部结合基座运动参数以及第一、第二和第三电机所安装框架的转动角度通过捷联算法得到该框架的转动速度。将第一超声电机安装框架的角速度与稳定平台达到稳定所需的本文档来自技高网...

【技术保护点】
一种超声电机驱动的捷联式三自由度自稳平台驱动控制器，其特征在于：包括嵌入式微处理器、功率放大匹配电路和参数采集电路，嵌入式微处理器将其内部时钟信号在ePWM模块分别分配至第一ePWM模块、第二ePWM模块、第三ePWM模块、第四ePWM模块、第五ePWM模块和第六ePWM模块；第一、第二ePWM模块的输出信号经过功率放大匹配电路中进行功率放大和匹配后向待控制的第一超声电机产生两路相位差为π/2的驱动信号；第三、第四ePWM模块的输出信号经过功率放大匹配电路中进行功率放大和匹配后向待控制的第二超声电机产生两路相位差为π/2的驱动信号；第五、第六ePWM模块的输出信号经过功率放大匹配电路中进行功率放大和匹配后向待控制的第三超声电机产生两路相位差为π/2的驱动信号。

【技术特征摘要】
1.一种超声电机驱动的捷联式三自由度自稳平台驱动控制器，其特征在于：包括嵌入式微处理器、功率放大匹配电路和参数采集电路，嵌入式微处理器将其内部时钟信号在ePWM模块分别分配至第一ePWM模块、第二ePWM模块、第三ePWM模块、第四ePWM模块、第五ePWM模块和第六ePWM模块；第一、第二ePWM模块的输出信号经过功率放大匹配电路中进行功率放大和匹配后向待控制的第一超声电机产生两路相位差为π/2的驱动信号；第三、第四ePWM模块的输出信号经过功率放大匹配电路中进行功率放大和匹配后向待控制的第二超声电机产生两路相位差为π/2的驱动信号；第五、第六ePWM模块的输出信号经过功率放大匹配电路中进行功率放大和匹配后向待控制的第三超声电机产生两路相位差为π/2的驱动信号。2.根据权利要求1所述的超声电机驱动的捷联式三自由度自稳平台驱动控制器，其特征在于：所述的参数采集电路包括陀螺仪传感器模块、第一磁旋转编码器模块、第二磁旋转编码器模块和第三磁旋转编码器模块；陀螺仪传感器模块安装在自稳平台基座上通过I2C总线与嵌入式微处理器相连接，测量基座运动的角速度；第一磁旋转编码器模块安装在第一超声电机转轴上，通过SPI与嵌入式微处理器相连接，测量第一超声电机的转动角度；第二磁旋转编码器模块安装在第二超声电机转轴上，通过SPI与嵌入式微处理器相连接，测量第二超声电机的转动角度；第三磁旋转编码器模块安装在第三超声电机转轴上，通过SPI与嵌入式微处理器相连接，测量第三超声电机的转动角度。3.根...

【专利技术属性】
技术研发人员：潘松，徐张帆，陈雷，唐洪全，
申请(专利权)人：南京航空航天大学，
类型：发明
国别省市：江苏,32