[发明专利]一种舵机系统非灵敏区判定方法有效
申请号: | 201910784533.6 | 申请日: | 2019-08-23 |
公开(公告)号: | CN110471349B | 公开(公告)日: | 2020-07-31 |
发明(设计)人: | 李嘉科;仲启亮;刘冠达;张翔;杨培;马俊 | 申请(专利权)人: | 北京机械设备研究所 |
主分类号: | G05B19/042 | 分类号: | G05B19/042 |
代理公司: | 北京天达知识产权代理事务所(普通合伙) 11386 | 代理人: | 杨光 |
地址: | 100854 北京市海淀区永*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 舵机 系统 灵敏 判定 方法 | ||
1.一种舵机系统非灵敏区判定方法,其特征在于,包括以下步骤:
向舵机系统输入单位角波控制信号,获得舵机系统的反馈信号;
对所述反馈信号进行滤波;
基于预设的非灵敏区阈值范围,对滤波后的所述反馈信号进行判断,得到舵机系统的所有静止区域,包括:
将滤波后的所述反馈信号依照单位角波控制信号的时序划分为三部分:
T为单位角波指令信号上升到最大输入电压Vmax所需时间;
基于预设的非灵敏区阈值范围,依次对三个部分的所述反馈信号进行判断,得到舵机系统的所有静止区域;
根据所有静止区域中最大静止区域所对应的时刻,得到舵机系统最大非灵敏区;
对舵机系统最大非灵敏区进行误差修正,得到修正后的舵机系统非灵敏区及非灵敏区的起始点和持续时间。
2.根据权利要求1所述的舵机系统非灵敏区判定方法,其特征在于,对反馈信号滤波设置的截止起始频率为单位角波控制信号的10倍频率。
3.根据权利要求1所述的舵机系统非灵敏区判定方法,其特征在于,所述预设的非灵敏区阈值范围为单位角波指令信号幅值的10%~20%。
4.根据权利要求1所述的舵机系统非灵敏区判定方法,其特征在于,得到舵机系统的所有静止区域,包括:
若t2时刻为舵机反馈信号幅值与t1时刻舵机反馈信号幅值差值大于等于所述预设的非灵敏区阈值范围的首次出现时刻,则对应于该t1时刻的静止区域长度Z(t1)为t2与t1的差值;t2>t1;
依次对三个部分的所有采样时刻进行判断,得到所有静止区域时刻及静止区域长度。
5.根据权利要求1或4所述的舵机系统非灵敏区判定方法,其特征在于,所述根据所有静止区域中最大静止区域所对应的时刻,得到舵机系统最大非灵敏区,包括:
比较所有静止区域长度,得到最大静止区域对应的时刻t3;
基于下式得到舵机系统最大非灵敏区Δutemp为:
Δutemp=Z(t3)*Vmax/T
其中Z(t3)为最大静止区域长度,单位s。
6.根据权利要求5所述的舵机系统非灵敏区判定方法,其特征在于,修正后的舵机非灵敏区Δu=(Z(t3)-δ)*Vmax/T,δ为因非灵敏区阈值范围ε而引入的时间误差。
7.根据权利要求6所述的舵机系统非灵敏区判定方法,其特征在于,通过判断最大非灵敏区出现的时刻,得到非灵敏区的起始点和持续时间;具体包括:
最大非灵敏区出现时刻为t3=0或T或3T时,
非灵敏区起始点:t4=t3;
非灵敏区持续时间:t=Z(t3)-δ;δ=Z(t5);
t5为舵机系统反馈信号y(t)最早出现|y(t5)-y(t3)|≥ε的时刻,t5>t3,Z(t5)为t5时刻对应的静止区域长度。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京机械设备研究所,未经北京机械设备研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910784533.6/1.html,转载请声明来源钻瓜专利网。