CN106005488B - 一种卫星对接锁紧自动控制方法及系统 - Google Patents
一种卫星对接锁紧自动控制方法及系统 Download PDFInfo
- Publication number
- CN106005488B CN106005488B CN201610335263.7A CN201610335263A CN106005488B CN 106005488 B CN106005488 B CN 106005488B CN 201610335263 A CN201610335263 A CN 201610335263A CN 106005488 B CN106005488 B CN 106005488B
- Authority
- CN
- China
- Prior art keywords
- locking
- motor
- host computer
- controller
- butt joint
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 36
- 230000008878 coupling Effects 0.000 title claims abstract description 21
- 238000010168 coupling process Methods 0.000 title claims abstract description 21
- 238000005859 coupling reaction Methods 0.000 title claims abstract description 21
- 210000001503 joint Anatomy 0.000 claims abstract description 58
- 230000007246 mechanism Effects 0.000 claims abstract description 46
- 230000009471 action Effects 0.000 claims abstract description 27
- 230000008569 process Effects 0.000 claims abstract description 20
- 238000013016 damping Methods 0.000 claims abstract description 18
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 claims abstract description 14
- 230000033001 locomotion Effects 0.000 claims description 15
- 238000009434 installation Methods 0.000 claims description 13
- 230000006698 induction Effects 0.000 claims description 10
- 238000000926 separation method Methods 0.000 claims description 9
- 230000005611 electricity Effects 0.000 claims description 6
- 238000005259 measurement Methods 0.000 claims description 6
- 230000005540 biological transmission Effects 0.000 claims description 5
- 230000000875 corresponding effect Effects 0.000 claims description 4
- 230000001960 triggered effect Effects 0.000 claims description 4
- 238000012937 correction Methods 0.000 claims description 2
- 235000013399 edible fruits Nutrition 0.000 claims 1
- 238000012544 monitoring process Methods 0.000 abstract description 4
- 238000003032 molecular docking Methods 0.000 description 8
- 238000004891 communication Methods 0.000 description 4
- 230000001276 controlling effect Effects 0.000 description 3
- 239000000446 fuel Substances 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 101000746134 Homo sapiens DNA endonuclease RBBP8 Proteins 0.000 description 1
- 101000969031 Homo sapiens Nuclear protein 1 Proteins 0.000 description 1
- 102100021133 Nuclear protein 1 Human genes 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000000994 depressogenic effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000007667 floating Methods 0.000 description 1
- 238000010438 heat treatment Methods 0.000 description 1
- 230000000977 initiatory effect Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000000630 rising effect Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
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
技术领域
本发明涉及一种对接锁紧自动控制方法及系统,特别是用于卫星的对接锁紧自动控制方法及系统。
背景技术
受限于卫星部组件寿命、燃料、运载能力、发射以及在轨运行环境等多个因素,卫星在从发射入轨、轨道转移、初轨部署、按计划运行、拓展运行到结束运行的全寿命过程中,在轨故障不可避免。NASA根据2010年统计的目前在轨和未来发射的卫星情况,预计至2022年约有203颗GEO卫星在轨需要燃料补给,包括150颗商业卫星和53颗军事卫星。ESA对GEO卫星统计数据的分析则指出,全球平均每年都有1颗GEO航天器由于发射故障,需要从错误的定点位置辅助转移至正确轨道,每年约有20颗GEO卫星仅由于燃料耗尽在轨失效。此外,还不时有航天器发生机构展开失利、空间碎片碰撞损伤、部组件失效等故障,其累计数量也相当可观。针对上述情况,需针对失效卫星或故障卫星进行在轨故障检测和判断,自主执行对航天器的燃料加注或维修操作,根据目标卫星不同情况提供辅助飞行、模块更换等服务。在对卫星进行服务时,首先需对目标卫星进行有效捕获和对接,与目标卫星形成相对固定的运动和姿态关系,方便后续服务的进行。
目前国内针对卫星对接接口的研究相对较少,尚未见关于卫星对接锁紧自动控制方法及系统的相关报道和专利文献。
发明内容
本发明的技术解决问题是:弥补现有技术的不足,提供一种用于卫星锁紧执行机构的自动控制方法及控制系统,通过控制锁紧执行机构各部组件动作,完成对目标卫星对接环的抱紧、下压、锁紧及释放分离等一系列任务。
本发明的技术解决方案是:一种卫星对接锁紧自动控制方法,所述控制方法的锁紧执行机构采用电机提供动力,并包括安装在基座上的对目标星的对接环进行抱紧和下压功能的抱紧组件、实现与目标星对接环锁紧的锁紧组件以及在锁紧执行机构与目标星接触时减少刚性撞击的阻尼机构;方法步骤如下:
(1)在锁紧执行机构的安装基座上周向均布三个光电式传感器,当阻尼机构起阻尼作用并进入传感器的感应范围内时,触发光电式传感器;在安装基座上周向均布三个电感式传感器,用于感应目标星对接环与锁紧机构的轴向最近距离;在安装基座上周向均布三个压力传感器,用于测量阻尼机构的阻尼力;
(2)当收到上位机“自动锁紧”命令后,控制器首先检查电机状态是否处于零位,若电机不处于零位则对电机进行回零操作;随后控制器实时监测光电传感器的触发状态,在预设的时间范围内,当三个光电式传感器中至少两路触发时,控制器发出驱动脉冲,控制电机转动,电机带动抱紧组件对目标卫星对接环进行抱紧和下压,转步骤(3);否则,控制器向上位机反馈出错信息,由上位机终止本次锁紧;
(3)控制器实时监测电感式传感器的触发状态,在预设的时间范围内,当三个电感式传感器中至少两路触发时,控制器发出驱动脉冲,控制电机转动,电机带动锁紧组件对目标卫星对接环进行锁紧,转步骤(4);否则,进一步判断是否电机已转动满足机构抱紧和下压运动的最大角度,若未达到最大角度且未达到预设的时间范围,则电机继续转动;若已到达最大角度或者达到预设的时间范围,控制器停止电机动作,并向上位机反馈出错信息,由上位机发指令通过控制器控制电机反向转动回归零位,中止锁紧任务;
(4)判断是否至少两路压力传感器的测量结果满足预紧力要求,若满足,控制器停止电机动作,完成锁紧;否则,进一步判断是否电机已转动至机构锁紧的最大角度,若未达到最大角度且未达到预设的时间范围,则电机继续转动;若已到达最大角度或者达到预设的时间范围,控制器停止电机动作,并向上位机反馈出错信息,由上位机发指令通过控制器控制电机反向转动回归零位,中止锁紧任务。
所述步骤(2)、(3)中的驱动脉冲根据锁紧执行机构在相应阶段的行程确定,不能超过相应阶段机构的运动范围。
光电式传感器须准确反映目标卫星对接环与锁紧机构的相对距离,光电式传感器触发后,代表目标卫星对接环已进入锁紧机构工作范围,锁紧机构的抱紧组件才能对目标卫星对接环实施抱紧、下压动作;电感式传感器的感应范围即额定工作距离根据锁紧机构的锁紧组件有效作用距离进行选择,一般取锁紧组件对目标卫星对接环锁紧时有效作用距离的中间值±中间值×10%,针对目标卫星对接环的电感式传感器修正系数一般为0.3。
预设的时间范围为不超过30s。
一种卫星对接锁紧自动控制系统,包括上位机、控制器和传感器单元;所述的传感器单元包括在锁紧执行机构的安装基座上周向均布的三个光电式传感器,当阻尼机构起阻尼功能时达到传感器的感应范围时,触发光电式传感器;包括在安装基座上周向均布的三个电感式传感器,用于感应目标星对接环与锁紧机构的距离;包括在安装基座上周向均布的三个压力传感器,用于测量阻尼机构的阻尼力;
控制系统包括上位机控制分阶段执行模式和自动锁紧工作模式;在自动锁紧工作模式下,上位机发出“自动锁紧”指令,执行上述步骤(1)-(4);在分阶段执行模式下,上位机实时监测光电传感器的触发状态,当三个光电式传感器中至少两路触发时,进入锁紧释放过程,上位机实时监控卫星对接锁紧释放的状态,根据当前所处的状态依据锁紧释放的先后状态顺序发送指令,由控制器接收上位机发送的指令,根据不同的指令控制锁紧执行机构执行相应的动作,具体:
上位机发出“对接环抱紧和下压”指令,控制器根据指令发出驱动脉冲,控制电机转动,上位机实时监测电感式传感器的触发状态,在预设的时间范围内,当三个电感式传感器中至少两路触发时,发送指令至控制器,控制电机停止动作;否则,进一步判断是否电机已转动满足机构抱紧和下压运动的最大角度,若未达到最大角度且未达到预设的时间范围,则电机继续转动,若已到达最大角度或者达到预设的时间范围,上位机发送控制指令由控制器停止电机动作,并控制电机反向转动回归零位;
上位机发出“对接环锁紧”指令时,上位机控制控制器发出驱动脉冲,控制电机转动,电机带动锁紧组件对目标卫星对接环进行锁紧;上位机判断是否至少两路压力传感器的测量结果满足预紧力要求,若满足,上位机发指令控制控制器停止电机动作;若不满足,进一步判断是否电机已转动至机构锁紧的最大角度,若未达到最大角度且未达到预设的时间范围,则电机继续转动;若已到达最大角度或者达到预设的时间范围,上位机发指令控制控制器停止电机动作,并控制电机反向转动回归零位;
上位机发“对接环分离”指令时,控制器驱动电机转动,解除对目标卫星对接环的锁紧,在阻尼机构的预紧力的作用下将目标卫星弹出,完成快速分离,根据光电式传感器和电感式传感器的触发状态,发送指令由控制器控制电机停止转动。
本发明与现有技术相比有益效果为:
(1)本发明可实现对卫星对接锁紧过程的闭环全自动控制,不需要人为参与即可自动准确完成锁紧机构对目标卫星对接环的抱紧、下压和锁紧动作,可实现全流程内对锁紧过程和状态的实时自动监控,极大提高了对卫星对接环锁紧的自动化程度和可靠性。
(2)本发明可灵活选择采用自动锁紧工作模式或分阶段工作模式,除可对卫星对接锁紧过程进行闭环全自动控制外,还可根据实际对接锁紧需要和对卫星其它操作需要对卫星的锁紧和释放过程进行分阶段控制,将整个对接锁紧流程分为对接环抱紧和下压、对接环锁紧和对接环分离等阶段,可采用上位机命令控制方式分别执行各个阶段的对接锁紧操作,提高了对接锁紧过程的控制灵活性,可有效提高对接锁紧过程与卫星整体操作的协同性和配合度
(3)本发明采用多传感器均匀分布的配置方式,保证了目标卫星对接环与锁紧机构的同轴性和锁紧动作执行的位置平衡性,提高了对锁紧过程监控的准确度,并采取了三取二的控制方式,兼顾了可靠性与容错性的需求。
(4)本发明可在不超过30s的时间内控制锁紧执行机构完成对目标卫星对接环的锁紧过程,综合满足了目标卫星动态稳定、对接锁紧组合体控制、星地链路及卫星应急反应策略制定及执行等多方需求,有效提高了空间目标对接锁紧的执行效率和工作效能。
附图说明
图1、2为本发明所基于的锁紧执行机构示意图;
图3为本发明所建立的锁紧执行机构控制系统示意图;
图4为本发明的实时控制流程图。
具体实施方式
下面结合附图及实例对本发明做详细说明。本发明控制对象为锁紧执行机构,适用本发明的机构组成见表1
表1锁紧执行机构组成及功能
锁紧执行机构总体呈圆环形,外径大于目标卫星对接环直径。对接结构与服务卫星本体通过安装支架连接。安装支架连接基座组件,传动组件在基座组件上运动,带动抱紧组件和锁紧组件动作,完成对目标卫星对接环的抱紧、下压、锁紧与释放。弹簧阻尼器在对接锁紧过程中产生预紧力,释放分离时在预紧力的作用下将目标卫星对接环弹出,实现与目标卫星的分离。光电传感器共有三个,均匀分布于锁紧执行机构圆形基座上,夹角为120度。电感式传感器共有三个,均匀分布于锁紧执行机构圆形基座上,夹角为120度。压力传感器共有三个,均匀分布于锁紧执行机构圆形基座上,夹角为120度。主要实施方式如下:
(1)将锁紧执行机构的控制器连接电机、三组光电传感器、三组电感式传感器和三组压力传感器,并将电机零点位置反馈信号连接到控制器输入端,如图3所示;电机的主要功能是控制锁紧机构对目标对接环的锁紧和释放;光电传感器的主要功能是检测目标对接环是否已进入锁紧机构工作范围;电感式传感器的主要功能是判断锁紧机构是否已具备对目标卫星对接环的锁紧条件;压力传感器的主要功能是测量对目标卫星对接环锁紧是否已到位,及产生的预紧力是否满足释放分离需求。
(2)将锁紧执行机构控制器通过数据通信端口与上位机相连;上位机通过与控制器的通信接口发送指令,控制器执行相应指令;上位机根据整星任务和工作状态对整个对接和释放过程进行全局控制;
(3)控制器对电机进行初始化操作,使电机回归零位,同时对各通信端口进行初始化参数设置;并设置相应接口接收电机位置反馈信息,以判断电机是否工作正常或回归零位;
(4)控制器或者上位机(在自动锁紧工作模式下为控制器;在分阶段工作模式下为上位机)接收并对传感器数据进行判断和处理,为制定对接策略和确定对接时机提供依据,并根据计算结果,按照对接策略需求,计算并校核电机驱动控制参数;
(5)接收并执行上位机的各类命令,当收到自动对接过程开始命令后,控制器实时接收判断各类传感器的状态和测量信息,当光电传感器触发后,控制电机转动,启动对目标卫星对接环的抱紧和下压过程;
(6)当处于上位机分阶段控制模式时,上位机实时接收并判断各类传感器的状态和测量信息,控制器接收到上位机命令后只执行对电机的驱动动作。
(7)当电感式传感器触发后,表明锁紧执行机构已具备对目标卫星对接环的锁紧条件,控制器发出驱动脉冲控制电机转动,对目标卫星对接环进行锁紧。使目标星与服务飞行器形成刚性连接;
(8)当上位机发出释放命令或锁紧中止命令,控制器接到命令后根据命令控制电机运动,解除对接环锁紧,释放目标星,随后电机转动,使锁紧执行机构回归零位,等待下一次对接任务。
具体以图1、2所示的机构为例进行详细说明:包括安装支架27、圆环支架26、弹簧阻尼器35、传动机构28和抱紧压紧机构,抱紧压紧机构包括转动座2、抱紧组件和压紧组件。抱紧压紧机构以120°等角距分布固定在圆环支架上,共三组,用于抱紧和压紧目标卫星的对接环,实现捕获卫星和目标卫星的刚性连接。圆环支架26包括下圆盘和上圆盘。
抱紧组件包括:由连接部和压紧板组成的压紧部件1、十字销轴5、平移导轨7和运动转接件8,压紧组件包括:压板6、顶杆导轨3、顶杆4和压板座9。
连接部和运动转接件8通过燕尾槽结构相配合,连接部相对运动转接件8做径向运动,两者采用间隙配合,实现压紧板对对接环的抱紧。压紧板与目标卫星对接环有相同曲率。转动座2通过螺钉与转盘固定连接,在转盘的带动下绕圆环支架26做周向运动,平移导轨7通过螺钉固定在上圆盘的固定环的凹槽上,作为运动转接件8轴向运动的直线导轨。
在地面原理样机阶段,控制系统使用ARM11处理器,能够提供四个伺服轴并加一个主编码器轴的配置控制方案,也可以实现五个步进轴方式的控制。每个轴都可以通过编程实现各类运动类型。
控制系统的控制器主要性能如下:
533MHz的ARM11处理器
并采用双精度浮点数据格式
可选的伺服更新周期:125、250、500、1000及2000微秒
脉冲输出频率2MHz
控制器输入接口设置如下:
数字I/O口0~2:分别用于三路光电传感器信号输入
数字I/O口3~5:分别用于三路电感式传感器信号输入
数字I/O口6~8:分别用于三路压力传感器信号输入
数字I/O口9:用于检测锁紧电机回零信号
数字I/O口10:用于检测锁紧电机报警情况
以太网口:使用MC405控制器10M/100M自适应以太网口与上位机相连,用于接收上位机命令
控制器输出接口设置如下:
数字I/O口11:用于发出锁紧电机归零指令
数字I/O口12:用于发出锁紧电机警报清除指令
以太网口:端口设置同输入接口
步进轴控制端口:使用STEP+DIRECTIONG模式,ATYPE设置为43,用于步进电机操作控制
根据控制系统功能,对接锁紧机构的实时控制可划分为两个任务:
1)主任务:包括系统初始化子任务、电机驱动参数计算、电机驱动子任务。
系统初始化子任务:主要完成系统初始化、电机零位调整、全局变量赋值、关键参数设置等功能;
电机驱动参数计算:根据目标相对位置计算结果,计算步进电机控制系数;
电机驱动子任务:根据电机控制参数和上位机命令,驱动电机运动,完成对接锁紧机构对接或释放任务。
2)上位机通信任务:主要完成与上位机进行通信的功能,接收上位机指令并按指令执行相应动作,并将执行结果和系统状态参数发送上位机/卫星平台,包括上位机通信和命令执行子任务。
锁紧执行机构的实时控制任务划分见下表:
表2锁紧执行机构实时控制任务划分
在系统上电后首先进行电机归零操作和系统初始化操作,使电机回归零位。锁紧电机选用AZ46AK闭环直流步进电机,最高分辨率可达10000p/r。AZ46AK电机具有可频繁起动/停止、免增益调节、高可靠、低发热等特点,其区别于其它系统电机的最大特点为可设置机械零位,且当前电机相对于零位的绝对位置可掉电不丢失。在对该电机进行零位操作时,根据前述端口设置,需通过控制器的I/O口向电机输出高电平脉冲,在上升沿电机将自动回归零位,并在回归零位后向I/O口0发送状态信号,I/O口0处电平由低变高,即表示锁紧电机已回归零位。
以套筒控制电机为例,该电机角度分辨率为0.072°,每接收一个脉冲旋转0.072°,需电机转一整周需要360/0.072为5000脉冲,又由于控制器内部预设内分频指数为16,根据控制器要求需发送5000×16=80000脉冲才能使电机转一圈。通过控制控制器发出的脉冲数及发送脉冲频率,即可控制电机转速、转向和转数,进而控制其连接机构的伸缩距离和旋转角度,及伸缩和旋转速度。
控制器通过以太网口与上位机进行连接,上位机端以太网口的默认IP地址为192.168.0.120,子网掩码:255.255.255.0,控制器端默认IP地址为192.168.0.250,端口号:23。以太网口使用VR变量进行数据输入,起始地址为400,默认为16bit整型输入,VR序列长度50。输入数据为指令代码。
根据锁紧机构设计特点,在完成抱紧和下压阶段,电机轴须从零位正向转动273.6度,从抱紧下压到锁紧阶段须再继续正向转动263.4度,从锁紧阶段到释放须继续正向转动143.4度,则抱紧与下压阶段的电机转动最大角度设定为273.6,锁紧阶段电机转动最大角度设定为537度,释放阶段电机转动最大角度设定为680.4度。
表3对接锁紧机构VR控制命令列表
如图4所示,全流程自动控制的具体控制过程如下:
(1)当收到上位机“自动锁紧”命令后,控制器首先根据电机状态反馈判断电机是否处于零位,若电机处于零位,则开始实时判断光电传感器测量值,等待三个光电式传感器中至少两路触发;否则首先对电机进行回零操作,使电机回归零位,再对传感器状态进行实时监测
(2)当三个光电式传感器中有两路以上信号触发时,控制器发出驱动脉冲,控制锁紧电机正向转动,此时预设时间为30s,电机最大转动角度为273.6度,若电机运动超出预设时间或电机转动角度超过最大转动角度限制,则控制器控制电机停止转动,并向上位机发送出错信息;上位机收到出错信息后,发送中止锁紧命令,控制器对电机进行回零操作。
(3)在上述步骤(2)的进行过程中,控制器实时判断电感式传感器的状态,等待三个电感式传感器中至少两路触发后,控制器控制电机停止转动,表示完成抱紧和下压动作。
(4)当三个电感式传感器中有两路以上信号触发时,控制器发出驱动脉冲,控制电机继续正向转动,转动组件带动锁紧组件完成对目标卫星对接环的锁紧,,此时预设时间为30s,电机最大转动角度为537度,若电机运动超出预设时间或电机转动角度超过最大转动角度限制,则控制器控制电机停止转动,并向上位机发送出错信息;上位机收到出错信息后,发送中止锁紧命令,控制器对电机进行回零操作。
(5)在上述步骤(4)的进行过程中,控制器实时判断压力传感器的测量值,等待三个压力传感器中至少两路的测量值达到锁紧阈值门限要求,控制器控制电机停止转动,表示完成锁紧动作。
分阶段控制的具体控制过程如下:
(1)控制器将所有传感器状态和测量信息实时发送给上位机,上位机对各传感器状态进行实时监测,根据不同阶段控制需求,对控制器发送控制命令,控制电机动作。
(2)上位机实时监测光电传感器的触发状态,当三个光电式传感器中至少两路触发时,上位机发出“对接环抱紧和下压”指令给控制器;控制器接收到上位机命令后,根据指令发出驱动脉冲,控制电机正向转动,电机最大转动角度为273.6度。
(3)上位机实时监测电感式传感器的触发状态,在预设的时间范围内,当三个电感式传感器中至少两路触发时,发送“电机停止”指令至控制器,控制电机停止动作,此时对接环抱紧与下压动作以执行完毕。
(4)若没有至少两路电感式传感器触发,进一步判断是否电机已转动满足机构抱紧和下压运动的最大角度,若未达到最大角度且未达到预设的时间范围,则电机继续转动,若已到达最大角度或者达到预设的时间范围,上位机发送“中止锁紧”控制指令给控制器;控制器接收到该命令后控制电机停止动作,并控制电机反向转动回归零位。
(5)完成对目标卫星对接环的抱紧和下压后,上位机发出“对接环锁紧”指令,控制器接收到该命令后发出驱动脉冲,控制电机转动,此时电机最大转动角度设定为537度。
(6)上位机实时判断是否至少两路压力传感器的测量结果满足预紧力要求,若满足,上位机发出“电机停止”指令控制控制器停止电机动作;若不满足,进一步判断是否电机已转动至机构锁紧的最大角度,若未达到最大角度且未达到预设的时间范围,则电机继续转动;若已到达最大角度或者达到预设的时间范围,上位机发送“中止锁紧”指令控制控制器停止电机动作,并控制电机反向转动回归零位。
(7)完成对接环锁紧后,在锁紧执行机构需要与目标卫星对接环分离的时候,上位机发送“对接环分离”指令给控制器,控制器驱动电机继续正向转动,解除对目标卫星对接环的锁紧,在阻尼机构的预紧力的作用下锁紧执行机构将目标卫星弹出,完成与目标卫星的分离。
(8)上位机实时监测光电式传感器和电感式传感器的触发状态,在目标卫星与锁紧执行机构分离后,光电式传感器和电感式传感器中均有至少两个处于“未触发”状态,此时表明与目标卫星已成功分离,上位机发送“电机停止”指令由控制器控制电机停止转动,并控制电机回归零位。本发明未详细说明部分属于本领域技术人员公知常识。
Claims (5)
1.一种卫星对接锁紧自动控制方法,所述控制方法的锁紧执行机构采用电机提供动力,并包括安装在安装基座上的对目标星的对接环进行抱紧和下压功能的抱紧组件、实现与目标星对接环锁紧的锁紧组件以及在锁紧执行机构与目标星接触时减少刚性撞击的阻尼机构;其特征在于:
(1)在锁紧执行机构的安装基座上周向均布三个光电式传感器,当阻尼机构起阻尼作用并进入光电式传感器的感应范围内时,触发光电式传感器;在安装基座上周向均布三个电感式传感器,用于感应目标星对接环与锁紧执行机构的轴向最近距离;在安装基座上周向均布三个压力传感器,用于测量阻尼机构的阻尼力;
(2)当收到上位机“自动锁紧”命令后,控制器首先检查电机状态是否处于零位,若电机不处于零位则对电机进行回零操作;随后控制器实时监测光电式传感器的触发状态,在预设的时间范围内,当三个光电式传感器中至少两路触发时,控制器发出驱动脉冲,控制电机转动,电机带动抱紧组件对目标星对接环进行抱紧和下压,转步骤(3);否则,控制器向上位机反馈出错信息,由上位机终止本次锁紧;
(3)控制器实时监测电感式传感器的触发状态,在预设的时间范围内,当三个电感式传感器中至少两路触发时,控制器发出驱动脉冲,控制电机转动,电机带动锁紧组件对目标星对接环进行锁紧,转步骤(4);否则,进一步判断是否电机已转动满足锁紧执行机构抱紧和下压运动的最大角度,若未达到最大角度且在预设的时间范围内,则电机继续转动;若已到达最大角度或者超过预设的时间范围,控制器停止电机动作,并向上位机反馈出错信息,由上位机发指令通过控制器控制电机反向转动回归零位,中止锁紧任务;
(4)判断是否至少两路压力传感器的测量结果满足预紧力要求,若满足,控制器停止电机动作,完成锁紧;否则,进一步判断是否电机已转动至锁紧执行机构锁紧的最大角度,若未达到最大角度且在预设的时间范围内,则电机继续转动;若已到达最大角度或者超过预设的时间范围,控制器停止电机动作,并向上位机反馈出错信息,由上位机发指令通过控制器控制电机反向转动回归零位,中止锁紧任务。
2.根据权利要求1所述的一种卫星对接锁紧自动控制方法,其特征在于:所述步骤(2)、(3)中的驱动脉冲根据锁紧执行机构在相应阶段的行程确定,不能超过相应阶段锁紧执行机构的运动范围。
3.根据权利要求1所述的一种卫星对接锁紧自动控制方法,其特征在于:光电式传感器须准确反映目标星对接环与锁紧执行机构的相对距离,光电式传感器触发后,代表目标星对接环已进入锁紧执行机构工作范围,锁紧执行机构的抱紧组件才能对目标星对接环实施抱紧、下压动作;电感式传感器的感应范围即额定工作距离根据锁紧执行机构的锁紧组件有效作用距离进行选择,一般取锁紧组件对目标星对接环锁紧时有效作用距离的中间值±中间值×10%,针对目标星对接环的电感式传感器修正系数一般为0.3。
4.根据权利要求1所述的一种卫星对接锁紧自动控制方法,其特征在于:预设的时间范围为不超过30s。
5.一种卫星对接锁紧自动控制系统,其特征在于:包括上位机、控制器和传感器单元;所述的传感器单元包括在锁紧执行机构的安装基座上周向均布的三个光电式传感器,当阻尼机构起阻尼功能并达到光电式传感器的感应范围时,触发光电式传感器;包括在安装基座上周向均布的三个电感式传感器,用于感应目标星对接环与锁紧执行机构的距离;包括在安装基座上周向均布的三个压力传感器,用于测量阻尼机构的阻尼力;
控制系统包括上位机控制分阶段执行模式和自动锁紧工作模式;在自动锁紧工作模式下,上位机发出“自动锁紧”指令,执行权利要求1中的步骤(1)-(4);在分阶段执行模式下,上位机实时监测光电式传感器的触发状态,当三个光电式传感器中至少两路触发时,进入锁紧释放过程,上位机实时监控卫星对接锁紧释放的状态,根据当前所处的状态依据锁紧释放的先后状态顺序发送指令,由控制器接收上位机发送的指令,根据不同的指令控制锁紧执行机构执行相应的动作,具体:
上位机发出“对接环抱紧和下压”指令,控制器根据指令发出驱动脉冲,控制电机转动,上位机实时监测电感式传感器的触发状态,在预设的时间范围内,当三个电感式传感器中至少两路触发时,发送指令至控制器,控制电机停止动作;否则,进一步判断是否电机已转动满足锁紧执行机构抱紧和下压运动的最大角度,若未达到最大角度且在预设的时间范围内,则电机继续转动,若已到达最大角度或者超过预设的时间范围,上位机发送控制指令由控制器停止电机动作,并控制电机反向转动回归零位;
上位机发出“对接环锁紧”指令时,上位机控制控制器发出驱动脉冲,控制电机转动,电机带动锁紧组件对目标星对接环进行锁紧;上位机判断是否至少两路压力传感器的测量结果满足预紧力要求,若满足,上位机发指令控制控制器停止电机动作;若不满足,进一步判断是否电机已转动至锁紧执行机构锁紧的最大角度,若未达到最大角度且在预设的时间范围内,则电机继续转动;若已到达最大角度或者超过预设的时间范围,上位机发指令控制控制器停止电机动作,并控制电机反向转动回归零位;
上位机发“对接环分离”指令时,控制器驱动电机转动,解除对目标星对接环的锁紧,在阻尼机构的预紧力的作用下将目标星弹出,完成快速分离,根据光电式传感器和电感式传感器的触发状态,发送指令由控制器控制电机停止转动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610335263.7A CN106005488B (zh) | 2016-05-19 | 2016-05-19 | 一种卫星对接锁紧自动控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610335263.7A CN106005488B (zh) | 2016-05-19 | 2016-05-19 | 一种卫星对接锁紧自动控制方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106005488A CN106005488A (zh) | 2016-10-12 |
CN106005488B true CN106005488B (zh) | 2018-02-09 |
Family
ID=57095400
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610335263.7A Expired - Fee Related CN106005488B (zh) | 2016-05-19 | 2016-05-19 | 一种卫星对接锁紧自动控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106005488B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109375540A (zh) * | 2018-10-18 | 2019-02-22 | 九江精密测试技术研究所 | 一种集成化旋转锁紧伺服模块 |
CN109466806B (zh) * | 2018-11-30 | 2020-09-22 | 上海航天控制技术研究所 | 一种空间运输飞行器多负载驱动器系统 |
CN109573112B (zh) * | 2018-12-10 | 2020-10-02 | 上海航天控制技术研究所 | 一种航天器对接机构主动对接控制方法 |
CN109649695B (zh) * | 2018-12-12 | 2021-12-14 | 上海航天控制技术研究所 | 一种货运飞船对接机构主驱动电机的驱动控制方法及装置 |
CN113581057B (zh) * | 2021-06-11 | 2022-07-12 | 北京航天发射技术研究所 | 一种锁紧机构的锁紧方法及装置 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2528385A1 (fr) * | 1982-06-15 | 1983-12-16 | Aerospatiale | Mecanisme d'accostage et d'arrimage pour vaisseaux spatiaux |
JP2564186B2 (ja) * | 1989-03-01 | 1996-12-18 | 科学技術庁航空宇宙技術研究所 | 宇宙構造物制振装置 |
US8783622B2 (en) * | 2011-03-09 | 2014-07-22 | Raytheon Company | Methods and apparatus for a grappling device |
CN104477417B (zh) * | 2014-09-19 | 2016-08-24 | 航天东方红卫星有限公司 | 一种星星在轨对接及锁定装置 |
CN104590592B (zh) * | 2015-01-13 | 2017-01-04 | 中北大学 | 一种空间电磁对接机构 |
CN105366077B (zh) * | 2015-11-27 | 2017-07-28 | 中国空间技术研究院 | 一种适用于卫星对接环对接的锁紧释放装置 |
-
2016
- 2016-05-19 CN CN201610335263.7A patent/CN106005488B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN106005488A (zh) | 2016-10-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106005488B (zh) | 一种卫星对接锁紧自动控制方法及系统 | |
US10309304B2 (en) | Electrical augmentation of a gas turbine engine | |
EP2610485A2 (en) | Wind turbine system | |
CN110125312A (zh) | 一种自动制孔铆接控制系统及控制方法 | |
CN105197261A (zh) | 面向在轨服务的快速翻滚目标消旋细胞帆及其工作方法 | |
CN103587719A (zh) | 平板件的全自动钻铆定位方法 | |
CN109445274A (zh) | 一种柔性空间机械臂振动控制方法及系统 | |
US20130036864A1 (en) | Method of operating a pivot drive | |
US20060180012A1 (en) | Rotary shell reloader | |
CN103869791B (zh) | 一种发动机试验集散式控制系统及方法 | |
CN109186900B (zh) | 一种基于转矩控制的扭转弹簧模拟装置和方法 | |
CN106292543A (zh) | 基于fpga的多轴运动控制器及其应用 | |
CN112326185B (zh) | 一种暂冲式超声速风洞三自由度投放机构就位控制方法 | |
EP3085497A1 (en) | Control system and apparatus for power wrench | |
CN206818741U (zh) | 舵机的测量装置 | |
CN1923622A (zh) | 一种卫星飞行参数实时预测方法 | |
CN102266612B (zh) | 活塞运动的判断方法及装置、呼吸机 | |
CN105676801B (zh) | 机组自启停控制系统 | |
CN207268585U (zh) | 一种火箭发射平台 | |
CN109926815A (zh) | 一种机器人自动装配螺纹副方法 | |
CN106508002B (zh) | 一种利用飞轮捕获地球的三轴机动渐进控制方法 | |
CN104571116A (zh) | 一种光电稳定平台的位置回路坐标系转换方法 | |
CN105278552B (zh) | 一种基于cmc芯片的定日镜控制器 | |
CN101712129B (zh) | 机床重力负载电气配重的系统 | |
CN109725653B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180209 Termination date: 20180519 |