本发明专利技术涉及一种空间绳系机器人系统逼近目标协调控制方法，首先根据目标与操作机器人初始相对位置及最终理想逼近位置给出整个逼近过程中的优化控制指标，利用高斯伪谱法得出这个过程中离散控制点处目标轨道坐标系Ot-xyz下x、y及z轴三个方向的理想离散控制力；然后利用Hermite插值法内插得到操作机器人逼近目标过程中x、y及z轴三个方向理想连续控制力；分析空间系绳仅能提供拉力的特性，以推力器上消耗燃料最少为优化指标利用模拟退火算法将理想连续控制力优化分配给操作机器人自带推力器及空间系绳；最后，空间系绳提供拉力的同时产生的姿态干扰通过操作机器人上自带反作用轮利用时间延迟算法进行抑制和稳定。
【技术实现步骤摘要】
【技术保护点】
一种空间绳系机器人系统逼近目标协调控制方法，其特征在于：空间绳系机器人系统是空间机动平台、空间系绳和操作机器人构成，控制步骤如下：步骤1：利用高斯伪谱法得出在目标轨道坐标系Ot?xyz下x、y及z轴三个方向操作机器人逼近目标时的理想轨道控制加速度组成的操作机器人相对目标轨道动力学方程：x··-2ωz·=axy··+ω2y=ayz··+2ωx·-3ω2z=az其中：X(t)=xyzx·y·z·T为状态变量，x、y及z分别表示操作机器人在目标轨道坐标系Ot?xyz下x、y及z轴三个方向的位置，及分别表示操作机器人在目标轨道坐标系Ot?xyz下x、y及z轴三个方向的速度，Uo(t)＝[ax?ay?az]T为控制变量，m为操作机器人的质量，t∈[t0,tf]为操作机器人逼近时间，ω为目标轨道角速度；步骤2：利用改进型非劣分类遗传算法将高斯伪谱法得出的操作机器人在轨道坐标系Ot?xyz下的理想控制力Fx、Fy及Fz分配到空间系绳和操作机器人自带推力器上：Jf1＝w1Fx′+w2Fy′+w3Fz′Jf2＝w4Ttx′+w5Tty′+w6Ttz′其中：Jf1为对控制力进行分配时的第一优化指标，Jf2为对控制力进行分配时的第二优化指标；w1、w2及w3为第一优化指标内权重系数，且w1+w2+w3＝1，w1∈(0,1)，w2∈(0,1)，w3∈(0,1)，Fx′、Fy′与Fz′为理想控制力优化分配后在目标轨道坐标系x、y和z方向推力器所需提供的控制力；w4、w5及w6为第二优化指标内权重系数，且w4+w5+w6＝1，w4∈(0,1)，w5∈(0,1)，w6∈(0,1)，Ttx′、Tty′及Ttz′分别为空间系绳提供拉力时对操作机器人产生的目标轨道坐标系x、y和z方向的姿态干扰力矩；所述Ttx′、Tty′及Ttz′为T′＝[Ttx′?Tty′?Ttz′]T，根据T′＝?l×Ft′求得，其中l×=0-lz′ly′lz′0-lx′-ly′lx′0,lx′,ly′和lz′分别为空间系绳与操作机器人的连接点距离操作机器人本体质心相对位置在本体坐标系下x、y和z方向的距离，F′为目标轨道坐标系Ot?xyz上优化分配到空间系绳上的力矢量；以指标Jf1和Jf2最小为优化目标利用改进性非劣分类遗传多目标优化算法进行优化分配，得到一组Pareto最优解，以Jf1指标为先的原则在其中选择一个解完成理想控制力的优化分配；步骤3：采用协调姿态稳定算法利用操作机器人上的反作用轮抑制空间系绳拉力对操作机器人产生的姿态干扰：Ua=Ua(t-T)+Ic[2Q·(Q×)-(Q→Qd)-ωct2-ω·c(t-T)]+ωc×(t)[Icωc(t)+Rwωc(t)+RwΩ(t)]-ωc×(t-T)[Icωc(t-T)+Rwωc(t-T)+RwΩ(t-T)]其中T为控制周期，Ua(t?T)为前一控制周期的姿态控制量，Ic为操作机器人的惯量矩阵，Q＝[q0?q1?q2?q3]T为操作机器人的姿态四元数，Qd为操作机器人期望姿态四元数，Q×=-q1-q2-q3q0-q3q2q3q0-q1-q2q1q0为姿态矩阵，ωc＝[ωcx?ωcy?ωcz]T为操作机器人转动角速度，ωcx、ωcy及ωcz为操作机器人转动角速度在本体坐标系下x、y及z轴向的分量，ωc(t?T)为前一周期操作机器人转动角速度，ωc×=0-ωczωcyωcz0-ωcx-ωcyωcx0为转动角速度矩阵，为反作用轮的惯量矩阵，及分别为安装在本体坐标系下x、y及z轴上的反作用轮的转动惯量，Ω＝[Ω1?Ω2?Ω3]T为反作用轮相对于操作机器人本体的转动角速度，Ω1、Ω2及Ω3分别为安装在本体坐标系下x、y及z轴上的反作用轮的转速，ωc×(t-T)=0...
【技术特征摘要】
【专利技术属性】
技术研发人员：黄攀峰，徐秀栋，孟中杰，刘正雄，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。