一种基于FPGA的无刷电动舵机故障检测系统及方法技术方案

本发明专利技术提供一种基于FPGA的无刷电动舵机故障检测系统及方法，在无需附加硬件检测电路、电流传感器的情况下，以舵机控制算法中的反馈信号(ADC模块采集的电压信息)和霍尔信号(霍尔传感器状态)为输入进行故障判断和处置，具有成本低，可移植性强的特点。相对于传统高性能处理器，FPGA具有高速、并行工作的特点，可同时检测并处置无刷电动舵机霍尔传感器开路或短路故障、角位移传感器开路故障。本发明专利技术提出的基于FPGA的无刷电动舵机故障检测技术，在舵机工作过程中，可以精准的定位角位移传感器开路故障并处置，同时将故障类型上报。同时将故障类型上报。

【技术实现步骤摘要】
一种基于FPGA的无刷电动舵机故障检测系统及方法


[0001]本专利技术属于电动伺服控制
，具体涉及一种基于FPGA的无刷电动舵机故障检测系统及方法。

技术介绍

[0002]传统的电动舵机故障检测技术采用电流传感器配合高性能处理器实现，基本策略是综合分析反馈信号对指令的跟随情况以及电流传感器采集电流判断故障类型。这种方法需要附加专用传感器，增加了设备体积和投资成本，不利于小型化、低成本的设计。且电动舵机中的角位移传感器开路故障和舵机卡滞故障的表现相似，现有技术很难精准定位故障类型。

技术实现思路

[0003]为了解决上述现有技术的问题，本专利技术提供一种基于FPGA的无刷电动舵机故障检测系统及方法，无需增加硬件检测电路，具有成本低、可移植性强的特点，可同时检测并处置无刷电动舵机霍尔传感器开路或短路故障、角位移传感器开路故障。
[0004]本专利技术通过以下技术方案实现：
[0005]一种基于FPGA的无刷电动舵机故障检测系统，包括FPGA、第一计数器、第二计数器和第三计数器；所述FPGA包括霍尔故障检测模块和角位移故障检测模块；
[0006]所述霍尔故障检测模块，用于获取无刷电动舵机中霍尔传感器状态，当霍尔传感器状态改变时，若此时霍尔传感器状态为0象限或7象限，则使第一计数器加1；根据第一计数器的累加值判断霍尔传感器是否出现故障；
[0007]所述角位移故障检测模块，用于接收无刷电动舵机中ADC模块采集的角位移传感器的电压信息并处理得到角位移传感器的反馈信号；获取无刷电动舵机中霍尔传感器状态，当出现一次132645循环霍尔序列时，则使第二计数器加1，当出现一次546231循环霍尔序列时，则使第三计数器加1；当第二计数器或第三计数器的累加值为预设值n时，计算第二计数器或第三计数器的累加值为1时角位移传感器的反馈信号和第二计数器或第三计数器的累加值为n时角位移传感器的反馈信号的差值，若差值小于预设值t，则认为角位移传感器故障。
[0008]优选的，所述FPGA包括控制模块，所述控制模块用于根据无刷电动舵机中角位移传感器的反馈信号调整控制量并输出给无刷电动舵机中无刷电机1以控制无刷电机1的旋转状态。
[0009]优选的，所述角位移故障检测模块包括计数模块、反馈记录模块和故障判断模块；
[0010]所述计数模块，用于获取无刷电动舵机中霍尔传感器状态，当出现一次132645循环霍尔序列时，使第二计数器加1，当出现一次546231循环霍尔序列时，使第三计数器加1；
[0011]所述反馈记录模块，用于接收ADC模块采集的角位移传感器的电压信息并处理得到角位移传感器的反馈信号，并记录第二计数器和第三计数器的累加值分别为1和n时角位
移传感器的反馈信号；
[0012]所述故障判断模块，用于计算第二计数器或第三计数器的累加值为1时角位移传感器的反馈信号与第二计数器或第三计数器的累加值为n时角位移传感器的反馈信号的差值，将差值与预设值t作比较，若差值小于t，则判定角位移传感器故障发生。
[0013]优选的，所述根据第一计数器的累加值判断霍尔传感器是否出现故障，具体是：若第一计数器的累加值为预设值m，则判断霍尔传感器出现故障。
[0014]进一步的，m为4
‑
7。
[0015]优选的，n为2
‑
6。
[0016]优选的，t为0.5
°
。
[0017]优选的，所述无刷电动舵机，包括无刷电机、减速器、输出轴、舵片、角位移传感器和ADC模块；无刷电机中设置有霍尔传感器，无刷电机通过减速器与输出轴传动连接，输出轴与舵片固定连接；角位移传感器用于采集舵片的位置信息并将采集的位置信息作为反馈信号输出给无刷电机的控制模块；ADC模块用于采集角位移传感器的电压信息并传输给角位移故障检测模块。
[0018]进一步的，所述减速器包括第一齿轮、第二齿轮、第三齿轮、第四齿轮、蜗杆、蜗轮；无刷电机的输出轴与第一齿轮同轴固定连接，第一齿轮与第二齿轮啮合连接，第二齿轮与第三齿轮固定连接，第三齿轮与第四齿轮啮合连接，第四齿轮与蜗杆固定连接，蜗杆与蜗轮啮合连接，蜗轮与输出轴同轴固定连接。
[0019]一种基于FPGA的无刷电动舵机故障检测方法，基于所述的无刷电动舵机故障检测系统，包括：
[0020]所述霍尔故障检测模块获取无刷电动舵机中霍尔传感器状态，当霍尔传感器状态改变时，若此时霍尔传感器状态为0象限或7象限，则使第一计数器加1；根据第一计数器的累加值判断霍尔传感器是否出现故障，当判断霍尔传感器故障时；
[0021]所述角位移故障检测模块接收ADC模块采集的电压信息并处理得到角位移传感器的反馈信号；获取无刷电动舵机中霍尔传感器状态，当出现一次132645循环霍尔序列时，则使第二计数器加1，当出现一次546231循环霍尔序列时，则使第三计数器加1；当第二计数器或第三计数器的累加值为预设值n时，计算第二计数器或第三计数器的累加值为1时角位移传感器的反馈信号和第二计数器或第三计数器的累加值为n时角位移传感器的反馈信号的差值，若差值小于预设值t，则认为角位移传感器故障。
[0022]与现有技术相比，本专利技术具有如下的有益效果：
[0023]本专利技术提出了基于FPGA的无刷电动舵机故障检测技术，在无需附加硬件检测电路、电流传感器的情况下，以舵机控制算法中的反馈信号(ADC模块采集的电压信息)和霍尔信号(霍尔传感器状态)为输入进行故障判断和处置，具有成本低，可移植性强的特点。相对于传统高性能处理器，FPGA具有高速、并行工作的特点，可同时检测并处置无刷电动舵机霍尔传感器开路或短路故障、角位移传感器开路故障。本专利技术提出的基于FPGA的无刷电动舵机故障检测技术，在舵机工作过程中，可以精准的定位角位移传感器开路故障并处置，同时将故障类型上报。
[0024]进一步的，本专利技术中将m设为4
‑
7，既不容易将因偶然原因出现的霍尔传感器状态错误误判为霍尔传感器故障，又能在霍尔传感器故障时识别出故障，从而能准确的检测出
霍尔传感器故障。
附图说明
[0025]图1为无刷电动舵机结构示意图。
[0026]图2为无刷电机的霍尔传感器象限分布。
具体实施方式
[0027]为了进一步理解本专利技术，下面结合实施例对本专利技术进行描述，这些描述只是进一步解释本专利技术的特征和优点，并非用于限制本专利技术的权利要求。
[0028]如图1所示，本专利技术所述无刷电动舵机包括无刷电机1、减速器、输出轴4、舵片、角位移传感器和ADC模块；无刷电机1中设置有霍尔传感器，减速器包括第一齿轮1
‑
1、第二齿轮1
‑
2、第三齿轮2
‑
1、第四齿轮2
‑
2、蜗杆2、蜗轮3。无刷电机1的输出轴与齿轮1
‑
1同轴固定连接，齿轮1
‑
1与齿轮1
‑
2啮合连接本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于FPGA的无刷电动舵机故障检测系统，其特征在于，包括FPGA、第一计数器、第二计数器和第三计数器；所述FPGA包括霍尔故障检测模块和角位移故障检测模块；所述霍尔故障检测模块，用于获取无刷电动舵机中霍尔传感器状态，当霍尔传感器状态改变时，若此时霍尔传感器状态为0象限或7象限，则使第一计数器加1；根据第一计数器的累加值判断霍尔传感器是否出现故障；所述角位移故障检测模块，用于接收无刷电动舵机中ADC模块采集的角位移传感器的电压信息并处理得到角位移传感器的反馈信号；获取无刷电动舵机中霍尔传感器状态，当出现一次132645循环霍尔序列时，则使第二计数器加1，当出现一次546231循环霍尔序列时，则使第三计数器加1；当第二计数器或第三计数器的累加值为预设值n时，计算第二计数器或第三计数器的累加值为1时角位移传感器的反馈信号和第二计数器或第三计数器的累加值为n时角位移传感器的反馈信号的差值，若差值小于预设值t，则认为角位移传感器故障。2.根据权利要求1所述的基于FPGA的无刷电动舵机故障检测系统，其特征在于，所述FPGA包括控制模块，所述控制模块用于根据无刷电动舵机中角位移传感器的反馈信号调整控制量并输出给无刷电动舵机中无刷电机1以控制无刷电机1的旋转状态。3.根据权利要求1所述的基于FPGA的无刷电动舵机故障检测系统，其特征在于，所述角位移故障检测模块包括计数模块、反馈记录模块和故障判断模块；所述计数模块，用于获取无刷电动舵机中霍尔传感器状态，当出现一次132645循环霍尔序列时，使第二计数器加1，当出现一次546231循环霍尔序列时，使第三计数器加1；所述反馈记录模块，用于接收ADC模块采集的角位移传感器的电压信息并处理得到角位移传感器的反馈信号，并记录第二计数器和第三计数器的累加值分别为1和n时角位移传感器的反馈信号；所述故障判断模块，用于计算第二计数器或第三计数器的累加值为1时角位移传感器的反馈信号与第二计数器或第三计数器的累加值为n时角位移传感器的反馈信号的差值，将差值与预设值t作比较，若差值小于t，则判定角位移传感器故障发生。4.根据权利要求1所述的基于FPGA的无刷电动舵机故障检测系统，其特征在于，所述根据第一计数器的累加值判断霍尔传感器是否出现故障，具体是：若第一计数器的累加值为预设值m，则判断霍尔传感器出现故障。5.根据权利要求4所述的基于FPGA的无刷电动舵机故障检测系统，其特征在于，m为4
‑
7。6.根据权利要求1所述的基于FPGA的无刷电动舵机故障检测系统，其特征在于，n为2
‑
6。7.根据权利要...

【专利技术属性】
技术研发人员：宋瑞，王琳琳，杨模，贺巧玲，
申请(专利权)人：西安微电子技术研究所，
类型：发明
国别省市：