[发明专利]面向空间绳系机器人的目标逼近过程鲁棒规划控制方法

说明书

【技术领域】

本发明隶属于航天器控制技术研究领域，涉及到一种空间绳系机械臂抓捕目标逼近控制方法，该控制方法可以广泛应用于空间绳系机械臂目标抓捕控制中。

【背景技术】

空间绳系机器人在失控卫星捕获，太空垃圾清理，辅助变轨，在轨维修，在轨组装，等方面可以发挥独特的优势。对目标的逼近过程的控制作为其关键技术是对目标实现成功抓捕的关键。

空间绳系机械人对目标逼近控制需考虑逼近过程中的轨道控制以及姿态稳定，对于空间绳系机械人，系绳可以为控制任务提供控制力和控制力矩，因而系绳的参与可以在一定程度上减轻推力器的任务压力，有助于节省空间机械人的能源消耗。而采用系绳和推力器协调对空间机械人轨道进行控制时，主要存在如下几个问题：首先是系绳张力容易对空间机械人带来力矩，进而对姿态的稳定带来干扰。而若采用姿态控制装置对该干扰进行补偿，无疑会带来新的能源消耗。因而对于以能源消耗最小为重要指标的逼近任务，故仅考虑逼近过程轨道控制中推力器的能源消耗，而不将其带来的额外姿态稳定控制能源消耗考虑在内是不合理的。其次，由于需要达到一定范围的接触条件才能保证捕获成功，因此在对目标的逼近过程中的任何轨道偏差都有可能使最后的条件不能满足该接触条件，进而导致抓捕失败甚至碰撞。而导致轨道偏差的因素主要有：模型偏差，轨道摄动，导航偏差，系绳张力矢量偏差，推进器矢量偏差，和推进器故障。由于抓捕任务持续时间较短，且只考虑抓捕机器人与目标航天器的相对运动，因而轨道摄动对该任务的影响十分有限可以忽略不计。推进器故障属于硬件故障，将对该任务产生很大影响，但任务期间硬件故障的发生是偶然性事件，不带有必然性，因而不在本文考虑范围。导航偏差主要包括位置，线速度，姿态，角速度等的测量偏差，主要原因是敏感器的安装误差以及测量性能的局限性。系绳张力矢量偏差主要包括张力大小以及方向的偏差，张力持续时间偏差，主要原因是系绳释放机构的不敏感性以及系绳矢量方向测量或计算偏差。推进器矢量偏差主要包括推力大小以及方向的偏差，推力持续时间偏差，空间机械臂质量偏差。以上这些不确定因素和偏差对任务的影响是巨大的，充分考虑这些因素进行对于抓捕任务的成功执行具有很大意义。因而有必要对绳系机器人逼近轨迹规划提出一种考虑不确定性的规划方法来降低任务对这些不确定性的敏感性，并提高方案的可靠性。

【发明内容】

提出一种绳系机器人可移动系绳点的控制方法，通过对系绳点的空间位置进行控制大幅度降低甚至消除系绳张力对空间绳系机器人的力矩，进而降低甚至消除了系绳张力对绳系机器人产生的姿态干扰。此时仅需考虑逼近过程轨道控制中推力器的能源消耗最小就可以得到能源消耗最小的逼近任务执行方案。提出一种考虑不确定性的绳系机器人逼近目标规划方法，采用推力器和系绳对绳系机器人进行控制，考虑导航偏差，系绳张力矢量偏差，推进器矢量偏差等不确定因素，建立绳系机器人逼近目标不确定规划模型，并采用粒子群优化算法进行求解，得到带有鲁棒性的空间绳系机器人控制方案。

为达到上述目的，本发明所采用的技术方案包括以下步骤：

1)空间绳系机械人可移动系绳点控制

在空间绳系机器人的后端面设置有a、b、c、d为四个系绳收放口，通过内部系绳控制电机对系绳长度进行控制，四条系绳l_a、l_b、l_c、l_d连接于空间中点t，并且该点与平台连接的系绳相连，绳系机器人质心O_b在后端面的投影为O'_b；在逼近过程中，通过对l_a、l_b、l_c、l_d四条系绳的长度调整，控制t点在空间中的位置；平台位于点P；

使O_b,t,P三点共线，即：建立优化目标函数：

s.t.

采用优化算法进行求解得到λ＝λ^*，则则四个系绳收放口a、b、c、d据此对系绳长度进行调整，其中收放口a释放/收回系绳(其中当时为释放，当为收回)，其他三个系绳收放口与收放口a相同；

2)建立空间绳系机械人相对目标运动不确定动力学模型

当目标和绳系机器人运行在近圆轨道时，通过C-W方程描述二者的相对运动，其状态空间模型为：

其中，U＝U₁+U₂，为推力器提供的速度脉冲，为与系绳拉力等效的速度脉冲，T为控制周期；

则