电力巡检机器人机械臂的运动规划虚拟系统.pdf

湖北电力Vol.47 No 1 Feb.2023DOI：10.19308/j.hep.2023.01.014第 47 卷第 1 期2023 年 2月电力巡检机器人机械臂的运动规划虚拟系统余凌，刘飘，罗金满，王湘女（广东电网有限责任公司东莞供电局，广东 东莞 523008）摘要 基于人机交互的虚拟机器人三维动态仿真及其计算是虚拟现实中的关键技术之一，是普适环境中的复杂任务计算重要内容。针对电力操作机器人作业环境的复杂性，以用户设计为中心，基于虚拟操作机械臂的三维模型，提出了机械臂操作的复杂任务中的运动轨迹规划及其运动仿真虚拟系统。构建了运动学方程的正解与反解两个方面对操作机械臂运动学模型，并利用Visual Studio编程工具以及Eon Studio仿真软件对以上研究结果进行仿真实验，为电力机器人机械臂运动控制提供参考依据关键词 虚拟仿真；三维动态；运动规划；机械臂；正解模型；反解模型中图分类号 TM76 文献标志码 A 文章编号 1006-3986（2023）01-0098-06Motion Planning Virtual System of Power Inspection Robot ArmYU Ling，LIU Piao，LUO Jinman，WANG Xiangnv（Dongguan Power Supply Bureau of Guangdong Power Grid Co.，Ltd.，Dongguan Guangdong 523008，China）Abstract The 3D dynamic simulation and calculation of virtual robot based on human-computer interaction is one of the key technologies in virtual reality，and an important content of complex task computation in ubiquitous environment.In view of the complexity of electric robot operating environment，this paper is based on the 3D model of virtual manipulator to propose a virtual system of motion trajectory planning and motion simulation in complex tasks of manipulator with the user-design centered，then constructs the kinematics model of the manipulator from two aspects of the positive solution and the reverse solution of the kinematic equation，and finally uses Visual Studio programming tools and Eon Studio simulation software to conduct simulation experiments on the above research results，providing reference for the motion control of power robot manipulator.Key words virtual simulation；three-dimensional dynamics；motion planning；positive solution model；inverse solution model0 引言带作业机械臂的电力机器人可以减轻人工劳动强度，解决现有巡检设备只有检测功能没有操作功能的问题，实现电力机器人代替人工来安全地完成作业，某种程度上解决了人工作业效率低和高风险等问题1-5。电力机器人作业时是依靠机械臂来完成任务的，机械臂的末端装有末端执行器来操作不同的任务。为了高效安全地实行机械臂自主执行任务，如带电导线捡拾、螺栓紧固等，需要对机械臂的关节空间进行实时的运动轨迹规划。如日本公司所研发的带电作业机器人Robot-Phase可实现半自动化作业，能自主识别目标位置并进行运动规划。目前大部分对机械臂的运动规划研究集中在运动规划方法上。栾庆磊提出一种改进型渐进最优快速随机扩展树（RRT*）算法用于路径规划，解决机械臂在运动路径规划上搜索随机性强、成功率低的问题6；陶志远针对断路器带电检修机器人的机械臂作了路径规划关键技术研究7；邾根豪提出了一种针对带电作业机器人基于时间最优的轨迹规划算法和控制策略研究8。韩波等对机械臂的运动学算法进行了建模和设计9-14。以上研究在不同方向上对机械臂的运动规划方法优化等做出了贡献，但较少涉及其规划算法后对机械臂的三维动态仿真内容。在实际的机械臂作业过程中，单凭操作人员的想像很难预测机械臂的运动规划后的轨迹，一旦规划出现问题，机械臂的运动状况将无法预测。基于此，以用户设计为中心，本文设计一个收稿日期 2023-02-01作者简介 余凌（1996），男，广东揭阳人，硕士，助理工程师，主要研究方向为计算机视觉、图像处理与人工智能等。基金项目 南方电网公司重点科技项目（项目编号：SZKJXM2020 0490）。98湖北电力Vol.47 No 1 Feb.2023第 47 卷第 1 期2023 年 2月基于四自由度电力巡检机器人机械臂的运动仿真系统来模拟机械臂的运动过程，实现机械臂的常规运动仿真和轨迹规划仿真。1 作业机械臂的建模电力巡检机器人的作业环境通常是非规则化的，当需要机械臂进行操作时，如需要快速将带电导线与被保护物分离时，操作导线的周边物品会不可避免地成为障碍物，给作业带来不便。为此，面向普适计算方法，对操作机械臂先进行运动建模研究。机械臂的运动学分析是运动规划的前提基础，可分为机械臂的正运动分析与逆运动分析两个方面15-16。本文采用四自由度的操作机械臂作为研究对象，只对主要运动部件进行建模型，分别为基座、旋转平台、大臂和小臂以及末端机构，四个自由度均为旋转型关节，如图1所示。1.1机械臂正运动分析机械臂正运动分析是指根据已知机械臂连杆参数与机械臂的运动坐标系，建立一数学模型。该模型是以机械臂各关节量()作为输入变量，以机械臂末端执行器坐标值为输出变量。然后利用该模型可根据已知的机械臂各关节量得出机械臂末端执行器在空间坐标系的坐标值。首先根据机械臂关节坐标系和广义连杆的 4 个 Denavit-Hartenberg（D-H）特征参数(d，k，a，)定义，绘制出机械臂处于初始状态时的运动学坐标系，具体如图2所示。(d，k，a，)4个参数含义分别是d为连杆偏距，k为连杆长度，a为连杆转角，为关节角；然后根据机器人矩阵学知识求出各机械臂连杆的相对变换矩阵i-1iT（其中i表示机械臂连杆的编号，i-1 即表示上一连杆的编号，i 1）；最后将各机械臂连杆的变换矩阵相乘得出末端执行器相对于基座标的变换矩阵05T。05T变换矩阵能够根据机械臂各连杆关节变量()的具体值，通过计算后得出末端执行器在基坐标系的位置和姿态。05T的得出如公式（1）所示。05T=01T 12T 23T 34T 45T=nxoxaxpxnyoyaypynzozazpz0001（1）式（1）中，用n，o，a，p分别表示矩阵中的元素。nx表示矩阵中第一行第一列的元素；ox表示矩阵第一行第二列的元素；ax表示矩阵第一行第三列的元素；px表示第一行第四列的元素；ny表示矩阵中第二行第一列的元素，其余类推；nz表示第三行第一列的元素，其余类推。1.2机械臂逆运动分析机械臂逆运动分析是正运动分析的逆过程，是指在已知各连杆几何参数的情况下，给定末端执行器在其坐标系中的期望坐标值，求出要使末端执行器运动到期望位置时每个关节所应该运动的数值量。利用变换方程式（1）求出各连杆关节变量()。机械臂逆运动分析的最终目标是求出各关节变量()的解析表达式，常用的方法有代数解法与几何解法。根据实际的操作机械臂结构与对计算量的考虑，本文采用几何解法与代数法相结合解法。先用代数解法求出底座旋转关节的表达式，然后绘制出机械臂各连杆（大臂旋转a1，中臂旋转a2，小臂旋转a3）的姿态位置图，如图3为机械臂运动到某一时刻时的姿态位置简图，最终得出其他各变量的解析表达式。图2机械臂运动学坐标系Fig.2Kinematic coordinate system of manipulator图1四自由度操作机械臂Fig.1Manipulator arm with four degrees of freedom图3机械臂连杆位置简图Fig.3Mechanical arm link position diagram 99湖北电力Vol.47 No 1 Feb.2023第 47 卷第 1 期2023 年 2月2 改进A*算法的机械臂避障路径规划由于C空间具有直观、易于实现以及在运用合适搜索方法的情况下可找到最优运动路径，且机械臂常用的路径规划方法为C空间法，因此本文采用基于C空间的路径规划方法17。根据C空间的特点建立机械臂的C空间并进行了C空间障碍的栅格化表示后，采用A搜索算法，搜索一条以起始位置点为起点，目标位置点为终点的无碰撞路径18-28。A搜索算法在搜索过程利用一个估价函数作为搜索指标，该函数表示为f(x)=g(x)+h(x)，其中f(x)表示从起始节点到节点x的一条最佳路径的实际代价加上从节点x到目标节点的一条最佳路径的代价之和；g(x)表示从起始节点到节点x之间最小代价路径的实际代价；h(x)表示从x节点到目标节点的最小代价路径上的代价。然而实际上f(x)是无法预先知道的，解决办法是用函数f(x)=g(x)+h(x)来近似代替以上估计函数，其中必须满足条件g(x)g(x)，h(x)h(x)。对于搜索算法在二维C-空间栅格平面上进行搜索时，每次搜索的方向有8个，如图4所示。由于机械臂的运动空间属于三维空间，使用搜索算法搜索时每次搜索的方向就变为26个，每次扩展的节点也变为26个，此时搜索算法每次扩展的节点一下子变成了二维平面的3倍之多，这样不仅会增加节点存储空间的使用，而且会严重影响搜索的速度。为了让A搜索算法能够适用于三维栅格C-空间，对A搜索算法的实现进行改进，具体为：对三维C空间上的任意一点，可以看成是三维空间的xy平面、yz平面以及xz平面这3个平面上的一点，因此，对于起始点与目标点不在同一个平面的情况，可先分别对起始点与目标点设定不同的从属平面，如起始点从属于R平面而目标点从属于r0平面，如图5所示。然后在这两个从属平面的相交处找出一个中间点，此时三维路径搜索问题可转换成两个二维平面的路径搜索问题的合成，这样便可利用A搜索算法分别在两个从属平面搜索出最优路径，然后再将这两条路径组合成最终的搜索路径。具体的操作步骤如图6所示。改进后的A搜索算法分别从两个平面上搜索出两条路径，然后组合起来得出最终三维C空间的运动路径，其相对于直接使用A搜索算法在三维空间中搜索，不仅节省了搜索过程节点的存储空间，而且还加快了搜索的速度。3 操作机械臂的运动规划仿真系统3.1机械臂运动仿真系统设计本次仿真采用Visual Studio为编程工具，使用Eon Studio作为仿真程序接口，实现了单一障碍物的操作机械臂避障运动仿真。为了便于研究，用经过简化处理的四自由度运动模型实体代表操作机械臂，以长圆柱体模型作为障碍物以及用小圆球代表运动目标点。为了配合路径规划，将机械臂简化为二自由度，只实现两连杆的运动，仿真的目标是让连杆2的端点运动到指定的目标点。首先，利用Visual Studio编写主体程序框架，在程序里实现运动反解程序，路径搜索程序以及轨迹规划程序；其次，把操作机械臂运动模型导入Eon Studio中进行虚拟仿真程序的设计；最后，Eon虚图4二维平面的8个搜索方向Fig.4Eight search directions in a two-dimensional plane图5改进的A搜索算法原理图Fig.5Improved A search algorithm schematic图6改进的A搜索算法流程图Fig.6Improved A search algorithm flow chart 100湖北电力Vol.47 No 1 Feb.2023第 47 卷第 1 期2023 年 2月拟仿真程序以Eon Studio控件形式嵌入到Visual Studio主程序框架中，利用Eon Studio控件提供的接口函数，Visual Studio可对仿真程序进行控制以及对仿真程序事件进行响应，仿真流程如图7所示。3.2机械臂运动仿真系统测试验证机械臂运动仿真系统的目的是在设定的具体条件下验证规划后的运动轨迹光滑平稳性。所设置的机械臂包括连杆1和连杆2，并设置抓取的对象为目标小球和设定障碍物。具体步骤为：1）设定仿真条件，设连杆1与连杆2长度同为500，两连杆关节初始值同为00。假设目标点在基座标系的位置为（600，0，300），障碍物的位置为（600，0，200）。2）运行运动学反解程序，路径搜索程序以及轨迹规划程序，得出两关节运动路径点和平滑后的运动曲线，如图8和图9所示。3）在Visual Studio主程序框架中根据设定的路径曲线进行运动仿真。为了让机械臂的运动更逼近两关节的运动曲线，在主框架程序中设定仿真运动每隔0.1 s更新一次关节的位置，如图10所示。图10（a）表示机械臂的初始状态，此时两连杆关节的值为00；图10（b）表示机械臂运动仿真过程的某一状态，由于运动位置点经过路径规划以及轨迹规划，因此连杆的运动不但可避开障碍物，而且还可实现平稳过渡；图10（c）表示机械臂运动到目标位置点。算例验证了所搭建的电力机器人机械臂运动的有效性。图7操作机械臂运动仿真流程图Fig.7Movement simulation flow chart of manipulator图8连杆1关节位移时间运动曲线Fig.8Joint displacement time motion curve of Connecting Rod 1图9连杆2关节位移时间运动曲线图Fig.9Joint displacement time motion curve of Connecting Rod 2图10机械臂避障运动仿真Fig.10Simulation of obstacle avoidance motion of mechanical arm 101湖北电力Vol.47 No 1 Feb.2023第 47 卷第 1 期2023 年 2月4 结语应用虚拟现实技术、普适任务计算的思想，把机器人机械臂的任务分解，从操作目标、运动规划和计划计算出发，构建了机器人运动规划数学模型，在虚拟环境下进行了三维运动仿真。利用Visual Studio编程工具以及Eon Studio仿真软件对以上研究结果进行仿真实验，为实际操作机械臂运动控制提供参考依据，也为虚拟人体运动和机器人运动提供了一种计算方法。参考文献（References）1 张海华，陈昊，许驰，等.变电站立体智能巡检新技术研究与应用 J.湖北电力，2021，45（01）：41-46.ZHANG Haihua，CHEN Hao，XU Chi，et al.Research and application of new technology of three-dimensional intelligent inspection for substationsJ.Hubei Electric Power，2021，45（01）：41-46.2 汪洋，刘帆，汪涛，等.变电站智能运检关键技术及应用 J.湖北电力，2017，41（11）：1-4，31.WANG Yang，LIU Fan，WANG Tao，et al.Research on key technology of smart operation maintenance and overhaul of substation and its application J.Hubei Electric Power，2017，41（11）：1-4，31.3 尹宏杰，谢逸逍，贾烨，等.变电站自动化维护巡检机器人设计 J.自动化技术与应用，2022，41（03）：101-105.YIN Hongjie，XIE Yixiao，JIA Ye，et al.Design of automatic maintenance and inspection robot for substation J.Techniques of Automation and Applications，2022，41（03）：101-105.4 杨俊，黄礼华，张立平.变电站巡检机器人关键技术及其适用性研究 J.湖北电力，2017，41（01）：20-24.YANG Jun，HUANG Lihua，ZHANG Liping.Researches on the key technologies of substation inspection robots and applicability J.Hubei Electric Power，2017，41（01）：20-24.5 张晖，张胜，何云峰，等.火力发电企业智慧电厂建设探索与实践 J.湖北电力，2022，46（02）：104-113.ZHANG Hui，ZHANG Sheng，HE Yunfeng，et al.Exploration and practice of smart power plant construction in thermal power enterprises J.Hubei Electric Power，2022，46（02）：104-113.6 付金奇，韩军杰，戴浩林，等.220 kV变电站绝缘子带电干冰清洗机器人设计研究 J.湖北电力，2017，41（02）：13-19，43.FU Jinqi，HAN Junjie，DAI Haolin，et al.Design&research of live-working dry-ice blast cleaning robot for 220 kV substations insulatorJ.Hubei Electric Power，2017，41（02）：13-19，43.7 叶思琪，刘飘，罗金满，等.一种具有图像功能的电力巡检自站立移动机器人 J.湖北电力，2022，46（02）：120-126.YE Siqi，LIU Piao，LUO Jinman，et al.A self-standing mobile robot with image function for power inspectionJ.Hubei Electric Power，2022，46（02）：120-126.8 陶志远.带电作业机器人及其路径规划研究 D.上海：上海交通大学，2018.TAO Zhiyuan.Research on hot-line working robot and its path planning D.Shanghai：Shanghai Jiao Tong University，2018.9 邾根豪.带电作业机器人的轨迹规划和自适应控制研究 D.天津：天津大学，2020.ZHU Genhao.Research on trajectory planning and adaptive control of live working robot D.Tianjin：Tianjin University，2020.10 张宏达.带电作业机器人的机械臂设计 J.微型电脑应用，2018，34（11）：70-72.ZHANG Hongda.Design of robot arms for live working robot J.Microcomputer Applications，2018，34（11）：70-72.11 杨希磊，王哲斐.基于粒子群算法的变电站巡检机器人运行功率分配 J.湖北电力，2021，45（01）：35-40.YANG Xilei，WANG Zhefei.Power distribution of substation inspection robot based on particle swarm optimizationJ.Hubei Electric Power，2021，45（01）：35-40.12 张振乾，李世超，李晨阳，等.基于双目视觉的香蕉园巡检机器人导航路径提取方法 J.农业工程学报，2021，37（21）：9-15.ZHANG Zhenqian，LI Shichao，LI Chenyang，et al.Navigation path detection method for a banana orchard inspection robot based on binocular visionJ.Transactions of the Chinese Society of Agricultural Engineering，2021，37（21）：9-15.13 俞佳乐，穆海伦.一种电力巡检机器人机械臂双重避障方法 J.制造业自动化，2022，44（05）：191-195.YU Jiale，MU Hailun.A double obstacle avoidance method for mechanical arm of electric inspection robot J.Manufacturing Automation，2022，44（05）：191-195.14 江维，吴功平，王伟，等.带电作业机器人机械臂动力学建模与运动规划 J.工程科学学报，2016，38（06）：867-875.JIANG Wei，WU Gongping，WANG Wei，et al.Manipulator dynamic modeling and motion planning for live working robotJ.Chinese Journal of Engineering，2016，38（06）：867-875.15 韩波.地电位带电作业机器人灵巧臂机构设计及控制系统研究 D.芜湖：安徽工程大学，2022.HAN Bo.Research on the design and control systrm of the dexterous arm mechanism of the ground pothntial live operation robotD.Wuhu：Anhui Polytechnic University，2022.16 芮宏斌，曹伟，孙宁宁.基于BP神经网络的光伏阵列清洁机械臂逆运动学分析与时间最短运动规划 J.太阳能学报，2022，43（10）：43-51.102湖北电力Vol.47 No 1 Feb.2023第 47 卷第 1 期2023 年 2月RUI Hongbin，CAO Wei，SUN Ningning.Inverse kinematics analysis and time optimal motion planning of photovoltaic array cleaning manipulator based on BP neural network J.Acta Energiae Solaris Sinica，2022，43（10）：43-51.17 李起栋.面向空间维修作业的机械臂运动规划 D.南京：南京航空航天大学，2021.LI Qidong.Manipulator motion planning for space maintenance D.Nanjing：Nanjing University of Aeronautics and Astronautics，2021.18 屈力刚，高凯，邢宇飞，等.基于ROS的机械臂运动规划研究 J.机床与液压，2022，50（22）：43-47.QU Ligang，GAO Kai，XING Yufei，et al.Research on maniulator motion planning based on ROS J.Machine Tool&Hydraulics，2022，50（22）：43-47.19 石初，杨开九，吉小亮，等.配电室巡检机器人室内挂轨式巡检机器人解决方案 J.无线互联科技，2021，18（20）：106-107.SHI Chu，YANG KaiJiu，JI Xiaoliang，et al.Power distribution room inspection robot indoor rail inspection robot solution J.Wireless Internet Technology，2021，18（20）：106-107.20 孟继君.基于轴不变量的偏置型6R机械臂建模与运动规划研究 D.南京：南京航空航天大学，2019.MENG Jijun.Research on modeling and motion planning of offset 6R manipulators based on axis-invariant D.Nanjing：Nanjing University of Aeronautics and Astronautics，2019.21 刘哲，潘爱强，魏本刚，等.基于指导轨迹加速的机械臂强化学习运动规划 J.电气自动化，2022，44（05）：102-103，107.Liu Zhe，Pan Aiqiang，Wei Bengang，et al.Motion planning of manipulators reinforcement learning based on guided trajectory acceleration J.Electrical Automation，2022，44（05）：102-103，107.22 陈进，张志巧，廖彩淇，等.基于深度强化学习的气振盘式播种机械臂运动规划方法研究 J.中国农机化学报，2022，43（10）：149-156.Chen Jin，Zhang Zhiqiao，Liao Caiqi，et al.Research on motion planning method of vacuum-vibration seeding manipulator based on deep reinforcement learning J.Journal of Chinese Agricultural Mechanization，2022，43（10）：149-156.23 崔坤腾，谭跃刚，闵双飞，等.基于ROS的六轴机械臂3D打印运动规划方法 J.机床与液压，2022，50（15）：1-7.CUI Kunteng，TAN Yuegang，MIN Shuangfei，et al.3D printing motion planning method of six-axis manipulator based on ROS platform J.Machine Tool&Hydraulics，2022，50（15）：1-7.24 张振，李新宇，董昊臻，等.基于约束采样RRT的机械臂运动规划 J.计算机集成制造系统，2022，28（06）：1616-1626.ZHANG Zhen，LI Xinyu，DONG Haozhen，et al.Constrained sampling method based RRT algorithm for manipulator motion planning J.Computer Integrated Manufacturing Systems，2022，28（06）：1616-1626.25 郑浩，高峰.一种新型串联机械臂工作空间与运动规划分析 J.机械设计，2022，39（03）：1-9.ZHENG Hao，GAO Feng.Analysis on workspace and motion planning of a novel serial manipulator J.Journal of Machine Design，2022，39（03）：1-9.26 温景阳，杜宇凡，秦涛，等.基于Dobot机械臂的包装自动线运动规划与仿真 J.包装工程，2021，42（21）：231-238.WEN Jingyang，DU Yufan，QIN Tao，et al.Motion planning and simulation of automatic packaging line based on dobot manipulator J.Packaging Engineering，2021，42（21）：231-238.27 王智杰，杜宇凡，杨沫，等.基于MATLAB Robotics Toolbox的Dobot机械臂运动规划 J.机械研究与应用，2021，34（02）：49-51.WANG Zhijie，DU Yufan，YANG Mo，et al.Motion planning of dobot manipulator based on MATLAB robotics toolboxJ.Mechanical Research&Application，2021，34（02）：49-51.28 王清清，奚琳.基于SSD的码垛机械臂关节速度纠偏运动规划 J.计算机仿真，2021，38（07）：340-344.WANG Qingqing，XI Lin.Motion planning of palletizing manipulator joint velocity deviation correction based on SSD J.Computer Simulation，2021，38（07）：340-344.103