CN113296388A - 一种三余度无人机舵机输出指令表决方法、系统、计算机程序及存储介质 - Google Patents
一种三余度无人机舵机输出指令表决方法、系统、计算机程序及存储介质 Download PDFInfo
- Publication number
- CN113296388A CN113296388A CN202110581428.XA CN202110581428A CN113296388A CN 113296388 A CN113296388 A CN 113296388A CN 202110581428 A CN202110581428 A CN 202110581428A CN 113296388 A CN113296388 A CN 113296388A
- Authority
- CN
- China
- Prior art keywords
- value
- absolute value
- central processing
- output
- threshold value
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 31
- 238000004590 computer program Methods 0.000 title claims description 13
- 238000012545 processing Methods 0.000 claims abstract description 68
- 238000007689 inspection Methods 0.000 claims abstract description 6
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000007429 general method Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B9/00—Safety arrangements
- G05B9/02—Safety arrangements electric
- G05B9/03—Safety arrangements electric with multiple-channel loop, i.e. redundant control systems
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明提供了一种三余度无人机舵机输出指令表决方法,接收每个中央处理单元传输的单元状态和数据;判断中央处理单元的状态,将处于正确状态下的中央处理单元输入的数据传入数据对比检查单元;对所有中央处理单元输入的数据进行比对,选择最优的中央处理单元的值作为输出。本发明提出的方案能够在三块中央处理器状态均正确的情况下,给出正确的舵机输出指令,保证多余度情况下的正确数据获取。
Description
技术领域
本发明涉及无人机领域,特别涉及一种三余度无人机舵机输出指令表决方法、系统、计算机程序及存储介质。
背景技术
无人机中的舵机系统是无人机的执行机构,相当于人体的四肢,其稳定可靠运行直接关系到无人机的飞行安全。无人机的控制多采用多余度架构,即多个中央处理单元同步运行舵机控制逻辑,舵机输出控制器需要表决出采用哪个中央处理器单元的指令作为最终输出。目前无人机多采用3块中央处理单元加1块输入输出单元的架构,其中的输入输出单元需要接收3块中央处理单元的舵机指令,经过输入输出单元自身的表决算法判断出采用哪个中央处理单元的数据。一般的方法是根据中央处理器的状态进行表决,即先判断第1块中央处理器状态,如果正确则采用此数据输出,否则判断第2块和第3块。这里存在问题,此方法比较适合2块中央处理器的情况,如果3块中央处理器状态均正确,但第1块数据发生改变,可能部分数字增加,部分数字减小,则累加校验还是正确,这时还是采用第1块中央处理单元的数据,则出现错误。
发明内容
针对现有技术中存在的问题,提供了一种三余度无人机舵机输出指令表决方法、系统、计算机程序及存储介质,在多块中央处理器状态均正确的情况下,使用数据对比进行联合判断,给出正确的舵机输出指令。
本发明采用的技术方案如下:一种三余度无人机舵机输出指令表决方法,包括以下步骤:
步骤1、接收三个中央处理单元输入的信号,针对同一信号,判断每个中央处理单元输入的值,若相同,则直接输出第一块中央处理单元的值;若不同,则进入步骤2;
步骤2、对所有中央处理单元的值进行排序,计算最大值与最小值之差的绝对值1,若绝对值1小于门限值,则保持输出来源不变;若绝对值1大于门限值,则进入步骤3;
步骤3、计算最大值与中间值之差的绝对值2,计算最小值与中间值之差的绝对值3,若绝对值2与绝对值3均小于门限值,则保持输出来源不变;若仅有绝对值2或绝对值3之一大于门限值,在绝对值2大于门限值时,选择最小值作为输出,在绝对值3大于门限值时,选择最大值作为输出;若绝对值2和绝对值3均大于门限值,则保持输出来源不变。
进一步的,在步骤1之前,对中央处理单元状态进行检测,接收正确状态下的中央处理单元输入的信号。
进一步的,所述门限值根据信号对象的属性、精度以及使用场景调整。
本发明还提供了一种三余度无人机舵机输出指令表决系统,包括三个中央处理单元、输入输出单元,所述输入输出单元接收每个中央处理单元传输的单元状态和数据;
所述输入输出单元包括单元状态检查单元和数据对比检查单元,
单元状态检查单元接收每个中央处理单元输入的单元状态,判断中央处理单元的状态,将处于正确状态下的中央处理单元输入的数据传入数据对比检查单元;
所述数据对比检查单元,对所有中央处理单元输入的数据进行比对,选择最优的中央处理单元的值作为输出。
进一步的,所述数据对比检查单元的工作过程为:
步骤1、接收三个中央处理单元输入的信号,针对同一信号,判断每个中央处理单元输入的值,若相同,则直接输出第一块中央处理单元的值;若不同,则进入步骤2;
步骤2、对所有中央处理单元的值进行排序,计算最大值与最小值之差的绝对值1,若绝对值1小于门限值,则保持输出来源不变;若绝对值1大于门限值,则进入步骤3;
步骤3、计算最大值与中间值之差的绝对值2,计算最小值与中间值之差的绝对值3,若绝对值2与绝对值3均小于门限值,则保持输出来源不变;若仅有绝对值2或绝对值3之一大于门限值,在绝对值2大于门限值时,选择最小值作为输出,在绝对值3大于门限值时,选择最大值作为输出;若绝对值2和绝对值3均大于门限值,则保持输出来源不变。
进一步的,所述门限值为门限值根据信号对象的属性、精度以及使用场景调整。
本发明还提供了一种计算机程序,其包括有计算机程序指令,其中,所述程序指令被处理器执行时用于实现权利要求1-3中任一项所述的三余度无人机舵机输出指令表决方法对应的过程。
本发明还提供了一种存储介质,其上存储有计算机程序指令,其中,所述程序指令被处理器执行时用于实现权利要求1-3中任一项所述的三余度无人机舵机输出指令表决方法对应的过程。
与现有技术相比,采用上述技术方案的有益效果为:能够在多块中央处理器状态均正确的情况下,给出正确的舵机输出指令,保证多余度情况下的正确数据获取。
附图说明
图1是本发明提出的三余度无人机舵机输出指令表决系统示意图。
具体实施方式
下面结合附图对本发明做进一步描述。
实施例1
本实施例提出了一种三余度无人机舵机输出指令表决方法,包括以下步骤:
步骤1、接收三个中央处理单元输入的信号,针对同一信号,判断每个中央处理单元输入的值,若相同,则直接输出第一块中央处理单元的值;若不同,则进入步骤2;
步骤2、对所有中央处理单元的值进行排序,计算最大值与最小值之差的绝对值1,若绝对值1小于门限值,则保持输出来源不变;若绝对值1大于门限值,则进入步骤3;
步骤3、计算最大值与中间值之差的绝对值2,计算最小值与中间值之差的绝对值3,若绝对值2与绝对值3均小于门限值,则保持输出来源不变;若仅有绝对值2或绝对值3之一大于门限值,在绝对值2大于门限值时,选择最小值作为输出,在绝对值3大于门限值时,选择最大值作为输出;若绝对值2和绝对值3均大于门限值,则保持输出来源不变。
在步骤1之前,对中央处理单元状态进行检测,接收正确状态下的中央处理单元输入的信号。
优选的,所述中央处理单元数量为3。
优选的,所述门限值根据信号对象的属性、精度以及使用场景调整。
实施例2
如图1所示,本实施例提供了一种三余度无人机舵机输出指令表决系统,包括三个中央处理单元、输入输出单元,所述输入输出单元接收每个中央处理单元传输的单元状态和数据;
所述输入输出单元包括单元状态检查单元和数据对比检查单元,
单元状态检查单元接收每个中央处理单元输入的单元状态,判断中央处理单元的状态,将处于正确状态下的中央处理单元输入的数据传入数据对比检查单元;
所述数据对比检查单元,对所有中央处理单元输入的数据进行比对,选择最优的中央处理单元的值作为输出。
具体的,所述数据对比检查单元的工作过程为:
步骤1、接收三个中央处理单元输入的信号,针对同一信号,判断每个中央处理单元输入的值,若相同,则直接输出第一块中央处理单元的值;若不同,则进入步骤2;
步骤2、对所有中央处理单元的值进行排序,计算最大值与最小值之差的绝对值1,若绝对值1小于门限值,则保持输出来源不变;若绝对值1大于门限值,则进入步骤3;
步骤3、计算最大值与中间值之差的绝对值2,计算最小值与中间值之差的绝对值3,若绝对值2与绝对值3均小于门限值,则保持输出来源不变;若仅有绝对值2或绝对值3之一大于门限值,在绝对值2大于门限值时,选择最小值作为输出,在绝对值3大于门限值时,选择最大值作为输出;若绝对值2和绝对值3均大于门限值,则保持输出来源不变。
进一步的,所述门限值根据信号对象的属性、精度以及使用场景调整。
实施例3
本实施例还提供了一种计算机程序,其包括有计算机程序指令,其中,所述程序指令被处理器执行时用于实现实施例1所述的三余度无人机舵机输出指令表决方法对应的过程。
实施例4
本实施例还提供了一种存储介质,其上存储有计算机程序指令,其中,所述程序指令被处理器执行时用于实现实施例1所述的三余度无人机舵机输出指令表决方法对应的过程。
本发明并不局限于前述的具体实施方式。本发明扩展到任何在本说明书中披露的新特征或任何新的组合,以及披露的任一新的方法或过程的步骤或任何新的组合。如果本领域技术人员,在不脱离本发明的精神所做的非实质性改变或改进,都应该属于本发明权利要求保护的范围。
本说明书中公开的所有特征,或公开的所有方法或过程中的步骤,除了互相排斥的特征和/或步骤以外,均可以以任何方式组合。
本说明书中公开的任一特征,除非特别叙述,均可被其他等效或具有类似目的的替代特征加以替换。即,除非特别叙述,每个特征只是一系列等效或类似特征中的一个例子而已。
Claims (8)
1.一种三余度无人机舵机输出指令表决方法,其特征在于,包括以下步骤:
步骤1、接收三个中央处理单元输入的信号,针对同一信号,判断每个中央处理单元输入的值,若相同,则直接输出第一块中央处理单元的值;若不同,则进入步骤2;
步骤2、对所有中央处理单元的值进行排序,计算最大值与最小值之差的绝对值1,若绝对值1小于门限值,则保持输出来源不变;若绝对值1大于门限值,则进入步骤3;
步骤3、计算最大值与中间值之差的绝对值2,计算最小值与中间值之差的绝对值3,若绝对值2与绝对值3均小于门限值,则保持输出来源不变;若仅有绝对值2或绝对值3之一大于门限值,在绝对值2大于门限值时,选择最小值作为输出,在绝对值3大于门限值时,选择最大值作为输出;若绝对值2和绝对值3均大于门限值,则保持输出来源不变。
2.根据权利要求1所述的三余度无人机舵机输出指令表决方法,其特征在于,在步骤1之前,对中央处理单元状态进行检测,接收正确状态下的中央处理单元输入的信号。
3.根据权利要求1所述的三余度无人机舵机输出指令表决方法,其特征在于,所述门限值根据信号对象的属性、精度以及使用场景调整。
4.一种三余度无人机多级输出指令表决系统,其特征在于,包括三个中央处理单元、输入输出单元,所述输入输出单元接收每个中央处理单元传输的单元状态和数据;
所述输入输出单元包括单元状态检查单元和数据对比检查单元,
单元状态检查单元接收每个中央处理单元输入的单元状态,判断中央处理单元的状态,将处于正确状态下的中央处理单元输入的数据传入数据对比检查单元;
所述数据对比检查单元,对所有中央处理单元输入的数据进行比对,选择最优的中央处理单元的值作为输出。
5.根据权利要求4所述的三余度无人机舵机输出指令表决系统,其特征在于,所述数据对比检查单元的工作过程为:
步骤1、接收三个中央处理单元输入的信号,针对同一信号,判断每个中央处理单元输入的值,若相同,则直接输出第一块中央处理单元的值;若不同,则进入步骤2;
步骤2、对所有中央处理单元的值进行排序,计算最大值与最小值之差的绝对值1,若绝对值1小于门限值,则保持输出来源不变;若绝对值1大于门限值,则进入步骤3;
步骤3、计算最大值与中间值之差的绝对值2,计算最小值与中间值之差的绝对值3,若绝对值2与绝对值3均小于门限值,则保持输出来源不变;若仅有绝对值2或绝对值3之一大于门限值,在绝对值2大于门限值时,选择最小值作为输出,在绝对值3大于门限值时,选择最大值作为输出;若绝对值2和绝对值3均大于门限值,则保持输出来源不变。
6.根据权利要求4所述的三余度无人机舵机输出指令表决系统,其特征在于,所述门限值根据信号对象的属性、精度以及使用场景调整。
7.一种计算机程序,其包括有计算机程序指令,其中,所述程序指令被处理器执行时用于实现权利要求1-3中任一项所述的三余度无人机舵机输出指令表决方法对应的过程。
8.一种存储介质,其上存储有计算机程序指令,其中,所述程序指令被处理器执行时用于实现权利要求1-3中任一项所述的三余度无人机舵机输出指令表决方法对应的过程。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110581428.XA CN113296388A (zh) | 2021-05-27 | 2021-05-27 | 一种三余度无人机舵机输出指令表决方法、系统、计算机程序及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110581428.XA CN113296388A (zh) | 2021-05-27 | 2021-05-27 | 一种三余度无人机舵机输出指令表决方法、系统、计算机程序及存储介质 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113296388A true CN113296388A (zh) | 2021-08-24 |
Family
ID=77325369
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110581428.XA Pending CN113296388A (zh) | 2021-05-27 | 2021-05-27 | 一种三余度无人机舵机输出指令表决方法、系统、计算机程序及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113296388A (zh) |
Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3551776A (en) * | 1968-10-01 | 1970-12-29 | Bendix Corp | Triple redundant servo flight control including digital resynchronization of channels,detection of failed channels,and voted output |
EP0110885A1 (en) * | 1982-06-16 | 1984-06-20 | Boeing Co | AUTOPILOT DIRECTION SYSTEM. |
US4517639A (en) * | 1982-05-13 | 1985-05-14 | The Boeing Company | Fault scoring and selection circuit and method for redundant system |
US5206810A (en) * | 1991-02-07 | 1993-04-27 | General Electric Company | Redundant actuator control |
US5428769A (en) * | 1992-03-31 | 1995-06-27 | The Dow Chemical Company | Process control interface system having triply redundant remote field units |
CN104677360A (zh) * | 2015-03-09 | 2015-06-03 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种姿态航向角的余度管理算法 |
EP3213990A1 (en) * | 2016-03-03 | 2017-09-06 | Sikorsky Aircraft Corporation | Fly-by-wire retrofit kit |
CN109557808A (zh) * | 2018-10-30 | 2019-04-02 | 成都飞机工业(集团)有限责任公司 | 一种冗余计算机通道间互监控方法 |
CN110442073A (zh) * | 2019-08-30 | 2019-11-12 | 四川腾盾科技有限公司 | 一种多余度飞机管理计算机mio板通道故障逻辑判断方法 |
CN110673690A (zh) * | 2019-08-29 | 2020-01-10 | 四川腾盾科技有限公司 | 一种多余度飞机管理计算机的三通道cpu同步方法 |
CN110928217A (zh) * | 2019-11-18 | 2020-03-27 | 天津津航计算技术研究所 | 一种应用于航空电热控制系统的cpu三余度表决电路 |
CN112558461A (zh) * | 2021-02-25 | 2021-03-26 | 四川腾盾科技有限公司 | 一种多余度无人机飞机管理计算机输出信号表决方法 |
US20210096965A1 (en) * | 2019-09-26 | 2021-04-01 | Gulfstream Aerospace Corporation | Voting of triple redundant circular data |
CN112783523A (zh) * | 2021-01-18 | 2021-05-11 | 四川腾盾科技有限公司 | 一种多余度飞机管理计算机软件空中加载方法 |
-
2021
- 2021-05-27 CN CN202110581428.XA patent/CN113296388A/zh active Pending
Patent Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3551776A (en) * | 1968-10-01 | 1970-12-29 | Bendix Corp | Triple redundant servo flight control including digital resynchronization of channels,detection of failed channels,and voted output |
US4517639A (en) * | 1982-05-13 | 1985-05-14 | The Boeing Company | Fault scoring and selection circuit and method for redundant system |
EP0110885A1 (en) * | 1982-06-16 | 1984-06-20 | Boeing Co | AUTOPILOT DIRECTION SYSTEM. |
US5206810A (en) * | 1991-02-07 | 1993-04-27 | General Electric Company | Redundant actuator control |
US5428769A (en) * | 1992-03-31 | 1995-06-27 | The Dow Chemical Company | Process control interface system having triply redundant remote field units |
CN104677360A (zh) * | 2015-03-09 | 2015-06-03 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种姿态航向角的余度管理算法 |
EP3213990A1 (en) * | 2016-03-03 | 2017-09-06 | Sikorsky Aircraft Corporation | Fly-by-wire retrofit kit |
CN109557808A (zh) * | 2018-10-30 | 2019-04-02 | 成都飞机工业(集团)有限责任公司 | 一种冗余计算机通道间互监控方法 |
CN110673690A (zh) * | 2019-08-29 | 2020-01-10 | 四川腾盾科技有限公司 | 一种多余度飞机管理计算机的三通道cpu同步方法 |
CN110442073A (zh) * | 2019-08-30 | 2019-11-12 | 四川腾盾科技有限公司 | 一种多余度飞机管理计算机mio板通道故障逻辑判断方法 |
US20210096965A1 (en) * | 2019-09-26 | 2021-04-01 | Gulfstream Aerospace Corporation | Voting of triple redundant circular data |
CN110928217A (zh) * | 2019-11-18 | 2020-03-27 | 天津津航计算技术研究所 | 一种应用于航空电热控制系统的cpu三余度表决电路 |
CN112783523A (zh) * | 2021-01-18 | 2021-05-11 | 四川腾盾科技有限公司 | 一种多余度飞机管理计算机软件空中加载方法 |
CN112558461A (zh) * | 2021-02-25 | 2021-03-26 | 四川腾盾科技有限公司 | 一种多余度无人机飞机管理计算机输出信号表决方法 |
Non-Patent Citations (2)
Title |
---|
JUNHUA CHEN ,等: "Design of FlexRay-based communication on triplex redundancy flight control computer", 《IEEE》 * |
曹东,等: "三余度飞行控制计算机FlexRay节点通信设计", 《计算机测量与控制》 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US20070027603A1 (en) | Inertial sensor software architecture security method | |
US7826962B2 (en) | Electronic control apparatus | |
US9612922B2 (en) | Computer system and method for comparing output signals | |
US20200262544A1 (en) | Fly-by-wire systems and related operating methods | |
US20210146939A1 (en) | Device and method for controlling a vehicle module | |
US7366597B2 (en) | Validating control system software variables | |
CN111891134B (zh) | 自动驾驶处理系统和片上系统、监测处理模块的方法 | |
US9335756B2 (en) | Method for the efficient protection of safety-critical functions of a controller and a controller | |
US7904796B2 (en) | Serial data communication—CAN memory error detection methods | |
KR20120098326A (ko) | 반도체 장치 및 데이터 처리방법 | |
US11347676B2 (en) | Methods for managing communications involving a lockstep processing system | |
US11762761B2 (en) | Generating synthetic test cases for network fuzz testing | |
US20060179366A1 (en) | Methods and systems for secure control of system modes and sub-modes | |
CN113296388A (zh) | 一种三余度无人机舵机输出指令表决方法、系统、计算机程序及存储介质 | |
CN112558461B (zh) | 一种多余度无人机飞机管理计算机输出信号表决方法 | |
US10585772B2 (en) | Power supply diagnostic strategy | |
KR101295770B1 (ko) | 안전 무결성 확보를 위한 열차제어 시스템 | |
GB2391333A (en) | Method and apparatus for selecting between two sensor output signals in an electronic throttle system. | |
US7869915B2 (en) | Method and apparatus for validating processors using seed and key tests | |
EP2759936B1 (en) | System and method for three input voting | |
US20220283913A1 (en) | Voting of triple redundant circular data | |
US9244750B2 (en) | Method and control system for carrying out a plausibility check of a first driver input sensor with regard to a second driver input sensor which is different from the first driver input sensor of a motor vehicle | |
US7464203B2 (en) | Method of validating plurality of data during serial communication using a dual path across a single serial link | |
JP5226653B2 (ja) | 車載制御装置 | |
US20130007514A1 (en) | Redundant system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210824 |
|
RJ01 | Rejection of invention patent application after publication |