一种具有实时故障监控能力的三轴旋转机构控制装置的制造方法
【技术领域】
[0001] 本发明涉及电机控制领域的一种具有实时故障监控能力的三轴旋转机构控制装 置，具体是涉及三路正交安装的直流无刷电机的控制装置。适用于对控制精度和安全稳定 性要求较高的旋转机构控制。
【背景技术】
[0002] 直流无刷电机由电动机主体和驱动器组成，是一种典型的机电一体化产品。有传 统直流电机的优点，同时又取消了碳刷、滑环结构，具有体积小，重量轻，出力大等优点。而 三轴旋转机构在汽车、工具、工业工控、自动化以及航空航天等领域得到了广泛的应用，对 旋转机构精确、安全的控制一直是研宄的热点。随着电子技术、微电子技术、数字技术、自控 技术等技术的发展，利用DSP为核心的数据处理单元，运用数字控制技术同时实现对电机 的精确控制与故障检测成了可能。现有的电机控制装置主要由控制器部分、隔离电路、位置 传感器以及用来检测电流与电压的检测电路组成。这类装置只能在外界条件较为稳定的环 境中工作，而在外界条件较为复杂的环境中则丧失了故障检测能力。一般情况下电机控制 与故障检测的任务都由主芯片完成，这样会使控制系统不够灵活，而且在实现匀速正反转 的过程中，并无额外的主动控制。
【发明内容】
[0003] 本发明提出一种具有实时故障监控能力的三轴旋转机构控制装置。该装置以TI 的高性能处理芯片TMS320F28335作为主控芯片，以一片CPLD作为信号采集单元的核心，减 少DSP的负担，提升了电机的控制精度和实时性。装置还实时检测电机的霍尔信号、旋转机 构的测角信号、系统温度、系统的振动信号以及电机驱动机构返回的状态信号，并在有故障 时采取相应保护措施，以保证旋转机构安全的运转。在控制算法发面，当旋转机构以匀速进 行连续正反转运动时，运用了主控控制的策略，保证了系统控制的精确度。
[0004] 本发明的技术解决方案：
[0005] 一种具有实时故障监控能力的三轴旋转机构控制装置，其特征在于，该装置主要 包括以DSP为核心的主控单元、以CPLD为核心的信号采集模块、通讯模块、光耦隔离模块、 电平转换模块1、电平转换模块2、电机驱动模块以及电源模块。DSP为本装置的控制核心， 接收来自外部的电机旋转指令与同步信号，并连接信号采集模块、总线传输模块、电平转换 模块1和通讯模块；信号采集模块以一片CPLD为核心，包含集成数据采集芯片，采集旋转机 构转角、温度、振动信号以及电机的监测信号，DSP根据采集到的信号实现对系统的实时监 测，并对相应的故障采取不同的措施；总线传输模块连接光耦隔离模块，光耦模块连接电平 转换模块2,电平转换模块2连接电机驱动模块；通信模块则连接上位机；电源模块为整个 装置供电。在控制算法方面，当旋转机构以匀速进行连续正反转运动时，运用了主控控制的 策略，保证了系统控制的精确度。
[0006] 以DSP为核心的主控单元由TI公司的TMS320F28335及其外围电路组成；信号采 集模块主要由CPLD芯片EPMl270、数据采集芯片SN65175、电平转换模块1以及外围电路组 成；数据传输模块由54HC245及其外围电路组成；光耦隔离模块由光耦器件HCPL-2631组 成；电平转换模块由SN74ALVC164245及其外围电路构成；通信模块由MAX3223和外围电路 构成；电机驱动模块由继电器和集成功放芯片DRV8332及其外围电路组成；电源模块由27V 转12V、5V以及5V转3. 3V构成，电压转换芯片为LM7805CT和LM1085。
[0007] 本发明与现有技术相比的优点在于：
[0008] (1)、本发明中电机驱动部分兼有了检测电路中过压、短路等故障的作用，而系统 除了实时采集旋转机构的测角信号、电机霍尔信号和电机驱动机构返回的状态信号外，还 会采集系统的振动信号，根据采集到的振动信号判断当前系统的工作状态，如出现由于某 些故障而引起振动幅值过大的情况，DSP可以通过切断电机的驱动电源保护系统安全。
[0009](2)、本发明还会实时采集系统温度信号，根据温度的高低，DSP会通过继电器来控 制风扇与加温片的工作与否，保证系统处于一个较适宜的温度环境中，而当温度由于故障 或系统由于工作时间超长使系统温度超出一定范围，可能影响系统工作时，DSP也会采取相 关保护措施，这样设计也增加了系统应对复杂工作环境的能力。
[0010] (3)、本发明在控制策略方面采用了主动控制的策略，这样可以保证系统在以匀速 进行正反转的运动中以较高的控制精度，实现平稳的过渡。
[0011] (4)、本发明在进行信号采集与故障检测时，以一片CPLD作为控制核心，减少了 DSP工作的负担，节省了DSP执行时间与存储空间，DSP集中资源用于电机的旋转控制，提高 了整个装置运行的实时性和控制精确度。
【附图说明】
[0012] 图1为本发明的系统框图；
[0013] 图2为本发明的工作原理图；
[0014] 图3为本发明中核心主控单元部分原理图；
[0015]图4为本发明的数据采集芯片及其外围电路图；
[0016] 图5为本发明中核心主控单元部分原理图；
[0017]图6为本发明的数据采集芯片及其外围电路图；
[0018] 图7为本发明的通讯模块原理图；
[0019] 图8为本发明的数据总线传输模块原理图；
[0020] 图9为本发明的光耦隔离芯片及其外围电路图；
[0021] 图10为利用本发明的电平转换模块原理图；
[0022] 图11为利用本发明的电机驱动模块原理图；
[0023] 图12利用本发明的电源模块部分原理图；
[0024] 图13为利用本发明上位机界面效果示意图。
【具体实施方式】
[0025] 下面结合具体的实施例，详细介绍本发明装置。
[0026] 本发明是一种具有实时故障监控能力的三轴旋转机构控制装置，如图1所示，该 装置主要包括以DSP为核心的主控单元、以CPLD为核心的信号采集模块、通讯模块、光耦隔 离模块、电平转换模块1、电平转换模块2、电机驱动模块以及电源模块。DSP为本装置的控 制核心，接收来自外部的电机旋转指令与同步信号，并连接信号采集模块、总线传输模块、 电平转换模块1和通讯模块；信号采集模块以一片CPLD为核心，包含集成数据采集芯片，采 集旋转机构转角、温度以及电机的监测信号；总线传输模块连接光耦隔离模块，光耦模块连 接电平转换模块2,电平转换模块2连接电机驱动模块；通信模块则连接上位机；电源模块 为整个装置供电。
[0027] 简化后的具体工作原理如图2所示，DSP根据主计算机提供的指令角速度与同步 信号，经计算后得到相应的PWM信号，当PWM信号进入功放芯片时，DSP根据同步信号通过继 电器控制电机驱动模块的供电，最终从电机驱动模块输出驱动电机的PWM信号（27V)。CPLD 主要负责信号采集，信号主要包括旋转机构的测角信号、温度传感器信号、以及功放芯片返 回的监控信号，DSP根据采集到的信号监控系统各部分性能。当系统出现故障的时，DSP根 据不同的情况做出不同的处理。具体各部分检测流程如下所示。
[0028] (1)当数据采集模块采集的测角装置信号会突然发生较大变化时，若DSP通过对 两次测角信号的值作差，计算的旋转机构转速超过设定阈值，DSP会以为控制装置出现故 障，就会发出信号切断电机驱动电源，同时发出报警信号给上位机。
[0029] (2)温度信号检测部分程序框图如图3所示。温度传感器通过信息采集模块将当 前系统的温度送至主控单元DSP，当系统温度就会发生变化时，DSP根据实际工作环境，将 系统温度分为超低（小于-40° )、较低（-40°至-20° )、正常（-20°至60° )、较高（60° 至85° )和超高（大于85° )几个范围。若温度处于正常工作范围内时，不启动风扇或加 温片；若系统温度值处于较低范围内时，DSP会发出信号至控制加温片的继电器使加温片 开始工作而保持控制风扇继电器关闭；若系统温度继续降低至超低温度范围，超出大多数 芯片的正常工作范围，DSP会发出关闭信号切断控制电机驱动芯片的继电器来保护系统安 全；同样当系统处于较高温度范围时，DSP会打开风扇而关闭加温片，处于超高范围时DSP 会切断电机切断电源，同时发送报警信号给上位机。
[0030] (3)系统振动信号检测部分程序框图如图4所示。当振动传感器信号的幅值和频 率发生变化时，DSP会根据检测到的不同的信号进行不同的处理。若检测到的振动信号的 幅值较大但不超过幅值而频率几乎接近于零则系统所在的载体可能在做加速运动，DSP对 此信号不做出处理；若系统振动信号的幅值不断增大也未超过阈值且振动频率接近不变则 可能出现谐振，DSP此时会稍调控制程序的中的PID参数；若振动信号的幅值或频率超过阈 值则DSP会切断电机的驱动电源，并发出报警信号到上位机。
[0031] (4)当电机的驱动电路出现欠压、超温、过载和短路等故障时，电机驱动芯片会检 测到这些故障，并将故障信号07W与传给DSP，DSP在接收到此故障信号后，继电 器切断相应电机的驱动电源来保护整个装置，同时发送报警信号给上位机。
[0032] 核心主控单元由TI公司的TMS320F28335浮点型数据处理器为核心， TMS320F28335具有150MHz的高速处理能力，具备32位浮点处理单元，有多大18路的PWM 输出，其中有6路TI特有的更高精度的PWM输出（HRPWM)。得益于浮点运算单元，用户可快 速编写控制算法而无需在处理小数操作上耗费过多的时间和精力，与前代DSP相比，性能 平均提高50%。其部分原理图如图5所示。
[0033] 信号采集模块主要由CPLD芯片EPM1270、数据采集芯片SN65175、电平转换模块1 以及外围电路组成。EPM1270还要根据采集的信号对控制装置进行实时监控；温度传感器、 光栅的输出信号由数据采集芯片SN65175采集，SN65175为四路差动线路接收器，由于其输 出的信号为5V逻辑，而CPLD