《破拆机器人机械臂自主运动控制系统软件设计.docx》由会员分享，可在线阅读，更多相关《破拆机器人机械臂自主运动控制系统软件设计.docx（9页珍藏版）》请在taowenge.com淘文阁网|工程机械CAD图纸|机械工程制图|CAD装配图下载|SolidWorks_CaTia_CAD_UG_PROE_设计图分享下载上搜索。
1、破拆机器人机械臂自主运动控制系统软件设计破拆机器人机械臂自主运动控制系统软件设计何锋，章小建，赵江海导语：针对现有破拆机器人手工定位时间长、定位不准确的问题，研发了一个基于激光定位的破拆机器人机械臂自主运动的控制系统软件。设计了运动学模块、闭环反应调节模块、液压装置控制模块、手眼标定模块和运动控制模块。实际使用效果说明，该软件系统能完成控制系统设计指标，进步工作效率。常州先进制造技术研究所机器人系统实验室，江苏常州213164;2.中国科学院合肥物质科学研究院先进制造技术研究所机器人系统实验室，江苏常州213164摘要：针对现有破拆机器人手工定位时间长、定位不准确的问题，研发了一个基于激光定位
2、的破拆机器人机械臂自主运动的控制系统软件。设计了运动学模块、闭环反应调节模块、液压装置控制模块、手眼标定模块和运动控制模块。实际使用效果说明，该软件系统能完成控制系统设计指标，进步工作效率。关键词：破拆机器人；运动学；自主运动中图分类号：TP273文献标识码：ADOI：10.19358/j.issn.1674-7720.2017.09.030引用格式：何锋，章小建，赵江海.破拆机器人机械臂自主运动控制系统软件设计J.微型机与应用，2017,369：103-105.引言目前，施工现场作业的破拆机器人采用手动方式进展作业1。由于破拆机器人机械臂运动经过产生的惯性力大，操作人员手工操控需要反复调整才
3、能运动到大致位置，因此，研发一种破拆机器人机械臂自主运动控制系统，设计该控制系统的上位软件，来实现机械臂目的导引的自主运动控制2功能是特别有必要的。本文设计了控制系统软件的各个模块，给出了各模块的设计方法，最后，通过实验证明了控制系统软件能完成破拆机器人机械臂目的导引3的自主控制功能。1破拆机器人总体硬件架构本文实验平台在惊天液压股份公司的GTRC15型破拆机器人根底上开展功能部件研究，机器人整机实物图见图1。由图1可看出，机器人由机械臂、挪动回转平台、行走履带和作业支架组成。机械臂主要由大臂、二臂、三臂和末端执行器构成。回转平台由回转马达驱动且安装有角度编码器以获得当前回转平台偏置角度，机械
4、臂的各个关节由液压缸驱动，安装了角度编码器传感器，可检测当前关节角的角度值。行走履带使用液压马达驱动，可以驱使机器人进展前进、后退、旋转等动作。机器人的通信使用CAN总线形式4。控制系统主要包括机械臂各关节的电液比例控制系统、无线视频收集与传输系统、激光定位平台控制系统及机器人主控PC。电液比例控制系统主要是通过控制比例阀阀口开度大小来控制液压缸体内液体的流速，而流速与液压缸体的运动速度及关节角的即时速度成近似线性关系。无线视频收集与传输系统是用于操作员远离作业现场环境下，通过远程无线视频来观察定位作业点，进而自动驱动激光定位平台找到作业目的点，使液压机械臂自动运动到指定目的位置。2破拆机器人
5、软件设计破拆机器人的控制系统软件选用的平台是WindowsXP系统，程序运行框架是用VC6的MFC类库开发。在控制系统中设计了运动学计算模块、闭环反应调节模块、液压装置控制模块、运动控制模块、手眼标定模块、无线视频收集与处理模块等。控制系统软件界面如图2。破拆机器人激光定位下机械臂自主运动整体控制系统工作原理为：操作员通过远程视频监控系统观察作业现场，并根据现场环境确定所要破碎的目的点，然后操作激光定位云台进展俯仰和旋转运动，直至激光点落在定位的目的点位置上。此时控制系统根据激光定位平台在两个方向上旋转的角度和激光测距仪当前的读数，运用前面给出的激光云台坐标系求解公式很容易计算出作业目的点在激
6、光定位平台坐标系下的空间坐标，该坐标通过刚性转置可转换为机械臂坐标系下的作业目的的空间坐标值。通过运动学逆解5或者在线轨迹规划方法6将空间运动量转为关节运动输出量，进而驱动液压执行元件使机械臂实现多轴联动动作，快速准确到达指定破拆目的。自主破拆的算法步骤为：1根据标定装置测出的作业目的间隔，经过旋转及偏置后得到视觉云台坐标系下三维坐标。激光测距传感器安装在云台坐标系下的Y轴原点，且激光器发射方向与Y轴正向一致，假设当前激光测距传感器读数是dm，那么作业目的在第五坐标系下的坐标表示为0,d,0。(2)通过基坐标系与末端执行器坐标系之间的齐次转换矩阵计算获取激光测距系统下的目的物体坐标。(3)通过
7、运动学逆解将第一坐标系下目的点坐标及设定的末端执行器位姿转换为液压机械臂五个关节角的角度值。(4)通过关节角与液压缸长度的映射关系得到液压缸运动的目的长度。(5)使用PID算法控制液压元件的速度信号，使其快速准确地到达目的点，完成破拆定位。3运动学模块设计运动学模块主要包括关节角求解局部、正运动学求解局部和逆运动学求解局部7。其中关节角求解局部主要完成液压缸的变化量与关节角变化量的线性映射关系的建立。正运动学求解局部完成各关节角的当前值与末端破碎锤的空间坐标和姿态的对应关系建立。逆运动学求解局部完成在指定目的位置和指定末端破碎锤姿态的情况下求出知足能量最优条件下8的各关节角的目的值。通过运动学
8、模块设计，可以在线获得当前机械臂的姿态和末端执行器的位置，也能根据指定目的点和末端破碎锤姿态求得各关节角的目的值9，并将目的值转化为液压缸运动的长度。4闭环反应调节模块设计闭环反应调节模块主要是用于对各液压缸的位置运动误差进展调节。使用PID控制方法进展闭环调节，PID控制参数通过经历法进展设计，获取适宜的各液压缸的PID控制参数。通过PID闭环反应调节后，每个液压缸关节的位置运动误差在0.01mm以内。PID控制模型图见图3。5液压装置控制模块设计液压装置控制模块通过CAN总线与各关节的电液比例控制系统进展通信，控制各个液压缸的阀门开度、运动方向和运动速度。通过液压装置控制模块设计，可以控制
9、机械臂各关节的运动。6手眼标定模块设计控制系统软件使用激光定位平台获取视觉的坐标系点，为将视觉坐标系和机械臂坐标系进展整合，需要进展手眼标定模块设计，手眼标定模块使用最小二乘算法来计算两坐标系之间的齐次变换矩阵。通过齐次变换矩阵可以将视觉坐标系的目的坐标和目的姿态转化为机械臂坐标系下的坐标，进一步通过运动学模块求出各液压缸的变化量，通过液压装置控制模块和闭环反应调节模块运动到指定的目的位置10。7运动控制模块设计运动控制模块主要完成机械臂的多轴运动控制，在软件中使用了三次样条曲线插值的方法，将逆解求出的各关节角目的值、各关节编码器反应的各关节角当前值和约定的整体运动时间作为插值输入参量代入，求
10、得每个定时器周期下各关节角的位置、速度和加速度值。利用液压缸的运动特性，进展机械臂多轴运动控制。8结论使用本文设计的控制系统软件，通过激光定位装置获取6组目的点，取末端破碎锤与地面垂直的姿态为最终姿态，通过实验数据表1可发现定位误差在5cm内，定位时间为10s，且可调。通过实验可证明该控制系统软件知足了破拆机器人机械臂运动自动化的目的。参考文献1刘庆运.破拆救援机器人关键技术J.当代制造工程,2020,30(7):149-153.2杨政,尚建忠，王彪，等.液压驱动机械臂的轨迹规划J.机械研究与应用,2020,25(4):47-51.3周孟然,吴永祥.基于红外激光定位技术的矿井提升机位置跟踪系统
11、的研究J.煤炭学报,2002,27(6):658-660.4胡敏,梁聪明，郑庆华，等.多关节液压臂架实时控制软件的设计与实现J.中国工程机械学报,2021,11(3):243-247.5蔡自兴.机器人学M.北京：清华大学出版社,2000.6CRAIGJ.Introductiontorobotics:mechanicsandcontrolthirdeditionM.PearsonEducation,Inc.,2005.7陆震.冗余自由度机器人原理及应用M.北京：机械工业出版社,2006.8XIANGJ,ZHONGC,WEIW.Avariedweightsmethodforthekinematic
12、controlofredundantmanipulatorswithmultipleconstraintsJ.IEEETransactionsonRobotics,2021,28(2):330-340.9CARRILERWF,KHOSLAPK，KROGHBH.PathplanningformobilemanipulatorsformultipletaskexceutionJ.IEEETransactionsonRoboticsandAutomation,1991,7(3):403-408.10FINZELR,HELDUSERS,JANGDS.ElectrohydrauliccontrolsystemsformobilemachinerywithlowenergyconsumptionC.ProceeingsoftheSeventhInternationalConferenceonFluidPowerTransmissionandControl,2020:214-219.