


DKP分析和计算的方法和文献很多,本文采用D-H变换矩阵法,略去求解过程。挖掘机工作装置的运动学正问题的解为:
x=c0(a3c123+a2c12+a1c1+a0)y=s0(a3c123+a2c12+a1c1+a0)
图2 轨迹实现框图
z=a3s123+a2s12+a1s1+d0 =2k -(q1+q2+q3)
1.3 控制数据的获得
挖掘机自动控制过程中,预设的路线是在位姿空间,即自然坐标系中。而控制是在驱动空间实现。要获得控
制信号,首先要把轨迹按一定的步长分成若干份,得到一组节点的坐标序列,即铲斗的位姿序列组;根据铲斗的位姿序列和变换矩阵可以计算出对应的各个杆件的目标转角序列;再由关节角序列转换成驱动空间序列,油缸长度变换量可以直接求出控制阀口的开度,阀口的开度可以直接被控制器控制。其过程如图3所示。
2.2 逆运动学(IKP)计算
IKP问题和正运动学问题相反,它是已知铲斗尖的位姿参数,求解此状态下的关节变量。用公式表示就是:
[x,y,z, ] [q0,q1,q2,q3]挖掘机工作装置的运动学逆问题的解为:q0=arctan2(y,x)
2a2z-d01+l13-a2
q1=a+arc3+2k1
2a1l13xy3-aq2= +22a21+a2-l13
+2k2
2a1a2
2a2z-d02+l13-a1
q3=a-arc3- +2k3
2a2l13xy3-a上式中,各符号的意义如下:
x,y,z和 是铲斗齿尖的三维笛卡儿坐标和铲斗的姿态角: 逆时针的方向为负,顺时针为正。
K1,k2,k3取整数,使qi的值落在(- , )区间(i=0,1,2,3)。
xy3=l13=
x+y+a3cos
z3=z+a3sin
(z3-d0)+(xy3-a0)2.3 驱动机构空间和关节空间的变换
图3 轨迹曲线的离散转换图
驱动空间和关节空间的变换的表达式为:
[ 0, 1, 2, 3] [q0,q1,q2,q3]
建立驱动机构空间变量与关节空间变量之间的关系,其目的是给控制器提供可直接控制的数据。各种液压挖掘机的驱动机构有所区别,但根据几何对应关系可以方便的计算出转换关系式。本节以驱动机构相对复杂的贵州詹阳机械公司生产GJW111型液压挖掘机为例列出关节空间向驱动空间转换关系:
0=15.899 q0;
2 自动控制中的数据计算
2.1 正运动学(DKP)计算
DKP问题是求解关节空间向位姿空间变量的转换:
[q0,q1,q2,q3] [x,y,z, ]
2= 3=10
400000c(ac(
1=
1+ac(
5-3c(-q2-5.82)212
)+8202500;
)。
400-600c(-q2-5.82)237
3225-2700(ac()-2700ac(
33上式中:c cos;ac arccos。计算数据取自GJW111型液压挖掘机说明书。
阀口流量特性可以表示为:
Qv=KvAv(1)
由式(1)可以看出,只要保证多路阀口前后压差 p不变,则流经阀口的流量Qv与阀口开度Av成正比。在多路阀口联接一个差压式减压阀,起到压力补偿作用,即可保证多路阀阀口前后压差 p在工作过程中始终保持一定
3 油缸长度变化与阀口开度的关系
油缸长度的变化是由流经阀的液压油流量决定的,而 http: chinajrna.ln.cnai:lnourna.lnet.
液压挖掘机工作装置运动轨迹自动绘制_专业资料。利用MATLAB的计算功能和图形化用户界面,对液压挖掘机反铲工作装置轨迹参数进行计算和优化,并绘制包络图,直观地反映挖掘...
专题综述 挖掘机工作 装置轨迹控制 同济大学 黄宗益 王康 杨劲松 1 概述 液压挖掘机是通用性机械, 具有很多自由度, 完 成多种作业: 掘削、 装载、 整地、 ...
液压挖掘机工作装置控制方案研究赵波m,刘杰1,王亚美2 (1.东北大学机械工程与...液压挖掘机作为功能典型的工程机械,如何实现 平稳和高精度的轨迹跟踪已成为挖掘机...
液压挖掘机工作装置的控制是实现自动挖掘的关键技术,由于挖掘机工作装 置的结构...实验研究,并取得了一些重要的成 果,主要内容包括任务规划、路径规划和轨迹规划“...
使多路换向阀动作, 推动液压缸伸出或者 缩进, 实现对挖掘机工作装置的电液操纵...研究挖掘机工作装置 轨迹控制问题,就是要保证各关节角位移能够跟踪 期望的目标...
液压挖掘机工作装置模型及控制的试验研究_机械/仪表_工程科技_专业资料。液压挖掘...这里采 用 PID 控制方法实现挖掘机对铲斗轨迹的精确控 制 , 并在测试试验 [...
液压挖掘机工作装置仿真研究_机械/仪表_工程科技_专业...信号实现压力 流量的控制 对挖掘机 这样的复杂液压...从而利用机构的运动学方程得出铲斗末端的 轨迹控制器...
中南大学 博士学位论文 液压挖掘机工作装置运动控制研究 姓名:张大庆 申请学位...运动轨迹,还是复合运动轨迹,使用论文中所设计的自适应预测控制算法,都能实现对...
第33 卷 第4期 液压挖掘机工作装置综合优化研究 1...由于空间开链工作机 构的主要用途是实现末杆在空间...挖掘装置操作臂末端轨迹控制的试验 研究[ J] . ...
热门文档