CN109573112B - 一种航天器对接机构主动对接控制方法 - Google Patents
一种航天器对接机构主动对接控制方法 Download PDFInfo
- Publication number
- CN109573112B CN109573112B CN201811503320.3A CN201811503320A CN109573112B CN 109573112 B CN109573112 B CN 109573112B CN 201811503320 A CN201811503320 A CN 201811503320A CN 109573112 B CN109573112 B CN 109573112B
- Authority
- CN
- China
- Prior art keywords
- direct current
- current motor
- docking
- control
- spacecraft
- 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.)
- Active
Links
- 238000003032 molecular docking Methods 0.000 title claims abstract description 115
- 238000000034 method Methods 0.000 title claims abstract description 44
- 230000007246 mechanism Effects 0.000 title claims abstract description 40
- 230000008569 process Effects 0.000 claims abstract description 29
- 238000012544 monitoring process Methods 0.000 claims abstract description 16
- 238000013016 damping Methods 0.000 claims abstract description 12
- 230000009191 jumping Effects 0.000 claims description 25
- 210000001503 joint Anatomy 0.000 claims description 11
- 230000009471 action Effects 0.000 claims description 4
- 238000001514 detection method Methods 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/64—Systems for coupling or separating cosmonautic vehicles or parts thereof, e.g. docking arrangements
- B64G1/646—Docking or rendezvous systems
Abstract
本发明公开了一种航天器对接机构主动对接控制方法,该方法包含接触准备控制、捕获识别控制、平衡监测控制、锁紧控制、状态归位控制、对接控制完成过程,驱动航天器对接机构中第一直流电机、第二直流电机、第三直流电机、阻尼设备、电磁阀动作,促使对接机构中锁紧设备、捕获设备、对接环、平衡传感器处于指定状态。本发明解决了对接机构主动对接控制不连续,精度不高的问题,实现了航天器对接机构与空间目标飞行器对接机构的精准对接。
Description
技术领域
本发明涉及航天器对接机构对接控制领域,特别涉及一种航天器对接机构主动对接控制方法。
背景技术
随着空间技术的发展,特别是近地空间站的建造,使得天地间的人员往返、物资运输愈发频繁,从而对航天器对接机构的性能和控制技术提出了更高的要求,尤其是对接机构主动对接的智能化、连续性要求更是亟待解决的问题。
现有的技术中,航天器对接机构对接控制主要采用定点式控制,由预定的指令驱动相应电机完成对接步骤,未形成对接控制系统化,不利于对接机构连续对接动作以及精细化控制要求。
基于上述原因,研发一种满足航天器对接机构主动对接精度要求的航天器对接机构主动对接控制方法实为必要。
发明内容
本发明的目的在于提供一种航天器对接机构主动对接控制方法,该方法通过接触准备控制、捕获识别控制、平衡监测控制、锁紧控制、状态归位控制、对接控制完成等步骤的设计驱动航天器对接机构中第一直流电机、第二直流电机、第三直流电机、阻尼设备、电磁阀动作,促使对接机构中锁紧设备、捕获设备、对接环、平衡传感器处于指定状态,连续控制对接机构主动对接过程,可以解决现有航天器对接机构对接过程不连续,对接控制精细化不高的问题,使得航天器与目标机构对接操作连续,控点较精细,精度较高。
为了达到上述目的,本发明通过以下技术方案实现:
一种航天器对接机构主动对接控制方法,该方法包含以下步骤:
S1、对接机构接收到对接准备指令后,进行接触准备控制;
S2、所述接触准备控制完成后,进行捕获识别控制;
S3、所述捕获识别控制完成后,进行平衡监测控制;
S4、所述平衡监测控制完成后,进行锁紧控制;
S5、所述锁紧控制完成后,进行状态归位控制,所述状态归位控制完成则表示对接控制完成。
优选地,所述步骤S1中,进一步包含以下步骤:
S11、启动电磁阀锁紧;
S12、启动第一直流电机正转;
S13、检测对接环是否到对接位置:若否,则跳转至所述步骤S12继续启动第一直流电机正转,直至对接环到对接位置;若是,则继续执行步骤S14;
S14、关闭第一直流电机;
S15、启动电磁阀解锁;
S16、检测平衡传感器是否失衡:如果未到位,则继续检测平衡传感器直至失衡;如果平衡传感器到位表明接触准备完成,接触准备控制过程完成。
优选地,所述步骤S2中,进一步包含以下步骤:
S21、检测捕获设备;
S22、判断捕获设备是否捕获:若是,则继续执行步骤S23;若否,则跳转至步骤S24;
S23、开启阻尼设备,捕获识别控制过程完成;
S24、启动第二直流电机反转,则继续执行步骤S25;
S25、判断捕获设备是否解锁:若是,继续执行步骤S26,若否,则跳转至步骤S24直至捕获设备解锁;
S26、关闭第二直流电机,捕获识别控制过程完成。
优选地,所述步骤S3中,进一步包含以下步骤:
S31、检测平衡传感器;
S32、判断当前是否为平衡模式:若是,则跳转至步骤S36;若否,则继续执行步骤S33;
S33、启动第一直流电机正转;
S34、检测对接环是否到极限位置:若否,则跳转至步骤S33继续启动第一直流电机正转,直至对接环到极限位置;若是,则继续执行步骤S35;
S35、关闭第一直流电机,继续执行步骤S36;
S36、启动电磁阀锁紧,平衡检测控制过程完成。
优选地,所述步骤S4中进一步包含以下步骤:
S41、启动第一直流电机反转;
S42、检测对接环是否到接近位置:若否,则跳转至所述步骤S41继续启动第一直流电机反转,直至对接环到接近位置;若是,则继续执行步骤S43;
S43、关闭第一直流电机;
S44、启动第三直流电机正转;
S45、检测锁紧设备是否锁紧:若否,跳转至所述步骤S44继续启动第三直流电机正转,直至锁紧设备锁紧;若否后,则继续执行步骤S46;
S46、关闭第三直流电机,锁紧控制过程完成。
优选地,所述步骤S5中,进一步包含以下步骤:
S51、启动第二直流电机反转;
S52、检测捕获设备是否解锁:若捕获设备未解锁,则跳转至所述步骤S51,继续启动第二直流电机反转直至捕获设备解锁;若是,则继续执行步骤S53;
S53、关闭第二直流电机;
S54、启动第一直流电机反转;
S55、检测对接环是否到初始位置:若否,则跳转至所述步骤S54,继续启动第一直流电机反转直至对接环到初始位置;若是,则继续执行步骤S56;
S56、关闭第一直流电机,状态归位控制过程完成。
与现有技术相比,本发明的有益效果为:本发明解决了现有航天器对接机构对接过程不连续,对接控制精细化不高的问题,使得航天器与目标机构对接操作连续,控点较精细,精度较高,实现了航天器对接机构与空间目标飞行器对接机构的精准对接,该对接机构对接控制方法首次应用于货运飞船型号。
附图说明
图1为本发明的航天器对接机构示意图;
图2为本发明的对接机构主动对接控制方法示意图;
图3为本发明的接触准备控制过程示意图;
图4为本发明的平衡监测控制过程示意图;
图5为本发明的捕获识别控制过程示意图;
图6为本发明的锁紧控制过程示意图;
图7为本发明的状态归位控制过程示意图。
具体实施方式
为了使本发明更加明显易懂,以下结合附图和具体实施方式对发明做进一步说明。
如图1所示,本发明的航天器对接机构包含第一直流电机1、第二直流电机2、第三直流电机3、锁紧设备4、捕获设备5、平衡传感器6、阻尼设备7、电磁阀8和对接环9。
其中,平衡传感器6、阻尼设备7、电磁阀8安装在对接环9中,第一直流电机1与对接环9连接,第一直流电机1驱动对接环9推出和拉回动作。第二直流电机2用于驱动航天器捕获动作,锁紧设备4用于监测航天器锁紧位置,第二直流电机2与锁紧设备4连接,锁紧设备4监测第二直流电机2动作状态。第三直流电机3用于驱动航天器锁紧动作,捕获设备5用于监测航天器捕获位置,第三直流电机3与捕获设备5连接,使得捕获设备5监测第三直流电机3动作状态。平衡传感器6用于监测航天器倾斜状态,阻尼设备7用于降低航天器震动,电磁阀8用于调整对接环角度,对接环9用于与其他航天器接触设备。
本发明的航天器对接机构主动对接控制方法通过驱动第一直流电机1、第二直流电机2、第三直流电机3、阻尼设备7、电磁阀8动作,促使锁紧设备4、捕获设备5、对接环9、平衡传感器6处于指定状态。
如图1所示,本发明的航天器对接机构主动对接控制方法包含以下步骤:
S1、对接机构接收到对接准备指令,表明对接机构进入对接准备状态,则进行接触准备控制;
S2、接触准备控制完成后,进行捕获识别控制;
S3、捕获识别控制完成后,进行平衡监测控制;
S4、平衡监测控制完成后,进行锁紧控制;
S5、锁紧控制完成后,进行状态归位控制;状态归位控制完成则表示对接控制完成。
如图3所示,所述步骤S1中的接触准备控制过程具体如下:
S11、启动电磁阀锁紧三次;
S12、启动第一直流电机正转;
S13、检测对接环是否到对接位置:如果未到对接位置,则跳转至步骤S12继续启动第一直流电机正转直至对接环到对接位置;如果对接环到对接位置,继续执行步骤S14;
S14、关闭第一直流电机;
S15、启动电磁阀解锁三次;
S16、检测平衡传感器是否失衡:如果未到位,继续检测平衡传感器直至失衡,如果平衡传感器到位表明接触准备完成,接触准备控制过程完成。
如图4所示,所述步骤S2中的捕获识别控制过程具体如下:
S21、检测捕获设备;
S22、判断捕获设备是否捕获:若是,则继续执行步骤S23;若否,则跳转至步骤S24;
S23、开启阻尼设备,捕获识别控制过程完成;
S24、启动第二直流电机反转,继续执行步骤S25;
S25、判断捕获设备是否解锁:若是,继续执行步骤S26,若否,则跳转至步骤S24直至捕获设备解锁;
S26、关闭第二直流电机,捕获识别控制过程完成。
如图5所示,所述步骤S3中的平衡监测控制过程具体如下:
S31、检测平衡传感器;
S32、判断当前是否为平衡模式:如果为平衡模式,则跳转至步骤S36;如果不为平衡模式,需校正对接机构状态,则继续执行步骤S33;
S33、启动第一直流电机正转;
S34、检测对接环是否到极限位置:如果未到极限位置,则跳转至步骤S33继续启动第一直流电机正转直至对接环到极限位置;如果对接环到极限位置,则继续执行步骤S35;
S35、关闭第一直流电机,继续执行步骤S36;
S36、启动电磁阀锁紧三次,平衡检测控制过程完成。
如图6所示,所述步骤S4中的锁紧控制过程具体如下:
S41、启动第一直流电机反转;
S42、检测对接环是否到接近位置:如果未到接近位置,则跳转至步骤S41继续启动第一直流电机反转直至对接环到接近位置;如果对接环到接近位置,继续执行步骤S43;
S43、关闭第一直流电机;
S44、启动第三直流电机正转;
S45、检测锁紧设备是否锁紧:如果未锁紧,跳转至步骤S44继续启动第三直流电机正转直至锁紧设备锁紧,如果锁紧设备锁紧后,继续执行步骤S46;
S46、关闭第三直流电机,锁紧控制过程完成。
如图7所示,所述步骤S5中的状态归位控制过程具体如下:
S51、启动第二直流电机反转;
S52、检测捕获设备是否解锁:如果捕获设备未解锁,则跳转至所述步骤S51,继续启动第二直流电机反转直至捕获设备解锁;如果捕获设备解锁,则继续执行步骤S53;
S53、关闭第二直流电机;
S54、启动第一直流电机反转;
S55、检测对接环是否到初始位置:如果未到初始位置,则跳转至所述步骤S54,继续启动第一直流电机反转直至对接环到初始位置,如果对接环到初始位置,继续执行步骤S56;
S56、关闭第一直流电机,状态归位控制过程完成。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。
Claims (1)
1.一种航天器对接机构主动对接控制方法,其特征在于,该方法包含以下步骤:
S1、对接机构接收到对接准备指令后,进行接触准备控制;
S2、所述接触准备控制完成后,进行捕获识别控制;
S3、所述捕获识别控制完成后,进行平衡监测控制;
S4、所述平衡监测控制完成后,进行锁紧控制;
S5、所述锁紧控制完成后,进行状态归位控制,所述状态归位控制完成则表示对接控制完成;
所述航天器对接机构包含第一直流电机、第二直流电机、第三直流电机、锁紧设备、捕获设备、平衡传感器、阻尼设备、电磁阀和对接环;
所述平衡传感器、阻尼设备、电磁阀安装在对接环中,第一直流电机与对接环连接,所述第一直流电机驱动所述对接环推出和拉回动作;
所述第二直流电机用于驱动航天器捕获动作,所述锁紧设备用于监测航天器锁紧位置,所述第二直流电机与锁紧设备连接,所述锁紧设备监测第二直流电机动作状态;
所述第三直流电机用于驱动航天器锁紧动作,所述捕获设备用于监测航天器捕获位置,所述第三直流电机与捕获设备连接,使得捕获设备监测第三直流电机动作状态;
所述平衡传感器用于监测航天器倾斜状态,所述阻尼设备用于降低航天器震动,所述电磁阀用于调整对接环角度,所述对接环用于与其他航天器接触设备;
所述步骤S1中,进一步包含以下步骤:
S11、启动电磁阀锁紧;
S12、启动第一直流电机正转;
S13、检测对接环是否到对接位置:若否,则跳转至所述步骤S12继续启动第一直流电机正转,直至对接环到对接位置;若是,则继续执行步骤S14;
S14、关闭第一直流电机;
S15、启动电磁阀解锁;
S16、检测平衡传感器是否失衡:如果未到位,则继续检测平衡传感器直至失衡;如果平衡传感器到位表明接触准备完成,接触准备控制过程完成;
所述步骤S2中,进一步包含以下步骤:
S21、检测捕获设备;
S22、判断捕获设备是否捕获:若是,则继续执行步骤S23;若否,则跳转至步骤S24;
S23、开启阻尼设备,捕获识别控制过程完成;
S24、启动第二直流电机反转,则继续执行步骤S25;
S25、判断捕获设备是否解锁:若是,继续执行步骤S26,若否,则跳转至步骤S24直至捕获设备解锁;
S26、关闭第二直流电机,捕获识别控制过程完成;
所述步骤S3中,进一步包含以下步骤:
S31、检测平衡传感器;
S32、判断当前是否为平衡模式:若是,则跳转至步骤S36;若否,则继续执行步骤S33;
S33、启动第一直流电机正转;
S34、检测对接环是否到极限位置:若否,则跳转至步骤S33继续启动第一直流电机正转,直至对接环到极限位置;若是,则继续执行步骤S35;
S35、关闭第一直流电机,继续执行步骤S36;
S36、启动电磁阀锁紧,平衡检测控制过程完成;
所述步骤S4中进一步包含以下步骤:
S41、启动第一直流电机反转;
S42、检测对接环是否到接近位置:若否,则跳转至所述步骤S41继续启动第一直流电机反转,直至对接环到接近位置;若是,则继续执行步骤S43;
S43、关闭第一直流电机;
S44、启动第三直流电机正转;
S45、检测锁紧设备是否锁紧:若否,跳转至所述步骤S44继续启动第三直流电机正转,直至锁紧设备锁紧;若否后,则继续执行步骤S46;
S46、关闭第三直流电机,锁紧控制过程完成;
所述步骤S5中,进一步包含以下步骤:
S51、启动第二直流电机反转;
S52、检测捕获设备是否解锁:若捕获设备未解锁,则跳转至所述步骤S51,继续启动第二直流电机反转直至捕获设备解锁;若是,则继续执行步骤S53;
S53、关闭第二直流电机;
S54、启动第一直流电机反转;
S55、检测对接环是否到初始位置:若否,则跳转至所述步骤S54,继续启动第一直流电机反转直至对接环到初始位置;若是,则继续执行步骤S56;
S56、关闭第一直流电机,状态归位控制过程完成。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811503320.3A CN109573112B (zh) | 2018-12-10 | 2018-12-10 | 一种航天器对接机构主动对接控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811503320.3A CN109573112B (zh) | 2018-12-10 | 2018-12-10 | 一种航天器对接机构主动对接控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109573112A CN109573112A (zh) | 2019-04-05 |
CN109573112B true CN109573112B (zh) | 2020-10-02 |
Family
ID=65928591
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811503320.3A Active CN109573112B (zh) | 2018-12-10 | 2018-12-10 | 一种航天器对接机构主动对接控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109573112B (zh) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7669804B2 (en) * | 2005-06-09 | 2010-03-02 | Odyssey Space Research, LLC | Spacecraft interface module for enabling versatile space platform logistics support |
CN108436912A (zh) * | 2018-03-27 | 2018-08-24 | 山东大学 | 一种可重构机器人对接机构的控制系统及其控制方法 |
CN108639389A (zh) * | 2018-03-26 | 2018-10-12 | 南京航空航天大学 | 可重复实现锁紧/解锁的空间电磁对接机构及对接方法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2564186B2 (ja) * | 1989-03-01 | 1996-12-18 | 科学技術庁航空宇宙技術研究所 | 宇宙構造物制振装置 |
US6354540B1 (en) * | 1998-09-29 | 2002-03-12 | The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration | Androgynous, reconfigurable closed loop feedback controlled low impact docking system with load sensing electromagnetic capture ring |
CN102923318B (zh) * | 2012-11-26 | 2015-05-27 | 上海宇航系统工程研究所 | 异体同构、刚度阻尼闭环反馈控制的对接系统及其方法 |
CN106005488B (zh) * | 2016-05-19 | 2018-02-09 | 中国空间技术研究院 | 一种卫星对接锁紧自动控制方法及系统 |
CN107089349A (zh) * | 2017-04-24 | 2017-08-25 | 上海航天控制技术研究所 | 一种对接后可旋转的微纳卫星电磁对接装置及对接方法 |
CN108507543B (zh) * | 2017-09-07 | 2020-09-01 | 哈尔滨工业大学 | 航天器对接捕获过程的位姿测量装置及柔顺控制方法 |
CN108860665B (zh) * | 2018-09-11 | 2021-08-17 | 上海宇航系统工程研究所 | 一种阻尼可控的对接机构传动缓冲系统 |
-
2018
- 2018-12-10 CN CN201811503320.3A patent/CN109573112B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7669804B2 (en) * | 2005-06-09 | 2010-03-02 | Odyssey Space Research, LLC | Spacecraft interface module for enabling versatile space platform logistics support |
CN108639389A (zh) * | 2018-03-26 | 2018-10-12 | 南京航空航天大学 | 可重复实现锁紧/解锁的空间电磁对接机构及对接方法 |
CN108436912A (zh) * | 2018-03-27 | 2018-08-24 | 山东大学 | 一种可重构机器人对接机构的控制系统及其控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109573112A (zh) | 2019-04-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9054627B2 (en) | Method and apparatus to drive a linear resonant actuator at its resonant frequency | |
US10680459B2 (en) | Non-contact charging system | |
JP5877930B1 (ja) | 共振型電力伝送システム、送信装置及び給電位置制御システム | |
US8897918B2 (en) | Robot hand and robot | |
CN107775324B (zh) | 螺栓加锁方法、螺栓解锁方法、螺栓加解锁方法及车用电池更换方法 | |
US9878452B2 (en) | Grasp assist device with automatic mode control logic | |
CN106712160A (zh) | 一种无人机快速充电系统的充电方法 | |
CN109573112B (zh) | 一种航天器对接机构主动对接控制方法 | |
CN101369796A (zh) | 检测永磁同步电机转子磁极初始位置的方法和系统 | |
CN106338997A (zh) | 一种基于自动充电的机器人与充电桩之间的自动定位方法 | |
CN111959338A (zh) | 一种电动车辆的换电方法 | |
CN109109856A (zh) | 智能停车辅助系统及其控制方法 | |
WO2020121012A8 (ja) | 車両走行制御方法及び車両走行制御装置 | |
CN111825032A (zh) | 一种面向折叠臂高空作业车的预作业位识别及自动展开控制系统及方法 | |
CN109787320B (zh) | 充电桩、机器人和机器人的充电方法 | |
CN109933072A (zh) | 机器人回座时检测到充电座护栏信号的控制方法 | |
JP7059887B2 (ja) | 受電装置、電力伝送システム、および受電装置の制御方法 | |
CN102012705A (zh) | 自动清洁装置及其充电方法 | |
JP2016226291A (ja) | 電力伝送システム | |
CN107963127A (zh) | 辅助机动车辆的操作程序的装置 | |
CN109693567B (zh) | 用于控制充电插口的锁定的方法及系统 | |
CN106337618A (zh) | 操作辅助控制装置 | |
US9843207B2 (en) | Charging apparatus and charging method thereof | |
CN107300918B (zh) | 一种改变运动状态的控制方法及控制装置 | |
JP5338876B2 (ja) | モータ制御装置 |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |