CN101850550A - 一种机器人关节冗余控制系统及控制方法 - Google Patents
一种机器人关节冗余控制系统及控制方法 Download PDFInfo
- Publication number
- CN101850550A CN101850550A CN 201010180797 CN201010180797A CN101850550A CN 101850550 A CN101850550 A CN 101850550A CN 201010180797 CN201010180797 CN 201010180797 CN 201010180797 A CN201010180797 A CN 201010180797A CN 101850550 A CN101850550 A CN 101850550A
- Authority
- CN
- China
- Prior art keywords
- control module
- controller
- load circuit
- module
- control
- 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.)
- Granted
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
一种机器人关节冗余控制系统及控制方法,它涉及伺服控制系统领域,它解决了现有冷备份机器人关节控制系统无法实现对主份系统和备份系统进行资源重新配置的缺陷。本发明的一种机器人关节冗余控制系统包括主份控制单元和备份控制单元,所述主份控制单元和备份控制单元结构相同,所述主份控制单元包括电源模块、负载电路组、控制器和信息交换控制模块,所述主份控制单元和备份控制单元通过信号线相连接;本发明的一种机器人关节冗余控制方法是基于所述控制系统实现的。本发明为进一步提高关节控制系统的可靠性奠定了基础。
Description
技术领域
本发明涉及伺服控制系统领域,具体涉及一种机器人关节冗余控制系统及控制方法。
背景技术
随着我国对空间探索投入的增加,越来越多的机电设备将投入到太空运行,空间机器人作为其中一个典型代表,已经成为一个热点研究领域。在太空中由于失去了地球大气层的保护,空间机器人等机电设备必须面对剧烈的高低温变化和强烈的太空辐射。另外,空间机器人等机电设备存在不可修复或修复成本太高的弱点,在设计过程中需要特别注意提高系统可靠性和容错能力。
目前空间机器人关节控制系统一般是通过冗余备份系统来提高系统的可靠性的。主份系统和备份系统设计有相同的电源系统、传感系统、控制系统和驱动系统。目前,一般将机器人关节控制系统设计成冷备份,当主份系统工作时备份系统处于掉电状态,或当备份系统工作时主份系统处于掉电状态。为了防止掉电系统对工作系统带来串电等影响,将主份系统和备份系统设计成完全独立的两套系统,通过上层控制系统来判断主份系统或备份系统运行。
虽然主份系统和备份系统完全独立的结构具有较高的可靠性,但是当主份系统和备份系统发生不重叠的故障时,由于主份系统和备份系统不能共享状态良好的资源,关节控制系统将失效。这样资源没有得到充分利用,机械臂关节控制系统的整体可靠性设计没有做到最大化。
发明内容
为了解决现有冷备份机器人关节控制系统无法实现对主份系统和备份系统进行资源重新配置的缺陷,本发明提供了一种机器人关节冗余控制系统及控制方法。
本发明的一种机器人关节冗余控制系统,它包括主份控制单元和备份控制单元,所述主份控制单元和备份控制单元结构相同,所述主份控制单元的地线和备份控制单元的地线均与所述控制系统回线连接,所述主份控制单元和备份控制单元通过信号线相连接,
所述主份控制单元包括电源模块、负载电路组、控制器和信息交换控制模块,
所述电源模块,用于提供电源给控制器,还用于在接收到来自控制器的电源控制信号后开通或关闭输出至负载电路组的电源,
所述负载电路组,用于在电源模块的电源控制下开始工作,并执行控制器传来的控制命令,还用于向控制器反馈关节的状态信息,
所述控制器,用于在上电后在输入的关节上级控制器工作命令下输出电源控制信号至电源模块,还用于输出使能信号至信息交换控制模块,同时输出控制命令给负载电路组,并将所述负载电路组反馈回来的关节的状态信息传递至信息交换控制模块,
所述信息交换控制模块与备份控制单元中的控制模块相连接,用于实现主份控制单元与备份控制单元进行信号线的连接,所述信息交换控制模块具有连通工作状态和高阻状态,如果主份控制单元中控制器与备份控制单元中控制器之间进行信息交换,控制器输出使能信号控制信息交换控制模块处于连通状态,以完成所述主份控制单元与备份控制单元之间的信息交换;否则控制器输出使能信号控制信息交换控制模块处于高阻状态。
本发明的一种机器人关节冗余控制方法,它是基于上述控制系统实现的,所述控制方法的控制过程为:
当主份控制单元和备份控制单元都正常时或只有一个正常时,
由关节上级控制器控制一个正常的控制单元进入上电状态,同时,另外一个控制单元处于掉电状态,此时处于上电状态的控制单元中的控制器输出使能信号控制三态数据缓冲器处于高阻态,实现控制系统正常工作;
当主份控制单元中负载电路组和备份控制单元中负载电路组都出现故障,且主份控制单元中负载电路组中负载电路的故障和备份控制单元中负载电路组中负载电路的故障不重叠时,关节上级控制器控制主份控制单元和备份控制单元同时上电,此时,主份控制单元中的控制器输出关节状态信息,同时备份控制单元中的控制器输出关节状态信息,使得主份控制单元中的控制模块与备份控制单元中的控制模块之间的数据连接通道信号线接通,进行信息交换,实现各控制单元中负载电路的资源重组,完成控制系统正常工作。
本发明的有益效果:本发明提供了一种既支持主份系统或备份系统单独上电工作模式,又能够实现主份系统和备份系统同时上电、共享资源工作模式的机器人关节冗余控制系统及控制方法;本发明通过采取单独控制负载电路的电源子模块的方式,实现对负载电路的电源状态的单独管理,保证了主份控制单元和备份控制单元同时上电工作时,隔离故障外围系统;本发明通过地线单点共地、关节状态信息连接信息交换控制模块和单独控制的负载电路的电源子模块的设计,实现了当主份控制单元或备份控制单元单独上电工作时,掉电的控制单元对运行的控制单元没有任何影响,安全性与完全独立的两套系统相当;当主份控制单元和备份控制单元发生不重叠故障时,通过关节状态信息连接信息交换控制模块进行主份控制单元中控制器和备份控制单元中控制器之间的信息交换,满足进行主份和备份信息共享和重组优良资源的需求,保证关节控制系统的正常运行;本发明中,当主份控制单元或备份控制单元单独上电工作时,相应控制器通过输出使能信号给信息交换控制模块,以保持信号线处于高阻状态,避免掉电系统对工作系统通过信号线产生串电等影响;当主份控制单元和备份控制单元需要同时上电工作时,主份控制单元中的控制器和备份控制单元中的控制器分别打开关节状态信息以连接各自的信息交换控制模块,以保证主份控制单元中的控制器和备份控制单元中的控制器的信号线接通,避免由于关节状态信息连接信息交换控制模块故障而发生单点事故;本发明通过电源系统的设计保证整个系统的安全。
附图说明
图1是本发明的一种机器人关节冗余控制系统的结构示意图,图2是本发明中的电源模块1-1电路结构示意图,图3是本发明中的信号线A连接控制器1-3的电路示意图,其中,B为使能控制线。
具体实施方式
具体实施方式一:根据说明书附图1、2和3具体说明本实施方式,本实施方式所述的一种机器人关节冗余控制系统,它包括主份控制单元1和备份控制单元2,所述主份控制单元1和备份控制单元2结构相同,所述主份控制单元1的地线和备份控制单元2的地线均与所述控制系统回线连接,所述主份控制单元1和备份控制单元2通过信号线相连接,
所述主份控制单元1包括电源模块1-1、负载电路组1-2、控制器1-3和信息交换控制模块1-4,
所述电源模块1-1,用于提供电源给控制器1-3,还用于在接收到来自控制器1-3的电源控制信号后开通或关闭输出至负载电路组1-2的电源,
所述负载电路组1-2,用于在电源模块1-1的电源控制下开始工作,并执行控制器1-3传来的控制命令,还用于向控制器1-3反馈关节的状态信息,
所述控制器1-3,用于在上电后在输入的关节上级控制器工作命令下输出电源控制信号至电源模块1-1,还用于输出使能信号至信息交换控制模块1-4,同时输出控制命令给负载电路组1-2,并将所述负载电路组1-2反馈回来的关节的状态信息传递至信息交换控制模块1-4,
所述信息交换控制模块1-4与备份控制单元2中的控制模块相连接,用于实现主份控制单元1与备份控制单元2进行信号线A的连接,所述信息交换控制模块1-4具有连通工作状态和高阻状态,如果主份控制单元1中控制器1-3与备份控制单元1中控制器之间进行信息交换,控制器1-3输出使能信号控制信息交换控制模块1-4处于连通状态,以完成所述主份控制单元1与备份控制单元2之间的信息交换;否则控制器1-3输出使能信号控制信息交换控制模块1-4处于高阻状态。
具体实施方式二:本实施方式是对具体实施方式一的进一步说明,具体实施方式一中所述电源模块1-1包括控制器电源子模块1-1-1和负载电路电源子模块组1-1-2,
所述控制器电源子模块1-1-1用于提供电源给控制器1-3,
所述负载电路电源子模块组1-1-2包括n个电源子模块,n>1,且为自然数,所述负载电路组1-2包括m个负载电路,m>1,且为自然数,所述负载电路电源子模块组1-1-2用于在接收到来自控制器1-3的电源控制信号后开通或关闭输出至负载电路组1-2的电源,以实现对所述负载电路组1-2中各负载电路的单独控制。
具体实施方式三:本实施方式是对具体实施方式一或二的进一步说明,具体实施方式一或二中所述的信息交换控制模块1-4为多个三态双向数据缓冲器。
具体实施方式四:本实施方式是对具体实施方式一、二或三的进一步说明,具体实施方式一、二或三中电源模块1-1还包括电源输入滤波电路1-1-3和多路DC/DC变换电路模块1-1-4,
所述电源输入滤波电路1-1-3,用于将外部输入的电源信号滤波后输出给多路DC/DC变换电路模块1-1-4,
所述多路DC/DC变换电路模块1-1-4,用于将输入的电源信号变换为多路电源信号,并将所述多路电源信号分别输出给控制器电源子模块1-1-1和负载电路电源子模块组1-1-2。
具体实施方式五:本实施方式是对具体实施方式一、二、三或四的进一步说明,具体实施方式一、二、三或四中控制器电源子模块1-1-1为低压差线性输出调节模块,负载电路电源子模块组1-1-2包括n个低压差线性输出调节模块。
具体实施方式六:本实施方式是基于具体实施方式一所述的控制系统实现的,本实施方式所述的控制方法的控制过程为:
当主份控制单元1和备份控制单元2都正常时或只有一个正常时,由关节上级控制器U控制一个正常的控制单元进入上电状态,同时,另外一个控制单元处于掉电状态,此时处于上电状态的控制单元中的控制器1-3输出使能信号控制三态数据缓冲器处于高阻态,实现控制系统正常工作;
当主份控制单元1中负载电路组1-2和备份控制单元2中负载电路组都出现故障,且主份控制单元1中负载电路组1-2中负载电路的故障和备份控制单元2中负载电路组中负载电路的故障不重叠时,关节上级控制器U控制主份控制单元1和备份控制单元2同时上电,此时,主份控制单元1中的控制器1-3输出关节状态信息,同时备份控制单元2中的控制器输出关节状态信息,使得主份控制单元1中的控制模块1-3与备份控制单元2中的控制模块之间的数据连接通道信号线A接通,进行信息交换,实现各控制单元中负载电路的资源重组,完成控制系统正常工作。
本实施方式中,负载电路组1-2主要包括的负载电路为各种传感器、电机驱动电路模块、制动器驱动电路模块,其中,传感器用来向控制器反馈关节的各种状态信息,如电机位置、关节输出力矩、关节温度等;电机驱动电路模块、制动器驱动电路模块用来执行控制器的命令,如驱动电机运转或停止,制动器的打开或关闭。
本实施方式中所述的负载电路故障不重叠,可以用如下例子来说明:当主份控制单元1中的传感器一出现故障,备份控制单元2中的传感器二出现故障时,即可称为是负载电路故障不重叠,而此时,可以通过资源重组形成一个与正常工作的主份控制单元1或备份控制单元2功能一致的控制系统。
Claims (6)
1.一种机器人关节冗余控制系统,它包括主份控制单元(1)和备份控制单元(2),所述主份控制单元(1)和备份控制单元(2)通过信号线相连接,其特征在于:
所述主份控制单元(1)包括电源模块(1-1)、负载电路组(1-2)、控制器(1-3)和信息交换控制模块(1-4),
所述电源模块(1-1),用于提供电源给控制器(1-3),还用于在接收到来自控制器(1-3)的电源控制信号后开通或关闭输出至负载电路组(1-2)的电源,
所述负载电路组(1-2),用于在电源模块(1-1)的电源控制下开始工作,并执行控制器(1-3)传来的控制命令,还用于向控制器(1-3)反馈关节的状态信息,
所述控制器(1-3),用于在上电后在输入的关节上级控制器工作命令下输出电源控制信号至电源模块(1-1),还用于输出使能信号至信息交换控制模块(1-4),同时输出控制命令给负载电路组(1-2),并将所述负载电路组(1-2)反馈回来的关节的状态信息传递至信息交换控制模块(1-4),
所述信息交换控制模块(1-4)与备份控制单元(2)中的控制模块相连接,用于实现主份控制单元(1)与备份控制单元(2)进行信号线(A)的连接,所述信息交换控制模块(1-4)具有连通工作状态和高阻状态,如果主份控制单元(1)中控制器(1-3)与备份控制单元(1)中控制器之间进行信息交换,控制器(1-3)输出使能信号控制信息交换控制模块(1-4)处于连通状态,以完成所述主份控制单元(1)与备份控制单元(2)之间的信息交换;否则控制器(1-3)输出使能信号控制信息交换控制模块(1-4)处于高阻状态。
2.根据权利要求1所述的一种机器人关节冗余控制系统,其特征在于所述电源模块(1-1)包括控制器电源子模块(1-1-1)和负载电路电源子模块组(1-1-2),
所述控制器电源子模块(1-1-1)用于提供电源给控制器(1-3),
所述负载电路电源子模块组(1-1-2)包括n个电源子模块,n>1,且为自然数,所述负载电路组(1-2)包括m个负载电路,m>1,且为自然数,所述负载电路电源子模块组(1-1-2)用于在接收到来自控制器(1-3)的电源控制信号后开通或关闭输出至负载电路组(1-2)的电源,以实现对所述负载电路组(1-2)中各负载电路的单独控制。
3.根据权利要求1或2所述的一种机器人关节冗余控制系统,其特征在于信息交换控制模块(1-4)为多个三态双向数据缓冲器。
4.根据权利要求2所述的一种机器人关节冗余控制系统,其特征在于电源模块(1-1)还包括电源输入滤波电路(1-1-3)和多路DC/DC变换电路模块(1-1-4),
所述电源输入滤波电路(1-1-3),用于将外部输入的电源信号滤波后输出给多路DC/DC变换电路模块(1-1-4),
所述多路DC/DC变换电路模块(1-1-4),用于将输入的电源信号变换为多路电源信号,并将所述多路电源信号分别输出给控制器电源子模块(1-1-1)和负载电路电源子模块组(1-1-2)。
5. 根据权利要求4所述的一种机器人关节冗余控制系统,其特征在于控制器电源子模块(1-1-1)为低压差线性输出调节模块,负载电路电源子模块组(1-1-2)包括n个低压差线性输出调节模块。
6. 基于权利要求1所述的一种机器人关节冗余控制系统的一种机器人关节冗余控制方法,其特征在于它的控制过程为:
当主份控制单元(1)和备份控制单元(2)都正常时或只有一个正常时,由关节上级控制器(U)控制一个正常的控制单元进入上电状态,同时,另外一个控制单元处于掉电状态,此时处于上电状态的控制单元中的控制器(1-3)输出使能信号控制三态数据缓冲器处于高阻态,实现控制系统正常工作;
当主份控制单元(1)中负载电路组(1-2)和备份控制单元(2)中负载电路组都出现故障,且主份控制单元(1)中负载电路组(1-2)中负载电路的故障和备份控制单元(2)中负载电路组中负载电路的故障不重叠时,关节上级控制器(U)控制主份控制单元(1)和备份控制单元(2)同时上电,此时,主份控制单元(1)中的控制器(1-3)输出关节状态信息,同时备份控制单元(2)中的控制器输出关节状态信息,使得主份控制单元(1)中的控制模块(1-3)与备份控制单元(2)中的控制模块之间的数据连接通道信号线(A)接通,进行信息交换,实现各控制单元中负载电路的资源重组,完成控制系统正常工作。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201010180797XA CN101850550B (zh) | 2010-05-24 | 2010-05-24 | 一种机器人关节冗余控制系统及控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201010180797XA CN101850550B (zh) | 2010-05-24 | 2010-05-24 | 一种机器人关节冗余控制系统及控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101850550A true CN101850550A (zh) | 2010-10-06 |
CN101850550B CN101850550B (zh) | 2011-09-28 |
Family
ID=42802313
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201010180797XA Expired - Fee Related CN101850550B (zh) | 2010-05-24 | 2010-05-24 | 一种机器人关节冗余控制系统及控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101850550B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102073284A (zh) * | 2010-12-21 | 2011-05-25 | 北京航空航天大学 | 一种适用于核工业机器人的双机冗余嵌入式控制系统 |
CN107901036A (zh) * | 2017-10-25 | 2018-04-13 | 深圳市朗驰欣创科技股份有限公司 | 一种用于机器人的冗余控制系统及控制方法 |
WO2021007717A1 (zh) * | 2019-07-12 | 2021-01-21 | 深圳市科曼医疗设备有限公司 | 一种高可靠性手术床液压控制系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002199724A (ja) * | 2000-12-26 | 2002-07-12 | Sony Corp | 交直両用形スイッチング電源装置 |
CN1619915A (zh) * | 2003-11-21 | 2005-05-25 | 华为技术有限公司 | 一种供电系统及其下电控制方法 |
CN1859538A (zh) * | 2005-04-30 | 2006-11-08 | 华为技术有限公司 | 直流电源供电控制系统及控制方法 |
CN201051669Y (zh) * | 2007-06-20 | 2008-04-23 | 中国科学院长春光学精密机械与物理研究所 | 一种冗余热备份电源供电系统 |
CN201274005Y (zh) * | 2008-09-28 | 2009-07-15 | 尹建国 | 一种自动冷备份节能程序控制器 |
-
2010
- 2010-05-24 CN CN201010180797XA patent/CN101850550B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002199724A (ja) * | 2000-12-26 | 2002-07-12 | Sony Corp | 交直両用形スイッチング電源装置 |
CN1619915A (zh) * | 2003-11-21 | 2005-05-25 | 华为技术有限公司 | 一种供电系统及其下电控制方法 |
CN1859538A (zh) * | 2005-04-30 | 2006-11-08 | 华为技术有限公司 | 直流电源供电控制系统及控制方法 |
CN201051669Y (zh) * | 2007-06-20 | 2008-04-23 | 中国科学院长春光学精密机械与物理研究所 | 一种冗余热备份电源供电系统 |
CN201274005Y (zh) * | 2008-09-28 | 2009-07-15 | 尹建国 | 一种自动冷备份节能程序控制器 |
Non-Patent Citations (1)
Title |
---|
> 20081231 刘喆等 空间机器人中央计算机的双机热备份 26-29 1-6 , 第12期 2 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102073284A (zh) * | 2010-12-21 | 2011-05-25 | 北京航空航天大学 | 一种适用于核工业机器人的双机冗余嵌入式控制系统 |
CN107901036A (zh) * | 2017-10-25 | 2018-04-13 | 深圳市朗驰欣创科技股份有限公司 | 一种用于机器人的冗余控制系统及控制方法 |
WO2021007717A1 (zh) * | 2019-07-12 | 2021-01-21 | 深圳市科曼医疗设备有限公司 | 一种高可靠性手术床液压控制系统 |
Also Published As
Publication number | Publication date |
---|---|
CN101850550B (zh) | 2011-09-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2021147351A1 (zh) | 基于EtherCAT P总线技术的多轴伺服电机控制系统及方法 | |
CN103838230B (zh) | 一种可扩充冗余度和轴数的数字舵机控制系统的故障切换方法 | |
CN103112576B (zh) | 一种舵机控制方法 | |
CN104681835B (zh) | 一种质子交换膜燃料电池双机备份控制器及其控制方法 | |
CN105471310A (zh) | 并行模块化转换器架构 | |
CN104590550B (zh) | 一种高可靠双冗余电动舵机控制装置 | |
CN104579029A (zh) | 一种三冗余无刷直流伺服驱动控制器 | |
CN102437800B (zh) | 一种直流电机伺服驱动器 | |
CN101850550B (zh) | 一种机器人关节冗余控制系统及控制方法 | |
CN103401486A (zh) | 带ups断电信息保护的双电机交流伺服驱动器 | |
CN102511124B (zh) | 致动器控制系统以及致动器系统 | |
CN202421819U (zh) | 用于dcs系统的三重冗余模拟量输出模块 | |
CN109823522A (zh) | 多冗余度起落架电动收放控制器 | |
CN201511980U (zh) | 一种全电子化信号执行模块电路 | |
CN108693805A (zh) | 一种安全计算机输出控制系统 | |
CN102354163B (zh) | 伺服刀架控制器及旋转参考点的捕捉方法 | |
CN104914816A (zh) | 一种基于linux平台的铁路联锁机柜组自动控制装置 | |
US10618640B2 (en) | Aircraft braking system having a high level of availability | |
CN104659901A (zh) | 具有不中断的供电单元的电设备 | |
CN106452203A (zh) | 一种可靠的驱动控制系统及其控制方法 | |
CN202257193U (zh) | 伺服刀架控制器 | |
CN105099281A (zh) | 伺服马达驱动器 | |
CN101532389B (zh) | 掘进工作面局部通风机的控制装置及其控制方法 | |
CN201408354Y (zh) | 一种整合精密加工机械与机械手臂的控制装置 | |
CN105334807A (zh) | 石材抛光机磨头控制方法及可编程序控制器控制系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
C17 | Cessation of patent right | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20110928 Termination date: 20120524 |