一种舵机异常自动检测系统技术方案

一种舵机异常自动检测系统，包括两个用于舵机角度信号检测的角度检测装置、两个用于舵机电流检测的电流检测装置、滤波模块、信号放大模块、A/D转换模块，用于进行数据处理和系统控制的DSP,角度检测装置切换模块，舵机驱动模块，存储模块和报警模块；本实用新型专利技术可以实时监控舵机工作状态，准确判定舵机异常原因，及时进行异常报警，并通过无线模块将异常信号检测数据传递给地面工作人员，结构简单，易于实现，检测全面，可以有效地减少异常情况给舵机及控制装置带来进一步的损害。

An automatic detection system for abnormal steering gear

【技术实现步骤摘要】
一种舵机异常自动检测系统
本技术涉及舵机智能控制
，尤其是涉及了一种舵机异常自动检测系统。
技术介绍
舵机是无人机、制导武器等的飞行系统的执行机构，是一种高精度的位置伺服系统，其工作原理是接受上位机给出的控制信号，经功率放大驱动舵机动作，通过控制舵机来操纵飞行系统舵面的偏转，从而进行飞行姿态和飞行轨迹的调整，最终使飞行系统够按照预定的轨迹飞行。通常，舵机控制系统可以分为电控部分和机械部分，机械部分通常情况下不会发生突发性故障，而是随着工作时间的增加逐渐出现性能下降、疲劳断裂等故障；电控部分由控制电路、无刷直流电机和角度传感器三部分组成，电机和角度传感器在运行过程中可能出现突发性故障，控制电路由于元器件的损坏或故障也可能出现突发性故障。目前常用的舵机异常检测系统，主要通过检测舵机工作电流是否异于正常值，或检测舵机转动角度是否异于预设值，从而判断舵机是否存在故障，而较少考虑到检测所用传感器自身故障造成舵机异常的问题。
技术实现思路
为了克服
技术介绍
中的不足，本技术公开了一种舵机异常自动检测系统，结构简单，可有效检测舵机的工作异常，及时报警和停止工作，消除安全隐患。为实现上述目的，本技术采样如下技术方案：一种舵机异常自动检测系统，包括两个用于舵机角度信号检测的角度检测装置a（1）和角度检测装置b（2）、两个用于舵机电流信号检测的电流检测装置a（3）和电流检测装置b（4）、滤波模块（5）、信号放大模块（6）、A/D转换模块（7），用于进行数据处理和系统控制的DSP（8）,角度检测装置切换模块（9），电流检测装置切换模块（10），舵机驱动模块（11），存储模块（12），报警模块（13）；所述角度检测装置a（1）、角度检测装置b（2）、电流检测装置a（3）、电流检测装置b（4）的输出端与所述滤波模块（5）的输入端相连，所述滤波模块的（5）的输出端与所述信号放大模块（6）的输入端相连，所述信号放大模块（6）的输出端与所述A/D转换模块（7）的输入端相连，所述A/D转换模块（7）的输出端与所述DSP（8）的输入端相连，所述DSP（8）的输出端与所述报警模块（13）的输入端相连；所述DSP（8）的输出端通过舵机驱动模块（11）与舵机相连；所述DSP（8）的输出端通过角度检测装置切换模块（9）分别与角度检测装置a（1）和角度检测装置b（2）相连；所述DSP（8）的输出端通过电流检测装置切换模块（10）分别与电流检测装置a（3）和电流检测装置b（4）相连。优选的，所述角度检测装置a（1）和角度检测装置b（2）为安装在舵机主轴上的同样型号的霍尔式角度传感器。优选的，所述电流检测装置a（3）和电流检测装置b（4）为安装在舵机供电电路上的同样型号的霍尔电流传感器。优选的，所述DSP（8）外接存储模块（12），所述存储模块选用FLASH存储器。优选的，所述报警模块（13）包括可以发出警报音的蜂鸣器和可以向工作人员发送异常信号检测数据的无线通信模块。由于采用如上所述的技术方案，本技术具有如下有益效果：通过设置两个角度检测装置和电流检测装置，可以实时监控舵机及其电路工作状态，准确判定检测装置是否出现故障或舵机系统是否出现异常，并能及时切换故障装置；在出现异常情况时，可以发出警报声，并通过无线模块将异常信号检测数据传递给地面工作人员；工作人员根据接收的检测数据，可以及时更换故障装置，保证设备安全运行，系统结构简单，易于实现，检测全面，可以有效地减少异常情况给舵机及控制装置带来进一步的损害。附图说明图1为本技术检测系统结构示意图。图中：1、角度检测装置a；2、角度检测装置b；3、电流检测装置a；4、电流检测装置b；5、滤波模块；6、信号放大模块；7、A/D转换模块；8、DSP；9、角度检测装置切换模块；10、电流检测装置切换模块；11、舵机驱动模块；12、存储模块；13、报警模块。具体实施方式通过下面的实施例可以详细的解释本技术，公开本技术的目的旨在保护本技术范围内的一切技术改进，本技术并不局限于下面的实施例。如图1所示，本技术一种舵机异常自动检测系统包括两个用于舵机角度信号检测的角度检测装置a（1）和角度检测装置b（2）、两个用于舵机电流信号检测的电流检测装置a（3）和电流检测装置b（4）、滤波模块（5）、信号放大模块（6）、A/D转换模块（7），用于进行数据处理和系统控制的DSP（8）,角度检测装置切换模块（9），电流检测装置切换模块（10），舵机驱动模块（11），存储模块（12），报警模块（13）。所述角度检测装置a（1）和角度检测装置b（2）为同样型号的霍尔式角度传感器，它们安装在舵机同一主轴上，用于进行舵机角度位置信息检测；电流检测装置a（3）和电流检测装置b（4）为同样型号的霍尔电流传感器，安装在舵机的同一供电电路上，用于进行供电电路的电流信号检测。所述角度检测装置a（1）、角度检测装置b（2）、电流检测装置a（3）、电流检测装置b（4）的输出端与所述滤波模块（5）的输入端相连，利用滤波模块（5）对检测信号进行滤波，以减少信号的外接噪声干扰，滤波模块（5）为两块并连的双通道可调低通滤波器LTC6603。所述滤波模块的（5）的输出端与所述信号放大模块（6）的输入端相连，利用信号放大模块（6）对滤波后的检测信号进行隔离放大，信号放大模块（6）为两块并连的高速双通道隔离放大器ICPL-2630。所述信号放大模块（6）的输出端与所述A/D转换模块（7）的输入端相连，利用A/D转换模块（7）将检测到的四路模拟信号转换为数字信号，A/D转换模块（7）为四通道16位模数转换器ADS5263。所述A/D转换模块（7）的输出端与所述DSP（8）的输入端相连，将转换的数字信号传送到DSP（8）中进行异常判断和处理；DSP（8）根据角度检测装置a（1）、角度检测装置b（2）、电流检测装置a（3）、电流检测装置b（4）的检测值，结合存储模块（12）中存储的检测阈值和舵机预设轨迹信息，判断舵机是否出现异常及异常类型；若判定角度检测装置出现故障，通过与角度检测装置a（1）和角度检测装置b（2）相连的角度检测装置切换模块（9）将故障的角度检测装置停止使用；若判定电流检测装置出现故障，通过与电流检测装置a（3）和电流检测装置b（4）相连的电流检测装置切换模块（10）将故障的电流检测装置停止使用。所述DSP（8）的输出端通过舵机驱动模块（11）与舵机相连；当DSP（8）判定舵机转动角度没有到达预设位置，DSP（8）计算角度补偿值，并通过舵机驱动模块（11）驱动舵机转动至预设位置。所述DSP（8）的输出端与所述报警模块（13）的输入端相连，所述报警模块（13）包括可以发出警报音的蜂鸣器和可以向工作人员发送异常信号检测数据的无线通信模块；当DSP（8）判定舵机出现异常信号后，通过报警模块（13）向工作人员发送不同类型的警报声，以通知工作人员出现了何种异常情况；D本文档来自技高网...

【技术保护点】
1.一种舵机异常自动检测系统，其特征是：包括两个用于舵机角度信号检测的角度检测装置a（1）和角度检测装置b（2）、两个用于舵机电流信号检测的电流检测装置a（3）和电流检测装置b（4）、滤波模块（5）、信号放大模块（6）、A/D转换模块（7），用于进行数据处理和系统控制的DSP（8）,角度检测装置切换模块（9），电流检测装置切换模块（10），舵机驱动模块（11），存储模块（12），报警模块（13）；所述角度检测装置a（1）、角度检测装置b（2）、电流检测装置a（3）、电流检测装置b（4）的输出端与所述滤波模块（5）的输入端相连，所述滤波模块（5）的输出端与所述信号放大模块（6）的输入端相连，所述信号放大模块（6）的输出端与所述A/D转换模块（7）的输入端相连，所述A/D转换模块（7）的输出端与所述DSP（8）的输入端相连，所述DSP（8）的输出端与所述报警模块（13）的输入端相连；所述DSP（8）的输出端通过舵机驱动模块（11）与舵机相连；所述DSP（8）的输出端通过角度检测装置切换模块（9）分别与角度检测装置a（1）和角度检测装置b（2）相连；所述DSP（8）的输出端通过电流检测装置切换模块（10）分别与电流检测装置a（3）和电流检测装置b（4）相连。/n...

【技术特征摘要】
1.一种舵机异常自动检测系统，其特征是：包括两个用于舵机角度信号检测的角度检测装置a（1）和角度检测装置b（2）、两个用于舵机电流信号检测的电流检测装置a（3）和电流检测装置b（4）、滤波模块（5）、信号放大模块（6）、A/D转换模块（7），用于进行数据处理和系统控制的DSP（8）,角度检测装置切换模块（9），电流检测装置切换模块（10），舵机驱动模块（11），存储模块（12），报警模块（13）；所述角度检测装置a（1）、角度检测装置b（2）、电流检测装置a（3）、电流检测装置b（4）的输出端与所述滤波模块（5）的输入端相连，所述滤波模块（5）的输出端与所述信号放大模块（6）的输入端相连，所述信号放大模块（6）的输出端与所述A/D转换模块（7）的输入端相连，所述A/D转换模块（7）的输出端与所述DSP（8）的输入端相连，所述DSP（8）的输出端与所述报警模块（13）的输入端相连；所述DSP（8）的输出端通过舵机驱动模块（11）与舵机相连；所述DSP（8）的输出端通过...

【专利技术属性】
技术研发人员：曹辉，曹邦武，李道军，杨士义，
申请(专利权)人：洛阳雷云科技有限公司，
类型：新型
国别省市：河南;41