基于蒙特卡洛法的水力破拆机械臂工作空间分析*

0 引言

机械臂工作空间是指机械臂末端执行器上坐标系在参考坐标系中所到达的空间点的集合[1]，其大小不仅表示末端执行器的活动范围，更是体现机械臂工作能力的主要参数[2]。针对工作空间的求解问题，主要是图解法、解析法和数值法三种，解析法表达式较复杂，不适于工程实际应用；图解法虽直观易于工程应用，但求出的工作空间为剖截面或剖截线，且解析法、图解法对关节较多的机械臂工作空间求解时过于复杂；数值法是将极值理论、优化方法作为基础，可分析任意形式的机械臂，且随着计算机软硬件发展，越来越多的被用来求解分析工作空间[3]。

本文采用一种基于随机概率分布的数值分析法——蒙特卡洛法，结合MATLAB仿真软件对混凝土水力破拆机械臂的工作空间进行求解、分析。

1 机械臂结构及参数方程

混凝土水力破拆机械臂结构如图1，主要由主回转关节θ1、伸缩关节d2、横向回转关节θ3、俯仰关节θ4和横向移动关节d5五个自由度构成，主回转关节安装在机器设备机座上，机械臂末端安装高压喷枪，工作时喷枪摆动幅度较小，在求解工作空间时可将喷枪视为竖直。

相容性是指润滑剂与其他各种材料(如橡胶、塑料、金属等)接触时起相互作用的程度，是评判润滑剂与橡胶密封材料相互配合以达到有效的润滑与密封的重要指标之一。当两者相容性较差时，密封材料会在工作过程中发生溶胀或收缩等现象，使之体积、强度、硬度以及延伸率的变化，造成系统的泄漏、空气混入以及密封材料的加速老化与失效。

  

图1 机械臂结构简图

参照D-H法则在机械臂各连杆末端上建立坐标系[4]，如图2所示，以o0x0y0z0作参考坐标系，在喷枪顶点建立坐标系o6x6y6z6，与o5x5y5z5相比其位置向x5轴负方向偏移230 mm，dx=-230 mm，y5轴正方向偏移490 mm，dy=490 mm。机械臂各连杆D-H参数如表1所示。

  

图2 机械臂D-H坐标系

 

表1 机械臂连杆D-H参数

  

关节i αi-1ai-1θi 1 2 3 4 5 0 θ1 dimm 108-90°90°-90°0 0 0 0 0 0°θ3 d2 θ4 104 0 13590°d5变量范围0°～360°0～300 mm 0°～360°-10°～90°0～1 099 mm

表1中各关节D-H参数代入式（1），即知相邻连杆间齐次变换坐标矩阵 0T1、1T2、2T3、3T4、4T5、5T6 。

由图3、4知，各关节的角度或位移随时间变化的曲线平滑且无异常点，机械臂各连杆未有位置错位现象，验证了机械臂D-H参数及方程的正确。

 

3）将2中产生的随机值代入式（3），解得的数值(px,py,pz)即为喷枪顶点的一个工作位置；

将 0T1、1T2、2T3、3T4、4T5、5T6 依次相乘，可得喷枪顶点坐标系o6x6y6z6在参考坐标系o0x0y0z0中的位姿0T6[5]，如式（2）所示。

 

式（2）中，[nxnynz]T、[oxoyoz]T、[axayaz]T、[pxpypz]T依次为喷枪顶点坐标系o6x6y6z6中的x6、y6、z6、坐标原点o6在参考坐标系o0x0y0z0中的向量表达式。

按矩阵相等原则[6]，则机械臂末端喷枪的顶点在参考坐标系o0x0y0z0中的位姿如式（3）所示。

 

其中： c13=cos(θ1+θ3)，其余类推。

4.消费者权益得不到有效保护。网络模式下的餐饮业法律规定不完善，很难确保消费者在网络交易过程中的权益得到有效保护。另外，由于消费者与网络餐饮业对食品质量的评判标准不同，因此在调查取证的过程中容易出现分歧，无法较好地保护消费者的合法权益[1]。

今年3月22日是第二十届“世界水日”，第二十五届“中国水周”也在这一天拉开帷幕。联合国确定“世界水日”的宣传主题是“水与粮食安全”，我国纪念“世界水日”和开展“中国水周”活动的宣传主题是“大力加强农田水利，保障国家粮食安全”。

2 机械臂运动参数验证

以Robotics Toolbox为工具仿真机械臂从初始位姿至水平破拆位姿的动作，即喷枪顶点从初始位置a=[π/2 0-π/2-π/2 0] ， 至 终 止 位 置 点a=[π/4 200-π/4-π/2 300]，仿真时间 1 s ，采样时间0.005 s，机械臂最后位姿如图3，仿真完成后输出各关节角度或位移变化曲线如图4。

2018-2035年，全球原油产量占比将逐年下降，天然气产量将稳步增长。2018-2024年原油产量增长较明显，2024年产量较2018年增长6.8亿吨，增长率为13.1%；2025年后原油产量趋于平稳，2035年原油产量降到52.8亿吨。天然气产量一直保持较高的增长率，2024年较2018年增长16%，2035年较2024年增长14%，达到42.1亿吨油当量。

  

图3 机械臂最终位姿

 

 

 

 

  

图4 关节1～5的角度或位移-时间曲线

3 工作空间

3.1 工作空间描述

结合图1、2及表1，在各关节运动范围内给定任意一组数据，参照式（3）即可求出喷枪顶点坐标系o6x6y6z6原点在参考坐标系o0x0y0z0中的一个位置，在取尽各关节变量qi(qimin≤qi≤qimax)范围内所有值后，则所能求出的喷枪顶点坐标系原点在参考坐标系中全部点构成了机械臂末端喷枪的工作的集合W(P)，即是其工作空间[7]。

 

其中：W(P)代表的集合即为喷枪工作空间，p(q)∶Q⊂R3为机械臂位置分量，q为关节的变量，Q为关节的取值区间。

按式（3），P=[px,py,pz]T是喷枪顶点相对参考坐标系的位置向量，则W(P)表达式如（5）所示：

 

3.2 运动空间仿真

结合图1及图5、6、7、8可知：机械臂末端喷枪顶点横向最大移动范围是0～2 630 mm，纵向最大移动范围是0～1 890 mm（纵向最大移动距离=800 mm+基座高565 mm+机器设备高425 mm），喷枪的纵向最大作业深度是630 mm（最大作业深度=1 720 mm-基座高565 mm-机器设备高425 mm）。

1）将表1中各关节qi的D-H参数予以赋值；

寡妇们和亡家的独身汉在李青山喊过口号之后，完全用膝头曲倒在天光之下。羊的脊背流过天光，桌前的大红蜡烛在壮默的人头前面燃烧。李青山的大个子直立在桌前：“弟兄们！今天是什么日子！知道吗？今天……我们去敢死……决定了……就是把我们的脑袋挂满了整个村子所有的树梢也情愿，是不是啊？……是不是？……弟兄们？……”

其 中 ， cθi=sinθi ， cαi-1=cosαi-1 ， sθi=sinθi ，sαi-1=sinαi-1， i=1,2,⋅⋅⋅n 。

4）考虑图像精度及运算时间，把2、3的重复次数设定为m=50 000次，则可计算出50 000个喷枪工作点(px,py,pz)；

5）再以scatter函数把喷枪m=50 000个工作点输出，即可求得机械臂末端喷枪顶点的工作空间。

机械臂末端喷枪的工作空间及其xoy、xoz、yoz三面上的投影如图5、6、7、8所示。

生态文明融入到高校校园文化建设，是高校激发师生积极性和创造性的内在动力。从生态文明的全新视角和崭新高度孕育具有生态特征的高校校园文化，对教学、科研、管理等运作机制充分融入生态文明新元素，构建出人与人在有序规则中和谐相处的生动局面，使师生在绿色校园文化中创新创业、成长成才。

关于为何和如何将数学史融入数学教育的HPM基础理论探讨有两场报告．报告10“有关如何在数学教育中运用数学史的分类框架：一项实证研究”在已有文献的基础上，结合20个中学HPM课例，建构了将数学史融入数学课堂教学方式的分类框架，报告2“以巴赫金的对话视角置身及研究历史和数学教育”是一种对数学史与数学教育研究的元分析，用巴赫金（Mikhail Bakhtin，1895—1975）的论点支持对数学教育研究的反思，从对话的视角来思考研究者、参与者及数学史之间的对话互动．

（2）按照推导运动学方程的结果，完成了在MATLAB中以蒙特卡洛法对机械臂末端喷枪工作空间的仿真、求解，分析得到了喷枪的工作空间及横向、纵向、最大纵向作业深度等主要参数，对后续机械臂末端喷枪的轨迹规划和运动控制具有一定参考意义。

在MATLAB中按照蒙特卡洛法求解喷枪工作空间W(P)的思路如下[8]：

  

图5 喷枪三维工作空间

  

图6 工作空间xoy面投影

  

图7 工作空间xoz面投影

  

图8 工作空间yoz面投影

4 总结

（1）以D-H法则构建了各连杆运动学方程，且在Robotics Toolbox中仿真了机械臂从初始位姿至水平破拆位姿的动作过程，输出了各关节角度或位移随时间变化曲线，证明了D-H参数及运动学方程的正确；

取经0.22 μm微孔滤膜滤过后的TPGS-CS载药胶束溶液100 μL，加入色谱甲醇稀释2.0 mL，涡旋1 min，破坏胶束，12 000 r/min离心10 min，取上清液进样测定，按公式分别计算其包封率和载药量。TPGS-CS载药胶束的包封率为76.0%，载药量为2.4%。

2）用rand函数在[0,1]区间内随机产生的数值视为一个步长，则机械臂中各移动关节随机值是di=dimin+(dimax-dimin)×rand[0,1]，旋转关节随机值是θi=θimin+(θimax-θimin)×rand[0,1]；

(1) 两处滑坡监测点的计算位移比实测位移偏小，但总体来说，计算位移与实测位移较为吻合，预测效果较好，且无需考虑计算时步和真实时间对应问题，表明本文提出的库水位波动下堆积层滑坡位移预测方法是可行、可靠的。

参考文献：

［1］何佳唯，平雪良，李朝阳，等.机器人工作空间求解方法研究及应用［J］.机械传动，2015，39（10）：68-71.

［2］常军，南文虎，李玉明.基于蒙特卡洛法的DELTA机器人工作空间分析［J］.机械工程师，2012（09）：14-15.

［3］李保丰，孙汉旭，贾庆轩，等.基于蒙特卡洛法的空间机器人工作空间计算［J］.航天器工程，2011，20（04）：79-85.

［4］赵燕江，张永德，姜金刚，等.基于Matlab的机器人工作空间求解方法［J］.机械科学与技术，2009，28（12）：1657-1661.

［5］蔡蒂，谢存禧，张铁，等.基于蒙特卡洛法的喷涂机器人工作空间分析及仿真［J］.机械设计与制造，2009（03）：161-162.

［6］朱志明，马国锐，郭吉昌，等.基于蒙特卡洛法的箱型钢结构焊接机器人工作空间分析［J］.焊接，2016（09）：1-5.

［7］刘志忠，柳洪义，罗忠，等.机器人工作空间求解的蒙特卡洛法改进［J］.农业机械学报，2013，44（01）：230-235.

［8］李保丰，孙汉旭，贾庆轩，等.基于蒙特卡洛法的空间机器人工作空间计算［J］.航天器工程，2011，20（04）：79-85.