1、李星辰，杨国庆，王宪,等.6 轴工业机器人工作空间快速求解J.机械科学与技术，2023，42（8）：1213-12206 轴工业机器人工作空间快速求解李星辰，杨国庆，王宪，胡文洪（湖南科技大学机电工程学院，湖南湘潭411100）摘要：由于机器人设计过程中需要反复计算机器人工作空间，提升工作空间的计算效率与精度具有重要意义。本文针对传统方法求解工作空间精度不高、速度慢的问题，提出了改进方法。用传统方法生成种子空间并离散为多个子空间，利用正态分布拓展工作空间点数量不足的子空间，并根据拓展后工作空间点的位置调整正态分布参数，得到可达工作空间。进一步，利用可操作度值评估机器人的灵活性，从可达工作空间筛
2、选出灵活种子空间，利用可调参数的正态分布拓展灵活种子空间边界，得到灵活工作空间。以 6 轴机器人为对象，对本文方法进行仿真分析。结果表明，本文方法在保证求解精度的前提下可极大的提升求解效率，为后续的机器人优化设计提供了便利。关键词：6 轴机器人；工作空间；蒙特卡洛法；可操作度中图分类号：TP24文献标志码：ADOI：10.13433/ki.1003-8728.20220067文章编号：1003-8728（2023）08-1213-08Fast Solution of 6-axis Industrial Robot WorkspaceLIXingchen，YANGGuoqing，WANGXian
3、，HUWenhong(SchoolofMechanicalEngineering,HunanUniversityofScienceandTechnology,Xiangtan411100,Hunan,China)Abstract：Intheprocessofrobotdesign,therobotworkspaceneedstobecalculatedrepeatedly,soitisofgreatsignificancetoimprovethecomputationalefficiencyandaccuracyoftheworkspace.Animprovedmethodtosolvethe
4、problemsoflowprecisionandslowspeedofthetraditionalmethodisproposed.Theseedspaceisgeneratedbythetraditionalmethodanddiscretizedintomultiplesubspaces,thenormaldistributionisusedtoexpandthesubspacewithinsufficientnumberofworkspacepoints,andthenormaldistributionparametersareadjustedaccordingtothepositio
5、nsoftheexpandedworkspacepointstoobtainthereachableworkspace.Then,theoperabilityvaluetoevaluatetheflexibilityoftherobotisused,theflexibleseedspacefromthereachableworkspaceisfilteredout,andthenormaldistributionofadjustableparameterstoexpandtheboundaryoftheflexibleseedspacetoobtainaflexibleworkspaceisu
6、sed.Bytakingthe6-axisrobotasanexampletosimulateandanalyzetheimprovedmethod,theresultsshowthatthepresentmethodcangreatlyimprovethesolvingefficiencyonthepremiseofensuringthesolvingaccuracy,andprovideconvenienceforthesubsequentoptimizationdesignoftherobot.Keywords：6-axisrobot；workspace；monte-carlometho
7、d；manipulability机器人工作空间是评价机器人工作性能的一项重要指标1。工作空间分为可达工作空间和灵巧工作空间。可达工作空间是指机器人末端执行器参考点所能到达的位置的集合，灵巧工作空间是指机器人末端执行器能以任意姿态到达的位置的集合2。实际上，由于机器人的几何属性和关节运功范围的限制，机器人的灵巧工作空间是不存在的3。在工程实际中，通常采用灵活工作空间代替灵巧工作空间4。机器人工作空间是机器人设计与优化的重要依据。王晓华等以六轴缝纫机器人为对象，通过对机器人末端的可达工作空间分析确定了缝纫机器人在工作时各关节的最佳运动范围5。荆学东等以六轴双臂服务机器人为对象，求解了双臂各自的可达
8、工作空间，以协作空间最大为优化目标，对机器人的结构参数进行了优化6。赵智远等研制了 9 自由度超冗余串联机械臂，以可达工作空间与灵活工作空间为优化目标，对机械臂的构型进行了优化设计7。贾世元等以六轴机械臂为对象，以全局灵活性为优化目标，对机械臂尺寸参数进行了优化设计8。目前，求解机器人工作空间的方法主要有 3 类：几何法、解析法和数值法9。几何法可以得到机器人的解剖面或解剖线，但受到自由度数的限制，无法精确描述多自由度机器人的工作空间，主要用于平收稿日期：2021-08-03基金项目：国 家 重 点 研 发 计 划“智 能 机 器 人”重 点 专 项（2018YFB1308200）作者简介：李
9、星辰（1997），硕士研究生，研究方向为机器人优化设计，通信作者：王宪，副教授，博士生导师，2023 年8 月机械科学与技术August2023第 42 卷第 8 期MechanicalScienceandTechnologyforAerospaceEngineeringVol.42No.8http:/ 个的机器人11。数值法是将多个关节角组合代入到正向动力学方程，求解出机器人末端在任务空间的坐标，最终得到工作空间的方法，求解简单，适用于任意结构的机器人工作空间的求解12。在数值方法中，求解机器人工作空间最为常见的方法就是蒙特卡洛方法。传统蒙特卡洛法的主要问题是工作空间点分布不均匀，大部分工作
10、空间点产生在工作空间内部，导致工作空间边界求取精度不高，当提高工作空间点数量以提升工作空间边界求取精度时，大量工作空间点任然出现在工作空间内部，造成了计算资源的浪费，导致求解速度较慢。针对上述问题，徐振邦等利用蒙特卡洛法生成了一个种子工作空间，对于每个工作空间点数量较少的位置，在其内部选取一个参考点，在生成该点的关节角附近多次随机抽样并代入正向运动学方程，一次性得到多个工作空间点。这种方法使工作空间点云密度分布更加均匀，提高了工作空间边界处的精确度，但该方法的求解效率与分块数有关，需要根据具体的结构进行调整，并且拓展得到的工作空间点过于集中13。刘志忠等先利用蒙特卡洛法生成了一个种子空间，对种
11、子空间分层，寻找每层的边界点，在边界点附近生成多个随机点，多次迭代，直到形成精确的边界。这种方法提高了工作空间边界处的精度，但求解精度依赖于分层数量，分层过少时精度不高，分层过多时消耗时间长1。本文依托的国家重点研发计划“面向铸造行业的机器人智能化生产线研制及在航天装备与发动机关键部件制造上的示范应用”的一个研究任务是“设计多台面向铸造行业的机器人”，在初步确定机器人设计参数以后，需要对设计参数进行优化设计，优化设计过程中需要反复计算工作空间，因此有必要对机器人的工作空间求解方法进行改进。本文针对传统蒙特卡洛法求解精度低、求解速度慢的缺陷，提出了改进方法。利用传统蒙特卡洛法生成种子空间，拓展随
12、机点数量较少的子空间，动态调整正态分布概率密度函数的参数，得到了可达工作空间。接着，利用可操作度评估了机器人的灵活性，从可达工作空间筛选出灵活种子空间，多次拓展灵活种子空间边界，并且正态分布标准差动态可调，得到了灵活工作空间。1 研究对象及运动学模型0.2本文研究对象为湖南科技大学与长沙长泰机器人有限公司正在联合研制的 6 轴重载工业机器人，该机器人的 6 个关节均为转动关节，本体自重1110kg，负载能力 210kg，最大臂展 2674mm，重复定位精度mm，具体结构如图 1 所示。图16 轴机器人结构示意图Fig.16-axisrobotstructurediagramXZYaidiii机
13、器人运动学模型是求解机器人工作空间的基础，本文建立机器人连杆坐标系如图 2 所示，其中部分关节只表示了转轴的 轴和 轴，对应的 轴可根据右手定则求得。改进的 D-H 参数表如表 1 所示，关节运动范围如表 2 所示，其中，代表连杆长度，代表连杆偏移量，代表关节角，代表扭转角。A3A1A2A5A4A6a4a3d1a2d4d6x5x4x6x3x2x0 x1z4z6z0z2z1y1y0y6z3z5图26 轴机器人坐标系Fig.26axisrobotcoordinatesystem表 1 6 轴机器人 D-H 参数表Tab.16-axisrobotD-Hparametertableidi/mmai/m
14、mi/()i/()170000120305902301110034126020090450090562450906表 2 6 轴机器人关节运动范围Tab.2Rangeofmotionof6-axisrobotjoini123456qmax/()+185+140+168+350+125+350qmin/()185+5120350125350i1i相邻关节坐标系和 之间的齐次变换矩阵为i1iT=cisi0i1sici1cici1si1disi1sisi1cisi1ci1dici10001（1）s=sin c=cos式中：；。机械臂末端执行器的正向运动学方程为1214机械科学与技术第42卷http:
15、/ 可达工作空间分析 2.1传统蒙特卡洛法蒙特卡洛法是一种基于概率统计理论，用于模拟随机现象的数值方法。在求解机器人工作空间时，在各个关节角取值范围内随机抽取大量的关节角变量值进行组合，将这些关节角值组合带入正向运动学方程，计算出机器人末端执行器参考点的坐标值，这些参考点所包络的空间就是机器人工作空间。传统蒙特卡洛法存在的问题如下：求解机器人工作空间时，工作空间边界的具体位置由工作空间边界的参考点给出，工作空间内部的点意义不大。然而，虽然传统蒙特卡洛法随机抽取的关节角值服从均匀分布，但关节空间到工作空间的映射是非线性的，大量工作空间点出现在工作空间内部，导致工作空间的精度不高。当增加随机抽取的
16、关节角值组合的数量时，大部分参考点任然出现在非工作空间边界部分，虽然工作空间的精度变高，但大量的工作空间点没有意义，造成了计算资源的浪费。2.2方法的改进根据上述分析，传统蒙特卡洛法的主要问题是工作空间点分布不均匀，大部分工作空间点产生在工作空间内部，导致工作空间边界求取精度不高的同时求解速度慢。针对上述问题，本文提出一种改进的蒙特卡洛法，该方法由 3 个部分组成。1）生成种子空间。利用传统蒙特卡洛法生成大量的工作空间点，用长方体包络所用种子空间点，划分成数个相等的子空间。2）拓展种子空间。筛选出需要拓展的子空间，利用正态分布抽样对这些子空间拓展，同时设置一个精度阈值确保拓展后的工作空间足够准确。为了保证拓展产生的点出现在边界附近，正态分布概率密度函数的方差会根据拓展后的点的位置进行调整。3）输出可达工作空间。多次重复拓展过程，直到每个子空间得到精确描述，输出可达工作空间。本文提出的改进蒙特卡洛法的具体步骤如下。2.2.1生成种子空间P(x，y，z)XmaxYmaxZmaxXminYminZmin用传统蒙特卡洛法对每一关节生成 N 个随机角度值，按序号组成对应关节角值组合。将关节角值
