一种舵机舵面角位置传感器冗余装置的制作方法

文档序号:5982073阅读:254来源:国知局
专利名称:一种舵机舵面角位置传感器冗余装置的制作方法
技术领域
本发明涉及一种角位置传感器冗余装置,尤其是一种用于余度舵机系统的舵面角位置传感器冗余装置。
背景技术
在余度舵机系统中,舵面角位置传感器主要用来实时采集舵面的位置,并通过调理电路进行处理,之后经过滤波电路送入CPU得到位置综合输出,所以舵面角位置传感器是系统中非常重要的一部分,它为系统提供了位置反馈信号,让系统更加有效、稳定的运行。角位置传感器的可靠性则直接影响位置信号的采集,从而影响舵系统的安全运行。目前,在舵机系统中,主要采用的是单余度角位置传感器,若其出现故障,则会引起系统位置反馈出错,整个系统错误运行甚至导致系统崩溃,所以主要致力于对其电力电子器件性能和可靠性的提高。西北工业大学的张海涛发表的论文《高精度双余度舵机伺服 系统研究》就是利用的这种技术,由于材料、制造工艺原因,已经很难大幅度提高这些电子器件的性能和可靠性,且会大幅增加成本。
发明内容本发明描述并提供了一种舵面角位置传感器冗余装置,它能够在角位置传感器正常工作时,利用双余度的优势,提高角位置传感器的精度,而在一个余度出现故障时,能立即检测出故障,并将故障余度角位置传感器隔离,切换到单余度工作模式,利用未故障余度角位置传感器继续对舵面角位置进行采集与处理,有效的提高了舵机系统舵面角位置传感器的可靠性。本发明解决其技术问题所采用的技术方案是包括CPU、滤波电路、调理电路和双余度角位置传感器。其中,双余度角位置传感器采集舵机舵面的角位置,输出两路舵面角位置采样值,分别经过一个调理电路,调理成CPU的AD模块能够识别的电压值,再分别经过一个滤波电路滤波,输入CPU进行处理。当一个余度发生故障时,切除该余度信号,并用另一余度的舵面角位置采样值作为最终的位置闭环反馈数据,系统仍然可以完成指定功能。所述的双余度角度位置传感器为两个电气独立的电位计,同轴安装,且分别连接一个调理电路。本发明工作时包括以下步骤第一步采集舵机的两路舵面角位置采样值,分别进行调理和滤波。第二步判断两路舵面角位置采样值是否都超出设定阈值,若是,则判定装置故障并报错,位置闭环反馈数据(即位置值综合输出)等于0,;若不是,进入第三步。第三步判断两路舵面角位置采样值的差值是否超出设定阈值,若不是,位置闭环反馈数据等于两路舵面角位置采样值之和除以二;若是,进入第四步。第四步判断舵面位置给定值与两路舵面角位置采样值的差值大小,位置闭环反馈数据等于较小差值对应的那一路舵面角位置采样值。[0012]第二步所述的设定阈值为-30° +30°,第三步所述的设定阈值为-3° +3°。本发明应用于舵机舵面角位置监测与反馈,与传统位置传感器监测与反馈方法相比具有以下优点I)采用双余度传感器,在两个余度传感器正常工作时,减小了传感器的误差,提高了传感器的精度。2)当一个余度传感器故障时,系统能够继续正常工作,提高了系统的可靠性。3)当一个余度传感器故障时,提供相应的故障点信息,为装置维护提供了方便。

图I为舵机舵面角位置传感器传感器冗余装置结构图。
·[0018]图中,I一位置传感器冗余控制模块CPU,2—余度I滤波电路,3—余度2滤波电路,4一余度I调理电路,5—余度2调理电路,6—双余度位置传感器。图2为双余度位置传感器结构图。图中,7—余度I位置传感器,8—余度2位置传感器。图3为舵机舵面角位置传感器冗余装置控制方法。
具体实施方式
本发明包括CPU、余度I滤波电路、余度I调理电路、余度2滤波电路、余度2调理电路、双余度角位置传感器。其中,双余度角位置传感器采集舵机舵面的角位置,输出两路舵面角位置值,分别经过余度I调理电路和余度2调理电路,调理成CPU的AD端口能够识别的电压值,再经余度I滤波电路和余度2滤波电路滤波,输入CPU进行处理。舵面角度位置传感器为两个电气独立的电位计同轴安装,且分别接于控制系统的余度I及余度2调理电路。舵面角位置传感器故障一般表现为线路接触不良,此时采样得到的反馈值会明显地偏离位置偏转角对应电压信号的正常范围。经实际调试,将舵机舵面位置偏转角在-30° +30°正常变化时的电压输出信号放大调理成可供CPU中AD模块采样的O. 417 2. 083V电压;若发生线路短路故障,则采样值会恒表现为O或3V (对应极限偏转位置),因此可以判定该余度电位计发生故障,应该及时切除,并用另一余度的位置采样值作为最终的位置闭环反馈数据,系统仍然可以完成指定功能。控制方法如下第一步对余度I和余度2位置反馈值进行采集。进入第二步。第二步判断余度I位置反馈值和余度2位置反馈值是否都超出设定阈值,若是,则位置值综合输出=0,装置故障并报错;若不是,进入第三步。第三步判断余度I位置反馈值和余度2位置反馈值的差值的绝对值是否超出设定阈值,若不是,位置综合输出=(余度I位置反馈值+余度2位置反馈值)/2 ;若是,进入第四步。第四步判断位置给定与余度2位置反馈值的差值的绝对值是否大于位置给定与余度I位置反馈值的差值的绝对值,若是,位置综合输出=余度I位置反馈值;若不是,位置综合输出=余度2位置反馈值。本发明在原有的角位置传感器结构和控制方法上做了改进,选择了高精度、高性能的双余度位置传感器,并且对控制策略与方法进行了改进。此冗余装置为热备份模式,即在正常情况下,两余度同时工作,在某一余度发生故障时,立即对故障余度进行隔离,智能切换到未故障余度的位置传感器进行位置信号的采集与处理,进入单余度工作模式。所以这项发明提高了舵面角位置传感器部分的可靠性,而且还能进行故障诊断与隔离,进而切换至正常余度工作,保证了整个系统的正常运行。
以下结合附图和实施例对本发明进一步说明。如图I所示,本发明包括位置传感器冗余控制模块CPUl,余度I滤波电路2,余度2滤波电路3,余度I调理电路4,余度2调理电路5,双余度位置传感器6。其中,双余度位置传感器6采集舵机舵面角位置,输出两路舵面角位置值,分别经过余度I调理电路2和余度2调理电路3 (如利用AD620放大),调理成CPU的AD端口能够识别的电压值,分别经余度I滤波电路4和余度2滤波电路5滤波(如二阶有源滤波),输入位置传感器冗余控制模块 CPUl。双余度位置传感器如图2所示,它由余度I位置传感器7和余度2位置传感器8构成,彼此互为余度,且电气隔离。当一个位置传感器出现故障,另一个位置传感器仍可正 常工作。如图3所示,是舵机舵面角位置传感器冗余装置控制方法。第一步对余度I和余度2位置反馈值进行采集。进入第二步。第二步判断余度I位置反馈值和余度2位置反馈值是否都超出设定阈值(本样机中为-30° ^30° ),若是,则位置值综合输出=0,装置故障并报错;若不是,进入第三步。第三步判断余度I位置反馈值和余度2位置反馈值的差值的绝对值是否超出设定阈值(本样机中为-3° 3° ),若不是,位置综合输出=(余度I位置反馈值+余度2位置反馈值)/2 ;若是,进入第四步。第四步判断位置给定与余度2位置反馈值的差值的绝对值是否大于位置给定与余度I位置反馈值的差值的绝对值,若是,位置综合输出=余度I位置反馈值;若不是,位置综合输出=余度2位置反馈值。
权利要求1.一种舵机舵面角位置传感器冗余装置,包括CPU、滤波电路、调理电路和双余度角位置传感器,其特征在于双余度角位置传感器采集舵机舵面的角位置,输出两路舵面角位置采样值,分别经过一个调理电路,调理成CPU的AD模块能够识别的电压值,再分别经过一个滤波电路滤波,输入CPU进行处理。
2.根据权利要求I所述的舵机舵面角位置传感器冗余装置,其特征在于所述的双余度角度位置传感器为两个电气独立的电位计,同轴安装。
专利摘要本实用新型公开了一种舵机舵面角位置传感器冗余装置,双余度角位置传感器采集舵机舵面的角位置,输出两路舵面角位置采样值,分别经过一个调理电路,调理成CPU的AD模块能够识别的电压值,再分别经过一个滤波电路滤波,输入CPU进行处理,当一个余度发生故障时,切除该余度信号,并用另一余度的舵面角位置采样值作为最终的位置闭环反馈数据。本实用新型减小了传感器的误差,提高了传感器的精度;提高了系统的可靠性;为装置维护提供了方便。
文档编号G01C1/00GK202692976SQ20122025384
公开日2013年1月23日 申请日期2012年5月31日 优先权日2012年5月31日
发明者林辉, 马冬麒, 戴志勇, 吴春, 齐蓉 申请人:西北工业大学
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1