[go: up one dir, main page]

CN107168044A - 一种水下机器人推进器容错系统 - Google Patents

一种水下机器人推进器容错系统 Download PDF

Info

Publication number
CN107168044A
CN107168044A CN201710463560.4A CN201710463560A CN107168044A CN 107168044 A CN107168044 A CN 107168044A CN 201710463560 A CN201710463560 A CN 201710463560A CN 107168044 A CN107168044 A CN 107168044A
Authority
CN
China
Prior art keywords
module
motor
servo motor
fault
auxiliary
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
Application number
CN201710463560.4A
Other languages
English (en)
Inventor
冀大雄
辜立忠
宋伟
朱世强
邓志
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhejiang University ZJU
Original Assignee
Zhejiang University ZJU
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Zhejiang University ZJU filed Critical Zhejiang University ZJU
Priority to CN201710463560.4A priority Critical patent/CN107168044A/zh
Publication of CN107168044A publication Critical patent/CN107168044A/zh
Pending legal-status Critical Current

Links

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)
  • Manipulator (AREA)

Abstract

本发明涉及水下机器人技术领域，旨在提供一种水下机器人推进器容错系统。该系统包括电子调速器和两个伺服电机，电子调速器分别连中央控制系统模块和伺服电机；伺服电机通过各自配合的电磁离合器接至一个双入单出的并车齿轮箱；在伺服电机上分别设置用于监测电机转速的接近开关，两个接近开关均与电机检测模块相接；电机检测模块通过导线分别接至两个电磁离合器，以及向两个伺服电机供电的电源；设置在辅伺服电机上的接近开关还通过导线接至应急监控模块，应急监控模块通过导线与回收控制模块相接。本发明具有可操作性强、舱容占用小、布置方便、可推广性强等优点，能够较好的实现硬件层面的主机故障自检、警报和自动容错功能。

Description

一种水下机器人推进器容错系统
技术领域
本发明涉及水下机器人技术领域，尤其涉及一种水下机器人推进器容错机制，该容错机制是一种自动化、智能化的水下机器人主机容错装置。
背景技术
当前，由于海洋深处工况的复杂性和难以预测性，无人水下机器人在深海作业时，一旦出现故障，将会面临无法顺利完成水下作业任务以及自身无法回收等严峻问题，为水下机器人的推广应用带来了很大阻碍。因此，水下机器人的可靠性保障研究显得非常关键，它的故障诊断与容错研究就是水下机器人技术研究的热点领域之一，其对自身状态的自主诊断和容错的能力是体现其智能水平的重要因素，也是AUV安全完成使命任务的有力保障。
容错控制思想产生的标志是1971年Niederlinski对完整性控制概念的提出。在系统发生故障时，除了进行修复外，可真正提高系统安全性和可靠性的途径是容错控制技术。
其中，冗余是容错技术实现的最核心的手段和方法，也是实现容错的前提因素，如何充分利用冗余来实现容错目标是容错控制技术研究、设计的关键。容错控制器的设计主要分为硬件冗余和软件冗余(解析冗余)两种方法。硬件冗余主要是增加系统关键部件及故障频发部件的数量，即通过硬件的重复布置来获得容错能力。软件冗余(解析冗余)主要是利用系统内部存在的解析关系，通过解析方式表示的系统数学模型来产生冗余的信号，或者使用多个不同软件执行同一功能，利用软件设计差异来实现容错。
硬件冗余的优点是便于设计、实现简单，但是，过度的硬件冗余会增加机舱区的舱容大小，不但影响水下机器人的布局、浮态调整，也会增加制造、维修成本。所以，为了配合硬件冗余，高等级水下机器人冗余研究还应辅以软件冗余(解析冗余)。这种方式的优点是成本低，但对容错控制算法的设计要求较高。
发明内容
本发明要解决的技术问题是，克服现有技术中的不足，提供一种水下机器人推进器容错系统。
为解决技术问题，本发明的解决方案是：
提供一种水下机器人推进器容错系统，包括电子调速器和用于提供推进器驱动力的伺服电机，电子调速器分别连中央控制系统模块和伺服电机；所述伺服电机有两个，分别为主伺服电机和辅伺服电机；主伺服电机和辅伺服电机通过各自配合的电磁离合器接至一个双入单出的并车齿轮箱；在主伺服电机和辅伺服电机上分别设置用于监测电机转速的接近开关，两个接近开关均与电机检测模块相接；电机检测模块通过导线分别接至两个电磁离合器，以及向两个伺服电机供电的电源；设置在辅伺服电机上的接近开关还通过导线接至应急监控模块，应急监控模块通过导线与回收控制模块相接。
本发明中，所述中央控制系统模块是单片机、中央处理器或者是智能处理终端。
本发明中，所述电机检测模块还与故障报警模块相接。
与现有技术相比，本发明的有益效果在于：
1、具有可操作性强、舱容占用小、布置方便、可推广性强等优点，能够较好的实现硬件层面的主机故障自检、警报和自动容错功能。
2、该系统仅针对主推进器进行冗余设置，有效避免了过度硬件冗余带来的负面影响，同时和后期在此基础上设置的软件冗余系统能够实现较好的合作容错关系。
附图说明
图1为本发明中推进器容错系统流程图。
图2为并车齿轮箱示意图。
图2中的附图标记：(主输入端的)电磁离合器1、(辅输入端的)电磁离合器2、主输入端3、辅输入端4、输出端5。
具体实施方式
首先需要强调的是，本发明所述各模块均为电路逻辑的集合，而非虚拟功能模块。其具体实现是本领域常见技术手段，本领域技术人员通过对本发明的阅读，根据其掌握的常规技术手段完全可以再现。本发明中不存在任何方法特征，即便在没有电路图的基础上本领域也是可以实施的。
如图1所示，本发明中的水下机器人推进器容错系统，包括电子调速器和用于提供推进器驱动力的伺服电机，电子调速器分别连中央控制系统模块和伺服电机。中央控制系统模块可以是单片机、中央处理器或者是智能处理终端中的任意一种，用于实现对水下机器人推进器运行过程的控制，还可以进一步实现水下机器人作业操作的控制。
本发明中的伺服电机有两个，分别为主伺服电机和辅伺服电机。主伺服电机和辅伺服电机通过各自配合的电磁离合器接至一个双入单出的并车齿轮箱；在主伺服电机和辅伺服电机上分别设置用于监测电机转速的接近开关，两个接近开关均与电机检测模块相接；电机检测模块通过导线分别接至两个电磁离合器，以及用于向两个伺服电机供电的电源，电机检测模块还与故障报警模块相接。设置在辅伺服电机上的接近开关还通过导线接至应急监控模块，应急监控模块通过导线与回收控制模块相接。
本发明中并车齿轮箱的结构示意如图2所示。主输入端的电磁离合器1与辅输入端的电磁离合器2并联设置，通过并车齿轮箱的主输入端3和辅输入端4实现双入单出，由输出端5提供推进器的驱动力。
本发明所述水下机器人推进器容错系统的运作方式具体描述如下：
初始状态时，在接收到来自于中央控制系统模块的上层结构的指令之后，由电子调速器将调速命令信号同时输送到主伺服电机和辅伺服电机。正常工作情况下，主伺服电机处于通电状态，辅伺服电机处于断电状态。相应地，与主伺服电机相连接的电磁离合器处于通电状态，而与辅伺服电机相连接的电磁离合器处于断电状态。在初始状态下，与主伺服电机相连的单列结构正常作业，与辅伺服电机相连的单列结构处于待机状态。
在电子调速器向伺服电机发出非零信号后，电机检测模块开始工作。设于主伺服电机上的接近开关监测主伺服电机转速，并将检测数据传送至电机检测模块进行残差分析。当残差数值高于设定阈值的持续时间达到3s时，电机检测模块发出指令信号：断开主伺服电机的电源供应、停止主伺服电机所对应的电磁离合器运行；同时，导通辅伺服电机的电源供应、启动辅伺服电机所对应的电磁离合器；并且导通故障报警模块，发出伺服电机运行故障警报。
此后，电机检测模块转而监测辅伺服电机的运转情况。当辅伺服电机开始运行，且对应的接近开关监测辅伺服电机转速并首次输出时，与接近开关连接的应急监控模块同时开始运行。如辅伺服电机出现故障，电机检测模块发出指令信号，断开辅伺服电机电源供应、停止辅伺服电机所对应的电磁离合器运行。同时，应急监控模块向回收控制模块发出信号，由回收控制模块根据预设的运行程序进行水下机器人的回收作业。

Claims (3)

1.一种水下机器人推进器容错系统，包括电子调速器和用于提供推进器驱动力的伺服电机，电子调速器分别连中央控制系统模块和伺服电机；其特征在于，所述伺服电机有两个，分别为主伺服电机和辅伺服电机；主伺服电机和辅伺服电机通过各自配合的电磁离合器接至一个双入单出的并车齿轮箱；在主伺服电机和辅伺服电机上分别设置用于监测电机转速的接近开关，两个接近开关均与电机检测模块相接；电机检测模块通过导线分别接至两个电磁离合器，以及用于向两个伺服电机供电的电源；设置在辅伺服电机上的接近开关还通过导线接至应急监控模块，应急监控模块通过导线与回收控制模块相接。
2.根据权利要求1所述的容错系统，其特征在于，所述中央控制系统模块是单片机、中央处理器或者是智能处理终端。
3.根据权利要求1所述的容错系统，其特征在于，所述电机检测模块还与故障报警模块相接。
CN201710463560.4A 2017-06-19 2017-06-19 一种水下机器人推进器容错系统 Pending CN107168044A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710463560.4A CN107168044A (zh) 2017-06-19 2017-06-19 一种水下机器人推进器容错系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710463560.4A CN107168044A (zh) 2017-06-19 2017-06-19 一种水下机器人推进器容错系统

Publications (1)

Publication Number Publication Date
CN107168044A true CN107168044A (zh) 2017-09-15

Family

ID=59819754

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710463560.4A Pending CN107168044A (zh) 2017-06-19 2017-06-19 一种水下机器人推进器容错系统

Country Status (1)

Country Link
CN (1) CN107168044A (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110262214A (zh) * 2019-07-22 2019-09-20 北京航天发射技术研究所 起竖控制系统
CN111275164A (zh) * 2020-01-13 2020-06-12 浙江大学 一种水下机器人推进系统故障的诊断方法
CN112083645A (zh) * 2020-07-30 2020-12-15 上海航天控制技术研究所 一种推力器冗余模式管理及故障屏蔽与自主恢复方法

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5422826A (en) * 1990-09-10 1995-06-06 Zond Systems, Inc. Microcontroller based control system for use in a wind turbine
CN101670886A (zh) * 2008-09-11 2010-03-17 上海海事大学 水下机器人推进器信息融合故障诊断方法及装置
CN101969288A (zh) * 2009-07-27 2011-02-09 帕克-汉尼芬公司 双电机致动器
CN102251711A (zh) * 2011-06-29 2011-11-23 上海铭源数码股份有限公司 电子锁双电机离合器驱动机构
CN102320325A (zh) * 2011-06-24 2012-01-18 吉林大学 应用于双电机线控转向系统的冗余容错控制方法
CN202828079U (zh) * 2012-07-30 2013-03-27 康士伯控制系统(上海)有限公司 一种基于双冗余控制器的推进控制系统
CN203474132U (zh) * 2013-09-24 2014-03-12 上海华菱电站成套设备有限公司 一种中压变频双控制器冗余装置
CN203827241U (zh) * 2014-05-21 2014-09-10 大唐韩城第二发电有限责任公司 一种ggh转子驱动装置
CN104678762A (zh) * 2013-11-29 2015-06-03 哈尔滨恒誉名翔科技有限公司 一种基于推进器故障的uuv容错控制系统
CN204883290U (zh) * 2015-08-19 2015-12-16 张桂臣 全回转机桨舵复合监控系统
CN105676756A (zh) * 2015-08-19 2016-06-15 张桂臣 全回转机桨舵复合监控系统以及监控方法
CN206892572U (zh) * 2017-06-19 2018-01-16 浙江大学 水下机器人推进器容错系统

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5422826A (en) * 1990-09-10 1995-06-06 Zond Systems, Inc. Microcontroller based control system for use in a wind turbine
CN101670886A (zh) * 2008-09-11 2010-03-17 上海海事大学 水下机器人推进器信息融合故障诊断方法及装置
CN101969288A (zh) * 2009-07-27 2011-02-09 帕克-汉尼芬公司 双电机致动器
CN102320325A (zh) * 2011-06-24 2012-01-18 吉林大学 应用于双电机线控转向系统的冗余容错控制方法
CN102251711A (zh) * 2011-06-29 2011-11-23 上海铭源数码股份有限公司 电子锁双电机离合器驱动机构
CN202828079U (zh) * 2012-07-30 2013-03-27 康士伯控制系统(上海)有限公司 一种基于双冗余控制器的推进控制系统
CN203474132U (zh) * 2013-09-24 2014-03-12 上海华菱电站成套设备有限公司 一种中压变频双控制器冗余装置
CN104678762A (zh) * 2013-11-29 2015-06-03 哈尔滨恒誉名翔科技有限公司 一种基于推进器故障的uuv容错控制系统
CN203827241U (zh) * 2014-05-21 2014-09-10 大唐韩城第二发电有限责任公司 一种ggh转子驱动装置
CN204883290U (zh) * 2015-08-19 2015-12-16 张桂臣 全回转机桨舵复合监控系统
CN105676756A (zh) * 2015-08-19 2016-06-15 张桂臣 全回转机桨舵复合监控系统以及监控方法
CN206892572U (zh) * 2017-06-19 2018-01-16 浙江大学 水下机器人推进器容错系统

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
辜立忠等: "水下机器人推进器故障诊断研究综述", 《科技资讯》 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110262214A (zh) * 2019-07-22 2019-09-20 北京航天发射技术研究所 起竖控制系统
CN111275164A (zh) * 2020-01-13 2020-06-12 浙江大学 一种水下机器人推进系统故障的诊断方法
CN112083645A (zh) * 2020-07-30 2020-12-15 上海航天控制技术研究所 一种推力器冗余模式管理及故障屏蔽与自主恢复方法
CN112083645B (zh) * 2020-07-30 2024-05-03 上海航天控制技术研究所 一种推力器冗余模式管理及故障屏蔽与自主恢复方法

Similar Documents

Publication Publication Date Title
CN112498664B (zh) 飞行控制系统以及飞行控制方法
CN107168044A (zh) 一种水下机器人推进器容错系统
CN107608381A (zh) 一种混合余度配置的电传飞控系统控制架构
US11030031B2 (en) Redundant sensor fabric for autonomous vehicles
US20220058096A1 (en) Redundant processing fabric for autonomous vehicles
CN214954689U (zh) 一种大中型固定翼无人机双余度舵机控制故障诊断系统
CN108776486A (zh) 一种大型中高空察打一体无人机飞控系统冗余架构方法
CN102122276A (zh) 一种双处理器星载计算机
CN107526289A (zh) 一种基于can总线的两余度舵机控制系统
CN102520356A (zh) 一种电动汽车用驱动电机试验平台
CN105000172A (zh) 飞机起落架收放电气控制系统
CN103482051B (zh) 一种船舶主机遥控系统
CN111959524A (zh) 自动驾驶车辆的人机交互控制系统及方法
CN206892572U (zh) 水下机器人推进器容错系统
JP7428217B2 (ja) 電気駆動装置
CN102312772B (zh) 一种风力发电机变桨距系统控制方法
CN214420544U (zh) 一种具有双电机安全冗余控制的线控转向eps控制器
CN215219510U (zh) 一种agv车载控制器
CN109617022A (zh) 一种支持故障诊断并恢复的电源控制装置
CN109683467A (zh) 一种动力定位控制表决系统及其方法
CN205049929U (zh) 一种无人机飞控系统和无人机
CN112327692A (zh) SoC芯片、伺服驱动器、伺服驱动器的控制方法及装置
CN209327869U (zh) 一种车辆无人驾驶系统
CN102632987A (zh) 能够应急避险的水下航行器水平直流舵机控制方法及装置
CN115453853A (zh) 无人机飞管系统舵机故障排查系统

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: 20170915

RJ01 Rejection of invention patent application after publication