一种单关节故障空间机械臂位姿可达空间求解方法技术

本发明专利技术实施例提供了一种单关节故障空间机械臂位姿可达空间求解方法，实现了任一关节故障锁定后空间机械臂可达位姿退化情况的量化分析，包括：基于关节人为限位求解单关节故障锁定的空间机械臂退化工作空间；构建姿态可达度指标，求解面向任务的空间机械臂期望姿态；综合期望姿态与退化工作空间内各散点坐标构建机械臂末端位姿集，筛选其中存在逆解的位姿，获得单关节故障的空间机械臂位姿可达空间。根据本发明专利技术实施例提供的技术方案，可以实现任一关节故障锁定的空间机械臂位姿可达空间求解。

A space mechanical arm position and pose solving method for single joint failure

The embodiment of the invention provides a single joint failure of space manipulator pose workspace solving method can quantify the degradation of space manipulator to pose any joint locking after fault analysis, including: artificial joint locking position limit for solving single joint failure of space manipulator degradation working space based on building attitude can reach; index of space manipulator to the desired attitude solving task oriented; comprehensive expectation attitude and work space of the degraded plot to build kinematics, inverse pose the existing screening solutions, obtain the single joint failure of space manipulator pose workspace. According to the technical scheme provided by the embodiment of the invention, the spatial manipulator position and position of any joint fault locking can be achieved in space.

【技术实现步骤摘要】
一种单关节故障空间机械臂位姿可达空间求解方法
本专利技术涉及一种单关节故障空间机械臂位姿可达空间求解方法，属于空间机械臂容错控制

技术介绍
随着人类对太空探索的不断深入，具有跨度大、操作灵活、负载能力强等特点的空间机械臂应用日益广泛。但是工作环境的恶劣与关节结构的复杂，使得长期服役的空间机械臂发生关节故障的概率增大。机械臂在关节故障后仍能执行同时考虑末端位置和姿态可达的在轨空载/负载操作，对太空探索任务的高质量完成具有至关重要的作用。因此，开展关节故障的空间机械臂末端位姿可达性的相关研究，对加快人类探索空间进度具有非常大的理论价值和现实意义。空间机械臂通常基于退化工作空间执行关节故障锁定后的空间操作任务，退化工作空间体积大小受故障关节锁定角度影响，当故障关节锁定至某些特殊角度时，工作空间严重退化导致空间机械臂可能无法完成后续任务。而且，退化工作空间不具有表征空间机械臂末端姿态可达性的特点，这将严重影响空间机械臂执行对末端位置和姿态都有要求的空间操作任务。因此，建立可满足后续任务位置可达性需求，且能够同时表征机械臂末端姿态可达性的工作空间，即机械臂位姿可达空间，对于空间机械臂关节故障后仍能继续完成后续操作任务具有至关重要的现实意义。
技术实现思路
有鉴于此，本专利技术实施例提供了单关节故障的空间机械臂位姿可达空间分析方法，所求位姿可达空间可为发生关节故障锁定的空间机械臂同时考虑末端位置和姿态可达性的后续操作提供保障。上述单关节故障空间机械臂位姿可达空间的求解过程中，用到的方法至少包括：依据故障关节锁定角度与空间机械臂退化工作空间体积之间的对应关系，以保证退化工作空间满足后续任务需求为目标，基于牛顿-拉夫逊法解出每一关节的人为限位，即在机械臂处于常态时人为限定关节转动范围，基于各关节所求人为限位范围，通过蒙特卡洛法求得单关节故障后空间机械臂的退化工作空间；依据末端处于不同姿态时机械臂可达空间不同这一特点，构建姿态可达度指标，针对空间机械臂具体操作任务所对应的末端姿态变化范围，基于姿态可达度指标求出其中不同姿态所对应的可达空间体积，选取最大可达空间对应的姿态作为空间机械臂面向任务的期望姿态；依据所求退化工作空间中各散点位置坐标和期望姿态的组合，构建空间机械臂末端位姿集，基于解析法筛选位姿集中存在逆运动学解的位姿，由这些位姿所对应的散点组成机械臂位姿可达空间，以实现单关节故障空间机械臂的位姿可达空间求解。上述求解过程中，计算单关节故障空间机械臂退化工作空间的过程包括：第一步，基于D-H参数法建立n自由度空间机械臂运动学模型，无故障状态下，令空间机械臂从基座到末端的各关节依次表示为J1～Jn，各关节对应关节角度依次表示为θ1～θn，各连杆依次表示为L1～Ln；定义为连杆i-1和i之间的位姿转换矩阵，则机械臂正运动学方程可表示为：当空间机械臂关节k发生故障并锁定在θk角度时，定义关节k后面各关节及各连杆编号在原有的基础上减1，并增加上标“～”；将连杆Lk-1与Lk视为一个连杆，即基于常态下空间机械臂正运动学方程可得单关节故障的空间机械臂正运动学方程为：上式中，第二步，基于蒙特卡洛法求解各关节在对应物理限位范围内转动时的空间机械臂工作空间W：上式中，Q表示n自由度空间机械臂常态下的关节角序列集合；设空间机械臂各关节人为限位为其中，和分别表示关节i的人为限位上下限，基于蒙特卡洛法及工作空间W的求解公式，可得各关节被人为限位时空间机械臂工作空间当关节k发生故障并锁定在θk角度时，空间机械臂正常关节的人为限位将会被释放至对应物理限位，即基于蒙特卡洛法及退化机械臂正运动学方程可得空间机械臂退化工作空间基于工作空间体积权衡阈值ζ，建立空间机械臂退化工作空间与常态下工作空间之间的权衡依据如下：上式中，表示空间机械臂退化工作空间的体积，表示常态下空间机械臂的工作空间的体积；第三步，基于牛顿-拉夫逊法求解空间机械臂各关节的人为限位，具体求解步骤如下：(1)令迭代次数j＝1，取空间机械臂关节k以外所有关节的人为限位为对应物理限位，即转至步骤(2)；(2)基于工作空间求解公式求解各关节被人为限位时的空间机械臂工作空间令关节k故障锁定在并使以Δq为步长依次遍历关节k的转动范围[-π,π]，基于退化工作空间求解公式求解关节k锁定在不同角度时所对应的空间机械臂退化工作空间转至步骤(3)；(3)基于所求退化工作空间筛选[-π,π]范围内满足退化工作空间与常态下工作空间权衡依据的关节角度区间，令其中最大区间为关节k的人为限位，转至步骤(4)；(4)重复步骤(1)至(3)，求解空间机械臂所有关节的人为限位完成空间机械臂各关节人为限位的单次求解，转至步骤(5)；(5)基于所求各关节的人为限位重新计算空间机械臂工作空间转至步骤(6)；(6)若j＝1，则重复步骤(2)至(5)对机械臂各关节进行人为限位再求解；若j≤jmax(jmax为迭代次数上限)且相邻两次求解所得各关节人为限位上下限的误差满足下式：上式中，υ表示最大允许误差；则输出此时对应的完成空间机械臂各关节人为限位求解；若j＝jmax时所求各关节人为限位仍不满足式(7)，则修改ζ和υ等阈值并重复步骤(1)至(6)，直至迭代次数j≤jmax时所求结果满足式(7)为止；在完成空间机械臂各关节人为限位求解的基础上，当某关节故障锁定时，基于退化工作空间求解公式，即可求得满足后续任务位置可达性要求且体积不小于的空间机械臂退化工作空间上述求解过程中，计算空间机械臂面向任务的期望姿态的过程包括：第一步，基于末端姿态不同对应空间机械臂末端可达散点占空间散点总数的比值不同，进行空间机械臂姿态可达度指标的构造；基于蒙特卡洛法随机遍历N组关节角序列可形成空间机械臂末端可达位置集合P：P＝{(xn,yn,zn)|n＝1,2,...,N}(8)令欧拉角(α,β,γ)表示空间机械臂末端相对于基坐标系的姿态，任一姿态(α,β,γ)同位置集P中各位置向量(xn,yn,zn)进行组合，可构成包含N个位姿的集合PE：PE＝{(xn,yn,zn,α,β,γ)|n＝1,2,...,N}(9)基于解析法计算空间机械臂分别以位姿集PE中各元素为末端位姿所对应的逆运动学解，即令机械臂末端处于PE中某一位姿，然后求解此时对应的机械臂关节角序列，设可获得M个有逆解的位姿；定义具有逆解的位姿个数M同总位姿个数N的比值为姿态(α,β,γ)所对应的姿态可达度R：R＝M/N(10)第二步，基于空间机械臂后续任务要求末端姿态α,β,γ取值范围分别为α∈[αmin,αmax]，β∈[βmin,βmax]，γ∈[γmin,γmax]，以为步长依次遍历α,β,γ的取值范围，可获得空间机械臂末端的可达姿态集E：上式中，ηβ,ηγ取值类似于ηα；可达姿态集E中包含元素总个数可表示为：令可达姿态集E中任一姿态同空间机械臂可达位置集P中各位置向量(xn,yn,zn)进行组合，即可形成姿态所对应的包含N个位姿的空间机械臂位姿集基于姿态可达度指标计算公式求解姿态所对应的姿态可达度Rη；第三步，基于任一姿态的姿态可达度Rη的计算方法，求解空间机械臂可达姿态集E中所有姿态所对应的姿态可达度Rη(η＝1,2,...,ε)；基于姿态可达度越大对应空间机械臂本文档来自技高网...

【技术保护点】
一种单关节故障空间机械臂位姿可达空间求解方法，其特征在于，该方法包括以下步骤：(1)基于牛顿‑拉夫逊法求解空间机械臂各关节人为限位，当机械臂任一关节故障锁定后，释放其他关节的人为限位至物理限位，通过蒙特卡洛法求解单关节故障后空间机械臂的退化工作空间；(2)依据末端处于不同姿态时机械臂可达空间不同这一特点，构建空间机械臂姿态可达度指标，求解空间机械臂末端处于不同姿态时的姿态可达度，选取最大姿态可达度对应的姿态作为空间机械臂面向任务的期望姿态；(3)依据所求退化工作空间中各散点位置坐标和期望姿态的组合，构建空间机械臂末端位姿集，基于解析法筛选位姿集中存在逆运动学解的位姿，由这些位姿所对应的散点组成空间机械臂位姿可达空间。

【技术特征摘要】
1.一种单关节故障空间机械臂位姿可达空间求解方法，其特征在于，该方法包括以下步骤：(1)基于牛顿-拉夫逊法求解空间机械臂各关节人为限位，当机械臂任一关节故障锁定后，释放其他关节的人为限位至物理限位，通过蒙特卡洛法求解单关节故障后空间机械臂的退化工作空间；(2)依据末端处于不同姿态时机械臂可达空间不同这一特点，构建空间机械臂姿态可达度指标，求解空间机械臂末端处于不同姿态时的姿态可达度，选取最大姿态可达度对应的姿态作为空间机械臂面向任务的期望姿态；(3)依据所求退化工作空间中各散点位置坐标和期望姿态的组合，构建空间机械臂末端位姿集，基于解析法筛选位姿集中存在逆运动学解的位姿，由这些位姿所对应的散点组成空间机械臂位姿可达空间。2.根据权利要求1所述的方法，其特征在于，所述单关节故障空间机械臂的退化工作空间的求解至少包括：(1)基于工作空间体积权衡阈值ζ，建立空间机械臂退化工作空间与常态下工作空间之间的权衡依据(2)设空间机械臂各关节的初始人为限位为对应的物理限位依次判断各关节锁定在不同角度是空间机械臂退化工作空间是否满足步骤(1)中的权衡依据，完成空间机械臂各关节人为限位的初次求解；(3)在完成各关节人为限位的初次求解之后，基于牛顿-拉夫逊法迭代求解各关节人为限位，直至相邻两次所求各关节人为限位之差满足要求为止；(4)将常态下空间机械臂的各关节转动范围限制在所求人为限位内，当某关节故障锁定后，释放其余关节转动范围至对应物理限位，基于退化工作空间求解公式，完成体积不小于的空间机...

【专利技术属性】
技术研发人员：贾庆轩，王宣，陈钢，袁博楠，符颖卓，郭雯，
申请(专利权)人：北京邮电大学，
类型：发明
国别省市：北京,11