设计了一款交通锥自动回收及摆放的装置,该装置具有自动回收以及摆放交通锥的功能。抓取装置中交通锥的机械臂是重要组成部分,对机械臂进行运动学分析,在Adams中仿真分析机械臂末端执行器的轨迹路线,基于Matlab的蒙特卡罗法模拟机械臂可达工作空间,验证机械臂抓取可行性。 A device for automatic recovery and placement of traffic cones has been designed. The device has the functions of automatic recovery and placement of traffic cones. The mechanical arm of the traffic cone in the gripper is an important part. The kinematics analysis of the manipulator is performed, and the trajectory of the end effect or of the manipulator is simulated and analyzed in Adams. The Monte Carlo method based on Matlab simulates the reach of the manipulator to the working space, and verifies the feasibility of the manipulator grasping.
华俣,谷勇霞
北京工商大学,材料与机械工程学院,北京
收稿日期:2020年1月30日;录用日期:2020年2月13日;发布日期:2020年2月20日
设计了一款交通锥自动回收及摆放的装置,该装置具有自动回收以及摆放交通锥的功能。抓取装置中交通锥的机械臂是重要组成部分,对机械臂进行运动学分析,在Adams中仿真分析机械臂末端执行器的轨迹路线,基于Matlab的蒙特卡罗法模拟机械臂可达工作空间,验证机械臂抓取可行性。
关键词 :机械臂,运动学分析,轨迹验证,可达工作空间
Copyright © 2020 by author(s) and Hans Publishers Inc.
This work is licensed under the Creative Commons Attribution International License (CC BY).
http://creativecommons.org/licenses/by/4.0/
随着汽车等代步工具的快速发展,高速公路及马路上的负担越来越重,人工养护 [
2010年8月,山东省潍坊市的刘庆亮先生发明了“一种用于高速公路快速摆放锥形标的摆放机”。施工人员只需要在滑板上放交通锥让交通锥自动滑到指定位置,这项发明类似一个半自动化的装置,将其放在工程车的尾部,然而其摆放交通锥的整齐度难以保障。
2018年北京道路运输展期间,北京市首都公路发展集团有限公司展出了国内首款交通锥半自动化收放存储专用车,该装置只需要两个驾驶人员在车厢内进行操作 [
上述摆放交通锥的装置仍然需要两个及以上的人来进行人工操作。与需要人工摆放的半自动化装置相比,能够实现自动回收及摆放交通锥的装置显然更具优势。本文设计出一种小型可通过货车运载的道路交通锥自动回收及摆放的装置。对装置中关键的机械臂进行理论分析,分析机械臂易出现危险截面的部分,以D-H齐次线性坐标法建立简图,运用运动学知识对机械臂进行运动学分析 [
阶段一:如图1(a)所示,机械臂利用滚珠丝杆升降机构升到指定高度,经过旋转和直线运动后所述机械臂的机械手到达指定位置,所述机械臂机械手外钩钩住了专用交通锥最外节的槽口。
阶段二:如图1(b)所示,机械手外钩钩住交通锥最外节的槽口,在所述机械臂滚珠丝杆升降机构的升降、所述机械臂大臂和小臂的旋转作用下位移到将要摆放的位置上方。
阶段三:如图1(c)所示,所述机械臂机械手外钩钩住交通锥最外节的槽口,所述机械臂滚珠丝杆升降机构向下降低,所述机械臂大臂同时向下摆动直到所述机械臂机械手完全将专用交通锥摆放到达指定地面。
阶段四:如图1(d)所示,所述机械臂机械手将专用交通锥摆放到地面之后,所述机械臂机械手内钩抓住专用交通锥交通锥环,滚珠丝杆升降机构上升,同时所述机械臂大臂向上摆动,直到所述机械臂机械手到达专用交通锥完全伸展状态时的高度,在这个过程中专用交通锥由于加重底盘的重力原因受到向下的力,达到伸展状态,当专用交通锥处于完全伸展状态时所述机械臂机械手内钩松开。这时一个专用交通锥的摆放工作完成。
图1. 所述装置工作流程图
收集箱长800 mm、宽600 mm、高610 mm。收集箱内部设计,包含四十个仿“鱼竿”式交通锥、机械臂和定位柱。收集箱立体示意图如下图2所示,内部布局图如下图3所示。
图2. 收集箱立体示意图
图3. 收集箱内部布局图
实现所述装置小型化,使装置易于运载携带。目前,交通锥的设计向着稳定型、缓冲型、多功能型以及提高警示效果型发展 [
运用Solidworks对所述装置装配(本文主要研究所述装置回收及摆放交通锥,所以其一体的小车只是设计了简易的模型),整体装配图如图7所示。整个装置体积小于1 m3,方便运载。
节数 | 1 | 2 | 3 | 4 | 5 | 6 |
---|---|---|---|---|---|---|
直径(mm) | 13.5 | 31.1 | 47.4 | 64 | 80.8 | 97.4 |
节数 | 7 | 8 | 9 | 10 | 11 | |
直径(mm) | 114 | 131 | 147 | 164 | 181 |
表1. 交通锥锥节直径参数表
图4. 交通锥立体示意图((a) 图为伸展状态,(b) 图为压缩状态)
图5. 交通锥最外节(底盘)放大图
图6. 交通锥顶部节示意图
图7. 交通锥自动回收及摆放装置立体示意图
本文设计了一款3自由度机械臂 [
自由度 | |||
---|---|---|---|
机械臂 | 3个,包含2个转动自由度和1个移动自由度 | ||
长度(mm) | 驱动 | 执行方式 | |
机械臂大臂 | 360 | 电机 | 带传动 |
机械臂小臂 | 360 | 电机 | 带传动 |
机械臂抓手 | 80 | 电机 |
表2. 机械臂参数表
使用solidworks制图软件建立机械臂三维模型图(见下图8)。
图8. 机械臂立体示意图
机械臂的工作方式如下(图9)。
图9. 机械臂运作流程图
为了能够满足抓取交通锥环以及交通锥末节槽口,机械手指的形状如图10所示,抓手材料为304不锈钢,手指外钩长度为8 cm,与内钩的夹角为30˚。本次设计的专用交通锥一个的重量约为2 KG,所以单侧手指在a点处承受的压力约为10 N。手指部分最容易出现危险截面,对该手指进行有限元分析,分析结果如图11。手指材料选用304不锈钢,304不锈钢的最大屈服应力为2.068e+008 N/m2,手指危险截面段即红色部分的屈服应力为1.579e+008 N/m2,显然手指部分选用的材料符合设计要求。
图10. 机械手指
图11. 机械手指应力图
D-H法 [
绕Z轴旋转θ: G 1 = [ cos θ − sin θ 0 0 sin θ cos θ 0 0 0 0 1 0 0 0 0 1 ] (1)
绕X轴旋转α: G 2 = [ 1 0 0 0 0 cos α − sin α 0 0 sin α cos α 0 0 0 0 1 ] (2)
沿Z轴平移d: G 3 = [ 1 0 0 0 0 1 0 0 0 0 1 d 0 0 0 1 ] (3)
沿X轴平移a: G 4 = [ 1 0 0 a 0 1 0 0 0 0 1 0 0 0 0 1 ] (4)
可以用矩阵 G · = G 1 G 2 G 3 G 4 ,来表示相邻两杆之间的关系,得到末端执行器相对坐标系原点的位姿 [
T n m = G • G • • (5)
由式(1)、(2)、(3)、(4)可得末端执行器的位姿矩阵为:
G n n − 1 = G 1 G 2 G 3 G 4 = [ cos θ − sin θ cos α sin θ sin α a cos θ sin θ cos θ cos α − cos θ sin α a sin θ 0 sin α cos α d 0 0 0 1 ] (6)
根据机器人机构学理论 [
图12. D-H机械臂坐标系机构简图
D-H参数表如下表3所示:
关节序号 | 连杆扭转α | 连杆长度a | 连杆偏移d | 关节转角θ |
---|---|---|---|---|
1 | 90 | l0 | 0 | θ1 |
2 | 0 | l1 | 0 | θ2 |
3 | 0 | l2 | 0 | θ3 |
表3. D-H参数表
将表中关节序号1的参数带入式(6)中可得:
G n n − 1 = G 1 G 2 G 3 G 4 = [ cos θ 1 − sin θ 1 cos 90 sin θ 1 sin 90 l 0 cos θ 1 sin θ 1 cos θ 1 cos 90 − cos θ 1 sin 90 l 0 sin θ 1 0 sin 90 cos 90 0 0 0 0 1 ] (7)
由式(7)可得坐标系(X0Y0Z0)到坐标系(X1Y1Z1)的变化矩阵:
G 1 0 = G 1 G 2 G 3 G 4 = [ cos θ 1 0 sin θ 1 l 0 cos θ 1 sin θ 1 0 − cos θ 1 l 0 sin θ 1 0 1 0 0 0 0 0 1 ] (8)
将表中关节序号2的参数带入式(6)中可得:
G n n − 1 = G 1 G 2 G 3 G 4 = [ cos θ 2 − sin θ 2 cos 0 sin θ 2 sin 0 l 1 cos θ 2 sin θ 2 cos θ 2 cos 0 − cos θ 2 sin 0 l 1 sin θ 2 0 sin 0 cos 0 0 0 0 0 1 ] (9)
由式(9)可得坐标系(X1Y1Z1)到坐标系(X2Y2Z2)的变化矩阵:
G 2 1 = G 1 G 2 G 3 G 4 = [ cos θ 2 − sin θ 2 0 l 1 cos θ 2 sin θ 2 cos θ 2 0 l 1 sin θ 2 0 0 1 0 0 0 0 1 ] (10)
将表中关节序号3的参数带入式(6)中可得:
G 3 2 = G 1 G 2 G 3 G 4 = [ cos θ 3 − sin θ 3 cos 0 sin θ 3 sin 0 l 2 cos θ 3 sin θ 3 cos θ 3 cos 0 − cos θ 3 sin 0 l 2 sin θ 3 0 sin 0 cos 0 0 0 0 0 1 ] (11)
由式(11)可得坐标系(X2Y2Z2)到坐标系(X3Y3Z3)的变化矩阵:
G 3 2 = G 1 G 2 G 3 G 4 = [ cos θ 3 − sin θ 3 0 l 2 cos θ 3 sin θ 3 cos θ 3 0 l 2 sin θ 3 0 0 1 0 0 0 0 1 ] (12)
由式(5)可得末端执行器相对坐标系原点的位姿,在此,令
G 3 1 = G 1 0 G 2 1 G 3 2 = [ • • • l 2 c θ 1 c θ 2 c θ 3 − l 2 c θ 1 s θ 2 s θ 3 + l 1 c θ 1 c θ 2 + l 0 c θ 1 • • • l 2 s θ 1 c θ 2 c θ 3 − l 2 s θ 1 s θ 2 s θ 3 + l 1 s θ 1 c θ 2 + l 0 s θ 1 • • 0 l 2 s θ 2 c θ 3 + l 2 c θ 2 s θ 3 + l 1 s θ 2 0 0 0 1 ] (13)
由式(13)可得到交通锥自动回收及摆放装置机械臂的末端执行器位置的位姿坐标,即交通锥自动回收及摆放装置机械臂的运动学正解:
[ P x 3 P y 3 P z 3 ] = [ l 2 c θ 1 c θ 2 c θ 3 − l 2 c θ 1 s θ 2 s θ 3 + l 1 c θ 1 c θ 2 + l 0 c θ 1 l 2 s θ 1 c θ 2 c θ 3 − l 2 s θ 1 s θ 2 s θ 3 + l 1 s θ 1 c θ 2 + l 0 s θ 1 l 2 s θ 2 c θ 3 + l 2 c θ 2 s θ 3 + l 1 s θ 2 ] (14)
逆运动学分析与正运动学相反 [
步骤 | 方法 |
---|---|
1 | 确定目标连杆的位姿。 |
2 | 设定躯干和目标连杆间关节角的矢量。 |
3 | 通过正运动学建模确定目标连杆的位姿。 |
4 | 求出目标连杆位姿误差。 |
5 | 检查误差是否在允许范围内,当误差超出允许范围时,校正关节角。 |
6 | 求出运动学逆解。 |
表4. 逆运动学分析方法 [
由式(14)可得:
{ P x 3 = l 2 c θ 1 c θ 2 c θ 3 − l 2 c θ 1 s θ 2 s θ 3 + l 1 c θ 1 c θ 2 + l 0 c θ 1 P y 3 = l 2 s θ 1 c θ 2 c θ 3 − l 2 s θ 1 s θ 2 s θ 3 + l 1 s θ 1 c θ 2 + l 0 s θ 1 P z 3 = l 2 s θ 2 c θ 3 + l 2 c θ 2 s θ 3 + l 1 s θ 2 (15)
其中,关节序号3处是末端执行器抓手,所以θ3是已知值,要求的参数中Px3、Py3、Pz3、l1和l2是已知的,l0是滚珠丝杆升降机的滑动长度。在此,令 sin θ i = s i ,令
式(15)中第三式只有一个未知数θ2,即可求出θ2的值。式(15)中第一式除以第二式可得θ1:
θ 1 = arctan P y 3 P x 3 (16)
由式(15)中的第一式与第二式相加变化后可得l0:
l 0 = P x 3 + P y 3 − ( c 1 + s 1 ) ( l 2 c 2 c 3 − l 2 s 2 s 3 + l 1 ) c 1 + s 1 (17)
通过运动学逆解解得机械臂抓手在抓取交通锥时的关节转角大小。
本节对整个机械臂容易出现危险截面的手指部分进行了有限元分析,验证了可行性。通过对机械臂的逆运动学分析可以求出机械臂末端执行器到达各个交通锥抓取点时关节转角的大小,验证机械臂末端执行器可以到达各个抓取点以及摆放点的位置,为之后机械臂仿真分析提供理论依据。
将在Solidworks中建模完成后的机械臂保存为x_t格式文件,导入到Adams软件中,添加3个转动副和1个移动副,获取目标执行器坐标(交通锥在收集箱内的坐标位置),将目标执行器坐标代入运动学逆解中求得各个关节处的转角。在Adams中设置各个关节转动副的转动方向,Adams中旋转副的转动方向遵循右手定则,利用 S t e p ( x , x 0 , h 0 , x 1 , h 1 ) 函数来控制仿真,其中x是时间的函数,x0——自变量是Step函数的开始值,h0是Step函数的初始值,x1——自变量是Step函数的结束值,h1是Step函数的最终值。得到机械臂在抓取收集箱中的交通锥时的轨迹,如图13所示,其中选取的轨迹参数如下: θ 1 = 75 ∘ , θ 2 = 180 ∘ , l 0 = 250 mm ,图13中可以看出机械臂抓手可以沿着平滑路线抓取交通锥。
图13. 机械抓手抓取交通锥时的轨迹图
图14. 机械臂抓手可达空间
蒙特卡罗法 [
收集箱的长800 mm、宽600 mm、高610 mm,实际交通锥在收集箱内的矩形分布空间会小于收集箱的矩形空间从图14中可见机械臂抓手可达空间可以完全覆盖收集箱的内部空间。
本文提出了一种用于危险路段的交通锥自动回收及摆放装置,构思设计了一种仿“鱼竿”式交通锥以及设计了一个2轴3自由度的机械臂。对机械臂机械手指进行有限元分析,验证机械臂抓手危险截面处符合设计要求。在机器人机构学以及数学理论的支撑下,建立D-H坐标系,对所述装置的机械臂进行正运动学分析和逆运动学分析。通过求解逆运动学解得到关节角,代入Adams中仿真,规划出机械臂抓手抓取交通锥时的轨迹,在Matlab中用蒙特卡罗法模拟绘制了机械臂抓手可达空间图,验证了机械臂装置的抓取可行性。该设计为道路交通锥的回收以及摆放装置提供了一种新型的方案,为之后的研究奠定了基础。
华 俣,谷勇霞. 交通锥自动回收及摆放装置中的机械臂运动学分析Kinematics Analysis of a Robotic Arm in a Traffic Cone Automatic Recovery and Placement Device[J]. 机械工程与技术, 2020, 09(01): 1-12. https://doi.org/10.12677/MET.2020.91001