挖掘机自动测深仪的研制

摘 要: 根据挖掘机的结构特点,建立了挖掘深度测量的数学模型,论述了挖掘机自动测深仪的硬件/软件结构、工作原理、性能指标及可靠性等。

关键词: 自动测量 仪器 仪表 微机 挖掘机

挖掘机是重要的工程机械,其作业环境比较复杂,有时属于恶劣环境。如遇危险场合或进行水下挖掘时,挖掘的深度难以测量,直接影响了挖掘的质量和效率。为了改变这一状况,我们开发研制了一种适合挖掘机工作环境的高稳定性和高可靠性的自动测深仪。它能够自动测量并显示挖掘深度,可设定挖掘界限,挖掘时遇限报警,以指导操作人员有效地工作。

无论是轮式挖掘机还是履带式挖掘机,其工作装置主要由动臂、斗杆、铲斗等部件组成,各部件以转动关节铰接在一起,每个关节具有一个自由度,并由相应的动力部件(油缸)驱动。挖掘的深度与各组件的相对空间位置有关。根据挖掘机工作装置的结构特点建立相应的深度测量模型,这是自动测量的基础。

1 建立数学模型

按以下规则建立直角坐标系:

基坐标系O₀X₀Y₀Z₀与挖掘机下车架固联,坐标原点O₀在动臂与下车架铰点处,X₀轴为下车架正前方,Z₀轴垂直于接地平面,Y₀轴按右手规则确定。

第i个坐标系O_iX_iY_iZ_i与第i个关节固联,坐标原点在第i+1个关节的铰点中心,并遵循以下三个条件:

①Z_i轴与第i+1个关节的运动轴方向一致;

②X_i轴垂直于Z_i-1轴,

③Y_i轴由右手规则确定。

两坐标系的联系可由四个参数来确定,四个参数定义如下:

θ_i:关于Z_i-1轴,按右手规则,从X_i-1到X_i的转角;

d_i:从第i-1个坐标系O_i-1X_i-1Y_i-1Z_i-1的原点O_i-1沿着Z_i-1轴到X_i轴与X_i-1轴相交点的距离;

a_i:从Z_i-1轴与X_i轴的交点,沿X_i轴到第i个坐标系坐标原点的偏移距离;

α_i:关于X_i轴,按右手规则从Z_i-1轴到Z_i轴的转角。

四个参数中,连杆参数(a_i,α_i)由连杆的结构决定,是常数;关节参数(θ_i,d_i)决定相邻连杆的相对位置。由于在挖掘机中均为转动关节,因此,d_i是常数,θ_i是变量。由上述定义可以看出,经过以下四步,可以使坐标系O_iX_iY_iZ_i与O_i-1X_i-1Y_i-1Z_i-1重合:

①绕Z_i-1轴旋转θ_i角,使X_i-1轴与X_i轴平行;

②沿Z_i-1轴平移距离d_i,使X_i-1轴与X_i轴位于同一直线上;

③沿X_i轴平移距离a_i,使两坐标系原点重合;

④绕X_i轴旋转α_i角,使两坐标系重合。

这样,两坐标系之间的联系可由一个4×4齐次变换矩阵来表示:

式中,S_i=sinθ_i,C_i=cosθ_i,Sα_i=sinα_i,Cα_i=cosα_i,Rot表示回转因子,Trans表示平移因子,表示第i个坐标系相对于第i-1个坐标系的齐次变换矩阵。

按上述规则建立的挖掘机工作装置直角坐标系如图1所示。履带或轮胎接地平面为M₀,点A为动臂与上车架铰点,点B为动臂与斗杆的铰点,点C为斗杆与铲斗的铰点,点D为斗尖,铰点A与平面M₀的距离为L₀。

坐标系O₀X₀Y₀Z₀的原点O₀在A点,O₁X₁Y₁Z₁的原点O₁也在A点,O₂X₂Y₂Z₂的原点O₂在B点,O₃X₃Y₃Z₃的原点O₃在C点,O₄X₄Y₄Z₄的原点O₄在D点。根据坐标系建立规则可得各坐标系参数如表1所示。

由式(1)可得:

可进一步求出第i个坐标系相对于基坐标系的齐次变换矩阵:

矩阵为挖掘机铲斗末端相对于基坐标系的齐次变换矩阵。态,且

将式(2)、(3)、(4)、(5)代入式(7),可得:

p_z=-L₃S₂₃₄-L₂S₂₃-L₁S₂ (8)

其中,S₂₃₄=sin(θ₂+θ₃+θ₄),S₂₃=sin(θ₂+θ₃),S₂=sinθ₂

p_z即为铲斗末端在基坐标系中Z₀轴上的坐标量。深度测量以挖掘机轮胎或履带接地平面M₀为参考平面,若动臂和上车架铰点与接地平面之间的距离为L₀,可得挖掘深度测量数学模型为:

H₀=L₀+p_z=L₀-L₃S₂₃₄-L₂S₂₃-L₁S₂ (9)

从式(9)可看出,除了挖掘机结构参数L₀、L₁、L₂、L₃等常数以外,挖掘深度只与3个角度有关。

2 硬件设计

挖掘机自动测深仪的硬件结构如图2所示,由以下几个部分组成:转角传感器、A/D转换接口、MCS51主机板、数码显示接口、键盘接口、电源等。

转角传感器:用于测量动臂与车体(θ₂)、斗杆与动臂(θ₃)、铲斗与斗杆(θ₄)等之间的夹角,输出标准电流信号,输送到A/D转换接口。

A/D转换接口:由I/V变换电路、高精度参考电源、A/D转换电路及其相应接口电路组成。功能是将电流信号转变成电压,并由A/D转换电路转换成数字量,经接口电路输入到主机板。

MCS51主机板:是硬件系统的核心,主要由单片机AT89C52、E²PROM存储器2864A、日历时钟12887及I/O接口电路组成。软件固化在单片机AT89C52中,是系统运行的控制中心。

数码显示接口:由数码管和驱动电路组成。在工作模式时,显示深度测量值;在校验模式时,显示各转角传感器测量值;在输入模式时,显示各组件结构尺寸值;在日历模式时,显示/修改日期或时间。

键盘接口:定制的薄膜键盘,由数字键盘(0～9)和功能键盘(包括模式转换键、确认键、返回键等)组成,用于模式转换操作及其参数输入等。

电源:供电电源直接使用挖掘机蓄电池组,稳压电源采用开关型DC/DC电源。

3 软件设计

设计自动测深仪软件时,为达到通用性、灵活性和实用性,设置了四种模式:工作模式、校验模式、输入模式和日历模式,软件流程如图3所示。

工作模式是挖掘深度自动测量模式,包括转角数据采集、数字滤波、标度变换、深度计算、越限报警及深度显示等;校验模式用于安装调试时各转角传感器零点与满量程的校准;输入模式因挖掘机型号不同、部件尺寸不同,用于输入或修改组件结构尺寸值;日历模式用于输入或修改日历与时间。

软件由MCS51汇编语言编写,按自下而上、模块化设计思想开发了如下模块:初始化、数据采集、数字滤波、标度变换、深度计算、越限判断、显示、键盘管理、主程序等。为了提高精度,采用三字节浮点数运算。

挖掘机自动测深仪的研制成功,解决了挖掘深度自动测量难的问题,尤其在复杂作业场合,如水下、危险环境等,更体现出了其优越性能。在挖掘深度不大于1m时,其绝对误差不大于0.05m;挖掘深度大于1m时,其相对误差不大于1%。

自动测深仪在设计时,采取了抗电磁干扰、抗振动、防水、耐高低温等措施,大大提高了仪器的稳定性和可靠性以及环境适应性。

自动测深仪操作简单、安装调试容易、维护十分方便,推广应用效益显著。

参考文献

1 潘松峰,张铁柱,蔺德军.挖掘机自动测深模型.青岛大学学报,1996(3):40～43

2 Lee C.S.G. Robot Arm Kinematics.DynamicsandControl.Computer,1982(12):62～80