一种变构型空间机器人及路径规划方法技术

本发明专利技术公开了一种变构型空间机器人及路径规划方法，变构型空间机器人中的任意两部第六臂杆互相捕获，形成闭环结构；解锁待改变构型的臂杆中的被动圆柱铰；将闭环结构等效为开环系统：以解锁的被动圆柱铰为分界，将整个闭环结构划分为两段，一段总自由度数较多，另一段总自由度数较少，两段中通过被动圆柱铰相连的两臂杆受到被动圆柱铰的约束；确定总自由度数较多的端部臂杆，相对于空间机器人平台的运动规律；所述端部臂杆为与被动圆柱铰相连的两臂杆；根据步骤中的总自由度数较多的端部臂杆，相对于空间机器人平台的运动规律，求解各个关节角时间序列。本发明专利技术实现了机械臂的自主变构型，提高了机械臂在轨操作能力。

【技术实现步骤摘要】
一种变构型空间机器人及路径规划方法
本专利技术涉及一种变构型空间机器人及路径规划方法，特别涉及一种基于奇异度量避免机器人奇异的路径规划算法和自主变构型机器人设计，属于空间机器人领域。
技术介绍
使用空间机器人对超出服役期或出现故障的航天器进行回收、维护、再利用，可以节约大量的人力资源和资金。但是由于空间机器人捕获目标是一项复杂的空间操作，通常机械臂的构型参数(臂杆长度、关节转轴方向等)是针对某一特定的任务设计。为了使机械臂具有更强的通用性，降低整个航天任务的成本，期望机械臂具有变构型、变臂杆长度的特点。为此，一种“被动圆柱铰”机构被设计。被动圆柱铰连接了两个刚性臂杆，内部有被动锁死装置。在平时操作中，圆柱铰内部锁死，固定两个刚性体间的相对平动和转动。在空间机器人变构型过程中，机械臂末端作动器捕获空间机器人平台上某一点，或者两部机械臂的末端作动器互相捕获形成闭环结构，然后释放被动圆柱铰内部的锁死机构，通过在其余关节上施加力矩，改变两个刚体间的相对平动和转动，实现机械臂自主的变构型过程。被动圆柱铰这种新型铰链的加入，给系统运动规划带来难题——活动自由度增大，且需要规划铰链内部的运动。现有的研究仅针对铰链数目较少的变构型机械臂系统，算法适用性还无法满足在轨应用的需求。此外，由于空间机器人自由度较多，构型容易陷入奇异，需要设计路径规划算法在实现空间机器人变构型的同时，避免构型奇异，目前国内外还没有一种适合于多自由度数的变构型机械臂系统的路径规划方法。
技术实现思路
本专利技术要解决的技术问题是：针对现有技术的不足，提供了一种变构型空间机器人及路径规划方法，实现了机械臂的自主变构型，提高了机械臂在轨操作能力。本专利技术的方法是通过下述技术方案实现的。一种自主变构型空间机器人包括：第一刚体、第二刚体、被动圆柱铰、空间机器人平台、多个机器臂；其中每个机械臂又包括第一臂杆、第二臂杆、第三臂杆、第四臂杆、第五臂杆和第六臂杆；第二臂杆又包括臂杆A和臂杆B，第三臂杆又包括臂杆C和臂杆D；第一刚体、第二刚体通过被动圆柱铰相连；第一臂杆的一端通过柱铰与空间机器人平台相连、第一臂杆的另一端通过柱铰与臂杆A的一端相连；臂杆A的另一端通过被动圆柱铰与臂杆B的一端相连；臂杆B的另一端通过柱铰与臂杆C的一端相连；臂杆C的另一端通过被动圆柱铰与臂杆D的一端相连；臂杆D的另一端通过柱铰与第四臂杆的一端相连；第四臂杆的另一端通过柱铰与第五臂杆的一端相连；第五臂杆的另一端通过柱铰与第六臂杆的一端相连。一种用于变构型空间机器人的路径规划方法，包括步骤如下：(1)变构型空间机器人中的任意两部第六臂杆互相捕获，形成闭环结构；(2)解锁待改变构型的臂杆中的被动圆柱铰，使该被动圆柱铰连接的两个刚体能够发生相对平动和转动；(3)将步骤(1)中的闭环结构等效为开环系统：以步骤(2)中解锁的被动圆柱铰为分界，将整个闭环结构划分为两段，一段总自由度数较多，另一段总自由度数较少，两段中通过被动圆柱铰相连的两臂杆受到被动圆柱铰的约束；(4)根据变构型需求，确定总自由度数较多的端部臂杆，相对于空间机器人平台的运动规律；所述端部臂杆为与被动圆柱铰相连的两臂杆；(5)根据步骤(4)中的总自由度数较多的端部臂杆，相对于空间机器人平台的运动规律，求解各个关节角时间序列。步骤(4)中确定总自由度数较多的端部臂杆，相对于空间机器人平台的运动规律的具体方式如下：确定总自由度数较少的机械臂的端部臂杆相对于空间机器人平台保持不动，然后计算出总自由度数较多的机械臂的端部臂杆，相对于总自由度数较少的机械臂的端部臂杆的运动规律，最终将总自由度数较多的机械臂的端部臂杆相对于总自由度数较少的机械臂的端部臂杆的运动规律，通过坐标变换转化为总自由度数较多的机械臂的端部臂杆相对于空间机器人平台的位置Rtip和姿态Ωtip的运动规律。步骤(5)中求解各个关节角时间序列的具体实现方式如下：(5.1)建立步骤(4)中总自由度数较多的机械臂的端部臂杆与这段中其他各个关节角间的运动学关系：其中，q表示总自由度数较多的机械臂中各个关节角组成的矩阵，表示各个关节角速度；J(q)表示q的雅克比矩阵；(5.2)确定总自由度数较多的机械臂的奇异度量指标m：(5.3)对奇异度量指标m求导得到其中，J+(q)表示雅克比矩阵J(q)的广义逆；k表示待定向量；I表示单位矩阵，阶数与总自由度数较多的机械臂的自由度数；(5.4)为保证m始终有增大的趋势，即保证则可得到时，能够保证(5.5)根据步骤(5.4)得到的k以及步骤(5.1)的运动学关系，求解各个关节角速度：(5.6)对步骤(5.5)得到的各个关节角速度进行积分，得到各个关节角时间序列。本专利技术与现有技术相比的有益效果为：1.本专利技术的一种能够自主变构型的空间机器人，基于被动圆柱铰设计，增加空间机器人活动自由度，使其具备变构型的功能，提高了空间机器人在轨操作的能力。2.本专利技术的一种空间机器人自主变构型的路径规划方法，根据空间机器人变构型阶段的特点，利用系统自由度冗余的特性，定义了构型奇异指标，设计使指标持续增大的路径规划算法，能够避免在机器人重构过程中陷入奇异。3.本专利技术的一种空间机器人自主变构型的路径规划方法，具有普适性，能够进行推广，即该方法不仅适用于变构型空间机器人，而且适用于普通机器人和一般多自由度运动系统的规划。附图说明图1为本专利技术机械臂组成示意图；图2为本专利技术被动圆柱铰示意图；图3为本专利技术变构型空间机器人结构示意图；图4为本专利技术臂杆长度改变时闭环系统示意图；图5为本专利技术臂杆长度改变时等效的开环系统示意图图6为本专利技术臂杆被拉伸后系统的构型示意图；图7为本专利技术机械臂各个转动关节的相对转动角速度；图8为本专利技术臂杆A10和臂杆B11相对转动和平移示意图；图9为本专利技术奇异度量结果示意图。具体实施方式下面结合附图对本专利技术的结构组成和工作原理做进一步解释。如图1、2、3所示，一种自主变构型空间机器人包括：第一刚体1、第二刚体2、被动圆柱铰3、空间机器人平台4、多个机器臂(本实施例中采用3个机械臂，如图2所示，机械臂5、机械臂6、机械臂7)；其中每个机械臂又包括第一臂杆8、第二臂杆9、第三臂杆12、第四臂杆15、第五臂杆16和第六臂杆17；第二臂杆9又包括臂杆A10和臂杆B11，第三臂杆12又包括臂杆C13和臂杆D14；第一刚体1、第二刚体2通过被动圆柱铰3相连第一刚体1和第二刚体2均为圆柱体。第一臂杆8的一端通过柱铰与空间机器人平台4相连、第一臂杆8的另一端通过柱铰与臂杆A10的一端相连；臂杆A10的另一端通过被动圆柱铰3与臂杆B11的一端相连；臂杆B11的另一端通过柱铰与臂杆C13的一端相连；臂杆C13的另一端通过被动圆柱铰3与臂杆D14的一端相连；臂杆D14的另一端通过柱铰与第四臂杆15的一端相连；第四臂杆15的另一端通过柱铰与第五臂杆16的一端相连；第五臂杆16的另一端通过柱铰与第六臂杆17的一端相连。多个机械臂之间可以通过各自的第六臂杆17相互捕获形成闭环结构。第六臂杆17的末端带有作动器。被动圆柱铰(3)为被动锁死结构，内部不包含主动施加控制力和力矩的执行机构，仅存在两种状体，被动锁死和解锁；当该铰链锁死时，不允许其连接的两个刚体发生相对平动和转动；反之，能够相对运动，从而本文档来自技高网...

【技术保护点】
一种自主变构型空间机器人，其特征在于包括：第一刚体(1)、第二刚体(2)、被动圆柱铰(3)、空间机器人平台(4)、多个机器臂；其中每个机械臂又包括第一臂杆(8)、第二臂杆(9)、第三臂杆(12)、第四臂杆(15)、第五臂杆(16)和第六臂杆(17)；第二臂杆(9)又包括臂杆A(10)和臂杆B(11)，第三臂杆(12)又包括臂杆C(13)和臂杆D(14)；第一刚体(1)、第二刚体(2)通过被动圆柱铰(3)相连；第一臂杆(8)的一端通过柱铰与空间机器人平台(4)相连、第一臂杆(8)的另一端通过柱铰与臂杆A(10)的一端相连；臂杆A(10)的另一端通过被动圆柱铰(3)与臂杆B(11)的一端相连；臂杆B(11)的另一端通过柱铰与臂杆C(13)的一端相连；臂杆C(13)的另一端通过被动圆柱铰(3)与臂杆D(14)的一端相连；臂杆D(14)的另一端通过柱铰与第四臂杆(15)的一端相连；第四臂杆(15)的另一端通过柱铰与第五臂杆(16)的一端相连；第五臂杆(16)的另一端通过柱铰与第六臂杆(17)的一端相连。

【技术特征摘要】
1.一种自主变构型空间机器人，其特征在于包括：第一刚体(1)、第二刚体(2)、被动圆柱铰(3)、空间机器人平台(4)、多个机械臂；其中每个机械臂又包括第一臂杆(8)、第二臂杆(9)、第三臂杆(12)、第四臂杆(15)、第五臂杆(16)和第六臂杆(17)；第二臂杆(9)又包括臂杆A(10)和臂杆B(11)，第三臂杆(12)又包括臂杆C(13)和臂杆D(14)；第一臂杆(8)的一端通过柱铰与空间机器人平台(4)相连、第一臂杆(8)的另一端通过柱铰与臂杆A(10)的一端相连；第四臂杆(15)的另一端通过柱铰与第五臂杆(16)的一端相连；第五臂杆(16)的另一端通过柱铰与第六臂杆(17)的一端相连；臂杆A(10)和臂杆C(13)为第一刚体(1)，臂杆B(11)和臂杆D(14)为第二刚体(2)，第一刚体(1)、第二刚体(2)通过被动圆柱铰(3)相连，具体为：臂杆A(10)的另一端通过被动圆柱铰(3)与臂杆B(11)的一端相连；臂杆B(11)的另一端通过柱铰与臂杆C(13)的一端相连；臂杆C(13)的另一端通过被动圆柱铰(3)与臂杆D(14)的一端相连；臂杆D(14)的另一端通过柱铰与第四臂杆(15)的一端相连；所述被动圆柱铰(3)为被动锁死结构，内部不包含主动施加控制力和力矩的执行机构，仅存在两种状体，被动锁死和解锁；当该铰链锁死时，不允许其连接的两个刚体发生相对平动和转动；反之，能够相对运动，从而改变这两个刚体组成的臂杆的长度和相对转角。2.根据权利要求1所述的一种自主变构型空间机器人，其特征在于：所述第一刚体(1)和第二刚体(2)均为圆柱体。3.根据权利要求1所述的一种自主变构型空间机器人，其特征在于：所述多个机械臂之间可以通过各自的第六臂杆(17)相互捕获形成闭环结构。4.根据权利要求3所述的一种自主变构型空间机器人，其特征在于：所述第六臂杆(17)的末端带有作动器。5.一种用于权利要求1所述的自主变构型空间机器人的路径规划方法，其特征在于步骤如下：(1)变构型空间机器人中的任意两部第六臂杆互相捕获，形成闭环结构；(2)解锁待改变构型的臂杆中的被动圆柱铰，使该被动圆柱铰连接的两个刚体能够发生相对平动和转动；(3)将步骤(1)中的闭环结构等效为开环系统：以步骤(2)中解锁的被动圆柱铰为分界，将整个闭环结构划分为两段，一段总自由度数较多，另一段总自由度数较少，两段中通过被动圆柱铰相连的两臂杆受到被动圆柱铰的约束；(4)根据变构型需求，确定总自由度数较多的端部臂杆，相对于空间机器人平台的运动规律；所述端部臂杆为与被动圆柱铰相连的两臂杆；(5)根据步骤(4)中的总自由度数较多的端部臂杆，相对于空间机器...

【专利技术属性】
技术研发人员：汤亮，何英姿，胡权，王大轶，张海博，
申请(专利权)人：北京控制工程研究所，
类型：发明
国别省市：北京;11