CN109614743B - 挖掘机及其铲斗定位方法、电子设备、存储介质 - Google Patents
挖掘机及其铲斗定位方法、电子设备、存储介质 Download PDFInfo
- Publication number
- CN109614743B CN109614743B CN201811601685.XA CN201811601685A CN109614743B CN 109614743 B CN109614743 B CN 109614743B CN 201811601685 A CN201811601685 A CN 201811601685A CN 109614743 B CN109614743 B CN 109614743B
- Authority
- CN
- China
- Prior art keywords
- bucket
- excavator
- coordinate system
- movable arm
- mechanical point
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 38
- 239000011159 matrix material Substances 0.000 claims abstract description 13
- 238000004590 computer program Methods 0.000 claims description 8
- 238000004364 calculation method Methods 0.000 description 15
- 238000005259 measurement Methods 0.000 description 9
- 238000010276 construction Methods 0.000 description 7
- 230000007547 defect Effects 0.000 description 4
- 230000035945 sensitivity Effects 0.000 description 4
- 230000008569 process Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 238000009412 basement excavation Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000000691 measurement method Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- Structural Engineering (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Computer Hardware Design (AREA)
- Evolutionary Computation (AREA)
- Geometry (AREA)
- General Physics & Mathematics (AREA)
- Operation Control Of Excavators (AREA)
Abstract
本发明公开了铲斗定位方法,该方法应用于挖掘机,采用右手定则规定正方向,建立挖掘机运动学模型;根据天线相位中心在地理坐标系中的坐标,及由RTK测量得到的天线相位中心在地理坐标系中的位置矢量,计算动臂支点坐标;通过挖掘机机械参数、动臂倾角计算动臂旋转角度;根据斗杆倾角、动臂旋转角度计算斗杆旋转角度;根据铲斗倾角、动臂旋转角度、斗杆旋转角度计算铲斗旋转角度;根据动臂支点坐标,通过建立DH矩阵模型计算铲尖位置。本发明能够解决挖掘机难以精确计算定位铲斗位置的问题。
Description
技术领域
本发明涉及挖掘机技术领域,尤其涉及挖掘机及其铲斗定位方法、电子设备、存储介质。
背景技术
目前,常用的挖掘机铲斗坐标计算方法主要有以下三种:
1、激光引导:通过架设激光发射器以及铲斗激光接收器,激光发射器扫出激光基准平面,铲斗激光接收器接收激光信号,由车载控制器根据激光基准平面引导挖掘机做平面的挖掘工作。
2、全站仪引导:类似于激光引导,但全站仪可测量铲斗三维坐标,可进行三维引导。
3、全球定位系统引导:同样可进行三维引导,通过在挖掘机车身安装卫星接收机,拉线位移传感器,利用车身固有机械结构模型可精确推算铲斗坐标,并且可适应于铲斗水下作业。
其中,激光引导为一维引导,不能做横向和纵向的引导;全站仪引导虽然可进行三维引导,但是当铲斗在水下作业时,该方案便难以精确测量铲斗坐标;激光引导、全站仪引导受环境影响较大,例如在进行水下工作时,由于光线在水中的折射很难判断铲斗位置。全球定位系统引导同样为三维引导,可适应于铲斗水下作业,但在实际施工过程中受工作环境影响较大,且机械臂姿态多变,对铲斗坐标计算的精度难以达到施工精度要求。
基于此,提供一种能够适应于各种施工环境并进行精确计算定位的挖掘机及铲斗定位方法,成了目前亟待解决的技术问题。
发明内容
为了克服现有技术的不足,本发明的目的之一在于提供挖掘机,其能够解决挖掘机难以精确计算定位铲斗位置的问题。
本发明的目的之一采用如下技术方案实现:
挖掘机,挖掘机设有四个动态传感器,包括车身倾角传感器、动臂倾角传感器、斗杆倾角传感器、铲斗倾角传感器,车身倾角传感器设于挖掘机车身以测量车身倾角、动臂倾角传感器设于挖掘机动臂以测量动臂倾角、斗杆倾角传感器设于挖掘机斗杆以测量斗杆倾角、铲斗倾角传感器设于挖掘机铲斗以测量铲斗倾角。
为了克服现有技术的不足,本发明的目的之二在于提供铲斗定位方法,其能够解决挖掘机难以精确计算定位铲斗位置的问题。
本发明的目的之二采用如下技术方案实现:
铲斗定位方法,应用于如本发明目的之一的挖掘机,包括以下步骤:
步骤S1、建立挖掘机运动学模型:采用右手定则规定正方向,建立的坐标系包括地理坐标系、导航坐标系、载体坐标系,动臂坐标系、斗杆坐标系、铲斗坐标系、铲尖坐标系和根据GNSS建立的卫星坐标系;
其中,载体坐标系的原点设于挖掘机动臂支点,导航坐标系的原点设于挖掘机底盘旋转中心位置;
俯仰角为导航坐标系绕地理坐标系X轴旋转的欧拉角,横滚角为导航坐标系绕地理坐标系Y轴旋转的欧拉角,航向角为导航坐标系绕地理坐标系Z轴旋转的欧拉角;
步骤S2、计算动臂支点坐标:根据天线相位中心在地理坐标系中的坐标,及由RTK测量得到的天线相位中心在地理坐标系中的位置矢量,计算动臂支点坐标;
步骤S3、计算挖掘机动臂旋转角度:通过挖掘机机械参数、动臂倾角计算动臂旋转角度;
步骤S4、计算挖掘机斗杆旋转角度:根据斗杆倾角、动臂旋转角度计算斗杆旋转角度;
步骤S5、计算挖掘机铲斗旋转角度:根据铲斗倾角、动臂旋转角度、斗杆旋转角度计算铲斗旋转角度;
步骤S6、计算铲尖位置:根据动臂支点坐标,通过建立DH矩阵模型计算铲尖位置。
以卫星定位为基础,结合动态传感器建立挖掘机运动学模型,采用动臂支点作为载体坐标系的原点,通过测量天线到动臂支点处的相对位置得到动臂支点坐标,进一步计算动臂旋转角度、斗杆旋转角度,再结合DH矩阵模型精确计算铲尖位置,通过卫星定位及动态传感器测量精度、灵敏度高、对施工环境要求较低,且利用DH矩阵对于多自由角度的挖掘机机械臂具有很好的适应性,在机械臂较多的情况下依旧能够保证计算的精准度。
优选的,步骤S6还包括以下步骤:
步骤S61、于动臂支点建立DH坐标系,根据挖掘机运动学模型得到DH参数;
步骤S62、根据DH参数及动臂支点坐标计算铲尖坐标,获取铲尖位置。
优选的,载体坐标系的原点设于挖掘机动臂支点,用右手定则规定正方向,载体坐标系X轴正向指向挖掘机驾驶室右侧,载体坐标系Y轴正向指向挖掘机车头方向,载体坐标系Z轴正向指向挖掘机顶部。
优选的,定义动臂于挖掘机机身的动臂支点为第一机械点、挖掘机动臂油缸与动臂连接处为第二机械点、动臂与挖掘机斗杆连接处为第三机械点,斗杆与挖掘机斗杆油缸间设有第一连杆,斗杆油缸与挖掘机铲斗间设有第二连杆,定义第一连杆与斗杆连接处为第四机械点、斗杆与铲斗连接处为第五机械点、第二连杆与斗杆油缸连接处为第六机械点、第二连杆与铲斗连接处为第七机械点、铲尖为第八机械点;挖掘机机械参数包括第一机械点与第二机械点连接形成的第一参考线及其长度、第一机械点与第三机械点连接形成的第二参考线及其长度、第二机械点与第三机械点连接形成的第三参考线及其长度、第三机械点与第四机械点连接形成的第四参考线及其长度、第三机械点与第五机械点连接形成的第五参考线及其长度、第四机械点与第五机械点连接形成的第六参考线及其长度、第四机械点与第六机械点连接形成的第七参考线及其长度、第五机械点与第七机械点连接形成的第八参考线及其长度、第六机械点与第七机械点连接形成的第九参考线及其长度、第六机械点与第八机械点连接形成的第十参考线及其长度。
优选的,动臂倾角传感器设于第二参考线,斗杆倾角传感器设于第五参考线,铲斗倾角传感器设于第十参考线。
为了克服现有技术的不足,本发明的目的之三在于提供一种电子设备,其能够解决挖掘机难以精确计算定位铲斗位置的问题。
本发明的目的之三采用如下技术方案实现:
一种电子设备,包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,其特征在于:所述处理器执行所述程序时实现如本发明目的之二的铲斗定位方法。
为了克服现有技术的不足,本发明的目的之四在于提供一种存储介质,其能够解决挖掘机难以精确计算定位铲斗位置的问题。
本发明的目的之四采用如下技术方案实现:
一种存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现如本发明目的之二的铲斗定位方法。
相比现有技术,本发明的有益效果在于:
以卫星定位为基础,结合动态传感器建立挖掘机运动学模型,采用动臂支点作为载体坐标系的原点,通过测量天线到动臂支点处的相对位置得到动臂支点坐标,根据计算得到的动臂旋转角度、斗杆旋转角度,结合DH矩阵模型精确计算定位铲尖,通过卫星定位及动态传感器测量精度、灵敏度高、对施工环境要求较低,且利用DH矩阵对于多自由角度的挖掘机机械臂具有很好的适应性,在机械臂较多的情况下依旧能够保证计算的精准度,该挖掘机及其铲斗定位方法能够对挖掘机进行精确计算定位。
附图说明
图1为本发明较佳实施例的铲斗定位方法的流程图;
图2为本发明较佳实施例的铲斗定位方法的挖掘机运动学模型示意图;
图3为本发明较佳实施例的铲斗定位方法的动臂、斗杆、铲斗旋转角度示意图。
具体实施方式
下面,结合附图以及具体实施方式,对本发明做进一步描述:
如图1-3所示,涉及挖掘机及其铲斗定位方法。
本发明较佳示例的挖掘机,设有四个动态传感器,包括车身倾角传感器、动臂倾角传感器、斗杆倾角传感器、铲斗倾角传感器,车身倾角传感器设于挖掘机车身以测量车身倾角、动臂倾角传感器设于挖掘机动臂以测量动臂倾角、斗杆倾角传感器设于挖掘机斗杆以测量斗杆倾角、铲斗倾角传感器设于挖掘机铲斗以测量铲斗倾角。
本发明所提“GNSS”指本发明基于卫星导航定位技术采用的全球导航卫星系统。“挖掘机运动学模型”的建立,以GNSS为基础,在实际操作中,仅需要确定用动臂支点作为原点,利用已知卫星天线到车体动臂支点处的三维坐标以及俯仰角、横滚角、航向角,测量天线到动臂支点处的相对位置即可进一步计算动臂支点的高斯坐标,避免了现有技术中在建立挖掘机运动学模型时惯用的测量方法(如以车身旋转中心为载体坐标系原点)以至于实际应用的测量场景受限,且测量难度较大。
本发明所示“动态传感器”为重力导向的动态MEMS倾角传感器,其测量精度、灵敏度高,通过对动态MEMS倾角传感器的应用能够精确知道倾角大小,且提高了机械臂在动态情况下的倾角测量精度,同时,本发明采用的MEMS传感器有四个,各传感器对应于挖掘机上的位置测量挖掘机机身及各机械臂相应的倾角,操作方便。
本发明所示RTK,即Real-time kinematic,指载波相位差分技术,本发明较佳示例通过RTK测量得出天线相位中心在地理坐标系中的位置矢量。
配合本发明实施例所示的挖掘机及其铲斗定位方法,还包括一种电子设备,该电子设备包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,处理器执行程序时实现如本发明实施例所示的铲斗定位方法。
同样地,配合本发明实施例所示的挖掘机及其铲斗定位方法,还包括一种存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现如本发明实施例所示的铲斗定位方法。
如图1所示,一种铲斗定位方法,用于本发明较佳实施例示例的挖掘机,包括以下步骤:
步骤S1、建立挖掘机运动学模型;
步骤S2、计算动臂支点坐标;
步骤S3、计算挖掘机动臂旋转角度;
步骤S4、计算挖掘机斗杆旋转角度;
步骤S5、计算挖掘机铲斗旋转角度;
步骤S6、计算铲尖位置。
其中,步骤S1、建立挖掘机运动学模型
采用右手定则规定正方向,建立的坐标系包括地理坐标系g系、导航坐标系n系、载体坐标系b系,动臂坐标系O1、斗杆坐标系O2、铲斗坐标系O3、铲尖坐标系O4和根据GNSS建立的卫星坐标系Ognss;其中,载体坐标系的原点设于挖掘机动臂支点,导航坐标系的原点设于挖掘机底盘旋转中心位置;俯仰角为导航坐标系绕地理坐标系X轴旋转的欧拉角,横滚角为导航坐标系绕地理坐标系Y轴旋转的欧拉角,航向角为导航坐标系绕地理坐标系Z轴旋转的欧拉角,以本发明的车身倾角传感器为例,俯仰角、横滚角、航向角逆时针旋转时为正。
如图2所示,本发明较佳实施例的挖掘机运动学模型,其中,θ、Φ、Ψ分别为导航坐标系绕地理坐标系X轴、Y轴、Z轴旋转的欧拉角(即分别为俯仰角、横滚角、航向角);θ1、θ2、θ3分别为动臂坐标系O1、斗杆坐标系O2、铲斗坐标系O3的连杆转动角度;d1、d2、d3分别为动臂坐标系O1、斗杆坐标系O2、铲斗坐标系O3的连杆长度。
其中,本发明较佳示例的挖掘机的动态传感器,动臂倾角传感器对应设于d1处、斗杆倾角传感器对应设于d2处、铲斗倾角传感器对应设于d3处。
较佳地,采用右手定则规定正方向,逆时针方向旋转为正,本发明较佳实施例示例载体坐标系的原点设于挖掘机动臂支点,载体坐标系X轴正向指向挖掘机驾驶室右侧,Y轴正向指向挖掘机车头方向,Z轴正向指向挖掘机顶部。
步骤S2、计算动臂支点坐标
由RTK测量得到天线相位中心在地理坐标系中的位置矢量,并对该适量进行欧拉变换,再结合天线相位中心在地理坐标系中的坐标,进一步计算动臂支点坐标,得到动臂支点坐标:
其中,为动臂支点的地理坐标、/>为天线相位中心在地理坐标系中的坐标、/>为天线相位中心在地理坐标系中的位置矢量,该动臂支点的地理坐标为动臂支点在高斯坐标系中的坐标。
步骤S3、计算挖掘机动臂旋转角度
较佳地,定义动臂于机身的动臂支点为第一机械点(即点A或O1)、挖掘机动臂油缸与动臂连接处为第二机械点(即点B)、动臂与挖掘机斗杆连接处为第三机械点(即点L),斗杆与挖掘机斗杆油缸间设有第一连杆,斗杆油缸与挖掘机铲斗间设有第二连杆,定义第一连杆与斗杆连接处为第四机械点(即点C)、斗杆与铲斗连接处为第五机械点(即点D)、第二连杆与斗杆油缸连接处为第六机械点(即点E)、第二连杆与铲斗连接处为第七机械点(即点F)、铲尖为第八机械点(即点G)。
本实施例涉及的挖掘机机械参数包括第一机械点与第二机械点连接形成的第一参考线(LAB)及其长度、第一机械点与第三机械点连接形成的第二参考线(LAL或d1)及其长度、第二机械点与第三机械点连接形成的第三参考线(LLB)及其长度、第三机械点与第四机械点连接形成的第四参考线(LLC)及其长度、第三机械点与第五机械点连接形成的第五参考线(LLD或d2)及其长度、第四机械点与第五机械点连接形成的第六参考线(LCD)及其长度、第四机械点与第六机械点连接形成的第七参考线(LCE)及其长度、第五机械点与第七机械点连接形成的第八参考线(LDF)及其长度、第六机械点与第七机械点连接形成的第九参考线(LEF)及其长度、第六机械点与第八机械点连接形成的第十参考线(LDG或d3)及其长度。其中,各参考线长度可在实际施工过程中结合本实施例较佳示例的挖掘机通过刻度尺等方式进行尺寸测量。
动臂倾角传感器设于第二参考线d1,斗杆倾角传感器设于第五参考线d2,铲斗倾角传感器设于第十参考线d3。
通过挖掘机机械参数,结合实际挖掘机各参考线之间的连接关系得出各个参考线之间的角度,进一步计算得到对应的参考角度,结合实际挖掘机操作,通过挖掘机机械参数、参考线、参考角度,及由动臂倾角传感器得到的动臂倾角计算动臂旋转角度。
同时,本发明较佳示例的挖掘机的动臂支点、底盘中心、及各机械臂等之间存在连接关系的结构,为刚性连接关系,各个位置及角度相互间存在对应关系,由建立的挖掘机运动学模型可计算出各自对应的关系,当中涉及的计算方法为常规计算手段。
步骤S4、计算挖掘机斗杆旋转角度
根据斗杆倾角传感器测量得到的斗杆倾角、S3计算得到的动臂旋转角度,通过本发明较佳示例建立的挖掘机运动学模型计算斗杆旋转角度。
步骤S5、计算挖掘机铲斗旋转角度
根据铲斗倾角传感器测量得到的铲斗倾角、S3得到的动臂旋转角度、S4得到的斗杆旋转角度计算斗杆旋转角度;
步骤S6、计算铲尖位置
根据动臂支点坐标,通过建立DH矩阵模型计算铲尖位置。
该计算铲尖位置的步骤可拆分为以下步骤:
步骤S61、在以挖掘机动臂支点为载体坐标系原点的基础上,于动臂支点建立DH坐标系,结合步骤S3、S4、S5的计算针对DH坐标系进行推算,同时,根据建立的挖掘机运动学模型结合上述步骤的计算可得到DH参数。利用DH矩阵,对于多自由度的挖掘机机械臂具有很好的适应性,即使机械臂较多的情况依旧能够确定计算定位。
步骤S61、将上一步骤得到的DH参数代入DH矩阵,同时,结合的动臂支点坐标对铲尖坐标进行推算,但由于地理坐标系和导航坐标系物理定义不一致,根据二者的物理定义结合数学进行形式转换,得出铲尖于地理坐标系的坐标,从而定位铲尖,由挖掘机控制室根据定位结果进行作业。
铲尖于地理坐标系的坐标为:
其中,为动臂支点的地理坐标,/>为铲尖中间位置坐标,为铲尖中间位置在地理坐标系中的相对位置矢量。
具体实施示例如下:
于动臂支点处建立DH坐标系,其中,Xi与Zi-1垂直,Xi与Zi-1相交,根据挖掘机运动学模型可得DH参数,如表所示:
表中:αi为从Zi到Zi+1绕Xi逆时针旋转角度;di为从Zi到Zi+1沿Xi+1平移的距离;li为从Xi到Xi+1沿Zi平移的距离;θi为从Xi到Xi+1绕Zi逆时针旋转角度。
i相对于i+1的变化矩阵为:
代入参数,得到
由于地理坐标系和导航坐标系定义不一致,需要进行旋转。/>为先绕地理坐标系Z轴转-90度,然后再绕地理坐标系X轴转-90度,得出:
代入上式:
进一步地,
代入动臂支点的地理坐标,即可得出铲尖的地理坐标:
本发明较佳示例的公式,结果均定义为地理坐标系中的坐标情况,公式的推算过程为常规计算手段,在此不赘述。
因采用的计算手段略有不同,本发明所示例的计算方法、计算结果根据实际操作及测量结果可以存在一定的差异,而这些差异属于本发明保护范围内。
本发明涉及的挖掘机及其铲斗定位方法,以卫星定位为基础,结合动态传感器建立挖掘机运动学模型,采用动臂支点作为载体坐标系的原点,结合DH矩阵模型精确计算铲尖位置,通过卫星定位及动态传感器测量精度、灵敏度高,对施工环境要求较低、环境适应性强,且利用DH矩阵对于多自由角度的挖掘机机械臂具有很好的适应性,在机械臂较多的情况下依旧能够保证计算的精准度,该挖掘机及其铲斗定位方法能够对挖掘机进行精确计算定位。
对本领域的技术人员来说,可根据以上描述的技术方案以及构思,做出其它各种相应的改变以及形变,而所有的这些改变以及形变都应该属于本发明权利要求的保护范围之内。
Claims (7)
1.一种铲斗定位方法,应用于挖掘机,其特征在于,所述挖掘机设有四个动态传感器,包括车身倾角传感器、动臂倾角传感器、斗杆倾角传感器、铲斗倾角传感器,所述车身倾角传感器设于所述挖掘机车身以测量所述车身倾角、所述动臂倾角传感器设于所述挖掘机动臂以测量所述动臂倾角、所述斗杆倾角传感器设于所述挖掘机斗杆以测量所述斗杆倾角、所述铲斗倾角传感器设于所述挖掘机铲斗以测量所述铲斗倾角;
包括以下步骤:
步骤S1、建立挖掘机运动学模型:采用右手定则规定正方向,建立的坐标系包括地理坐标系、导航坐标系、载体坐标系,动臂坐标系、斗杆坐标系、铲斗坐标系、铲尖坐标系和根据GNSS建立的卫星坐标系;
其中,所述载体坐标系的原点设于所述挖掘机动臂支点,所述导航坐标系的原点设于所述挖掘机底盘旋转中心位置;
俯仰角为所述导航坐标系绕所述地理坐标系X轴旋转的欧拉角,横滚角为所述导航坐标系绕所述地理坐标系Y轴旋转的欧拉角,航向角为所述导航坐标系绕所述地理坐标系Z轴旋转的欧拉角;
步骤S2、计算动臂支点坐标:根据天线相位中心在地理坐标系中的坐标,及由RTK测量得到的天线相位中心在地理坐标系中的位置矢量,计算所述动臂支点坐标;
步骤S3、计算挖掘机动臂旋转角度:通过挖掘机机械参数、所述动臂倾角计算动臂旋转角度;
步骤S4、计算挖掘机斗杆旋转角度:根据所述斗杆倾角、所述动臂旋转角度计算斗杆旋转角度;
步骤S5、计算挖掘机铲斗旋转角度:根据所述铲斗倾角、所述动臂旋转角度、所述斗杆旋转角度计算铲斗旋转角度;
步骤S6、计算铲尖位置:根据所述动臂支点坐标,通过建立DH矩阵模型计算所述铲尖位置。
2.根据权利要求1所述的铲斗定位方法,其特征在于,所述步骤S6还包括以下步骤:
步骤S61、于所述动臂支点建立DH坐标系,根据所述挖掘机运动学模型得到DH参数;
步骤S62、根据所述DH参数及所述动臂支点坐标计算所述铲尖坐标,获取所述铲尖位置。
3.根据权利要求1-2中任意一项所述的铲斗定位方法,其特征在于,所述载体坐标系的原点设于所述挖掘机动臂支点,用右手定则规定正方向,所述载体坐标系X轴正向指向所述挖掘机驾驶室右侧,所述载体坐标系Y轴正向指向所述挖掘机车头方向,所述载体坐标系Z轴正向指向所述挖掘机顶部。
4.根据权利要求1-2中任意一项所述的铲斗定位方法,其特征在于,定义所述动臂于所述挖掘机机身的所述动臂支点为第一机械点、所述挖掘机动臂油缸与所述动臂连接处为第二机械点、所述动臂与所述挖掘机斗杆连接处为第三机械点,所述斗杆与所述挖掘机斗杆油缸间设有第一连杆,所述斗杆油缸与所述挖掘机铲斗间设有第二连杆,定义所述第一连杆与所述斗杆连接处为第四机械点、所述斗杆与所述铲斗连接处为第五机械点、所述第二连杆与所述斗杆油缸连接处为第六机械点、所述第二连杆与所述铲斗连接处为第七机械点、所述铲尖为第八机械点;所述挖掘机机械参数包括所述第一机械点与所述第二机械点连接形成的第一参考线及其长度、所述第一机械点与所述第三机械点连接形成的第二参考线及其长度、所述第二机械点与所述第三机械点连接形成的第三参考线及其长度、所述第三机械点与所述第四机械点连接形成的第四参考线及其长度、所述第三机械点与所述第五机械点连接形成的第五参考线及其长度、所述第四机械点与所述第五机械点连接形成的第六参考线及其长度、所述第四机械点与所述第六机械点连接形成的第七参考线及其长度、所述第五机械点与所述第七机械点连接形成的第八参考线及其长度、所述第六机械点与所述第七机械点连接形成的第九参考线及其长度、所述第六机械点与所述第八机械点连接形成的第十参考线及其长度。
5.根据权利要求4中任意一项所述的铲斗定位方法,其特征在于,所述动臂倾角传感器设于所述第二参考线,所述斗杆倾角传感器设于所述第五参考线,所述铲斗倾角传感器设于所述第十参考线。
6.一种电子设备,包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,其特征在于:所述处理器执行所述程序时实现如权利要求1-5任意一项所述的铲斗定位方法。
7.一种存储介质,其上存储有计算机程序,其特征在于:
所述计算机程序被处理器执行时实现如权利要求1-5任意一项所述的铲斗定位方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811601685.XA CN109614743B (zh) | 2018-12-26 | 2018-12-26 | 挖掘机及其铲斗定位方法、电子设备、存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811601685.XA CN109614743B (zh) | 2018-12-26 | 2018-12-26 | 挖掘机及其铲斗定位方法、电子设备、存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109614743A CN109614743A (zh) | 2019-04-12 |
CN109614743B true CN109614743B (zh) | 2023-11-21 |
Family
ID=66012457
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811601685.XA Active CN109614743B (zh) | 2018-12-26 | 2018-12-26 | 挖掘机及其铲斗定位方法、电子设备、存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109614743B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110409546B (zh) * | 2019-07-25 | 2021-12-14 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种挖掘机的电控系统及正流量系统挖掘机 |
CN110939135A (zh) * | 2019-11-19 | 2020-03-31 | 中交疏浚技术装备国家工程研究中心有限公司 | 应用于斜坡摊铺工程机械作业的定位定向方法及系统 |
CN111679306B (zh) * | 2020-06-18 | 2023-09-26 | 万宝矿产有限公司 | 一种基于卫星导航的挖掘机智能化高精度定位方法 |
CN111851614A (zh) * | 2020-07-03 | 2020-10-30 | 中联重科股份有限公司 | 用于为工程机械作业照明的方法、装置和系统及工程机械 |
CN111708067B (zh) * | 2020-08-04 | 2022-04-12 | 中国铁道科学研究院集团有限公司铁道建筑研究所 | 挖掘机自动引导系统 |
CN112012263A (zh) * | 2020-08-26 | 2020-12-01 | 上海三一重机股份有限公司 | 工作灯调节方法、装置及工作灯控制系统 |
CN113107044A (zh) * | 2021-04-21 | 2021-07-13 | 立澈(上海)自动化有限公司 | 挖掘机的铲斗位置确定方法、装置以及电子设备 |
CN113280736B (zh) * | 2021-06-10 | 2022-07-22 | 雷沃工程机械集团有限公司 | 一种装载机铲斗位置检测方法及设备 |
CN115950356A (zh) * | 2022-12-26 | 2023-04-11 | 江苏徐工工程机械研究院有限公司 | 铲斗坐标标定方法和装置、更新方法和设备、挖掘机 |
CN115795580B (zh) * | 2023-02-10 | 2023-05-26 | 安徽省(水利部淮河水利委员会)水利科学研究院(安徽省水利工程质量检测中心站) | 基于云计算的智能开挖施工管理系统 |
CN117435853B (zh) * | 2023-12-21 | 2024-03-01 | 山东科技大学 | 一种破土点位坐标计算方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20170020692A (ko) * | 2015-08-13 | 2017-02-23 | 한서대학교 산학협력단 | 굴삭기 최대 굴삭력 시뮬레이션 방법, 이를 실행하는 장치 및 기록 매체에 저장된 굴삭력 시뮬레이션 컴퓨터 프로그램 |
KR101793961B1 (ko) * | 2017-05-08 | 2017-11-06 | (주) 벽강산기 | 로테이팅 암 제어시스템을 가지는 굴삭기 |
CN107740448A (zh) * | 2017-11-30 | 2018-02-27 | 南京工业大学 | 一种无人自动化挖掘机智能施工系统 |
CN107905275A (zh) * | 2017-11-15 | 2018-04-13 | 山东天星北斗信息科技有限公司 | 一种挖掘机数字化辅助施工系统及其辅助施工方法 |
CN107916684A (zh) * | 2017-12-26 | 2018-04-17 | 青岛雷沃工程机械有限公司 | 高精度坐标测量挖掘机 |
CN108549771A (zh) * | 2018-04-13 | 2018-09-18 | 山东天星北斗信息科技有限公司 | 一种挖掘机辅助施工系统及方法 |
CN108705531A (zh) * | 2018-04-17 | 2018-10-26 | 上海达野智能科技有限公司 | 工业机器人的运动学参数标定方法、标定系统、电子设备 |
-
2018
- 2018-12-26 CN CN201811601685.XA patent/CN109614743B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20170020692A (ko) * | 2015-08-13 | 2017-02-23 | 한서대학교 산학협력단 | 굴삭기 최대 굴삭력 시뮬레이션 방법, 이를 실행하는 장치 및 기록 매체에 저장된 굴삭력 시뮬레이션 컴퓨터 프로그램 |
KR101793961B1 (ko) * | 2017-05-08 | 2017-11-06 | (주) 벽강산기 | 로테이팅 암 제어시스템을 가지는 굴삭기 |
CN107905275A (zh) * | 2017-11-15 | 2018-04-13 | 山东天星北斗信息科技有限公司 | 一种挖掘机数字化辅助施工系统及其辅助施工方法 |
CN107740448A (zh) * | 2017-11-30 | 2018-02-27 | 南京工业大学 | 一种无人自动化挖掘机智能施工系统 |
CN107916684A (zh) * | 2017-12-26 | 2018-04-17 | 青岛雷沃工程机械有限公司 | 高精度坐标测量挖掘机 |
CN108549771A (zh) * | 2018-04-13 | 2018-09-18 | 山东天星北斗信息科技有限公司 | 一种挖掘机辅助施工系统及方法 |
CN108705531A (zh) * | 2018-04-17 | 2018-10-26 | 上海达野智能科技有限公司 | 工业机器人的运动学参数标定方法、标定系统、电子设备 |
Non-Patent Citations (1)
Title |
---|
王太海 ; 陈建宏 ; 金俊 ; .基于挖掘机GNSS精确定位的开采姿态监测系统.黄金科学技术.2016,(04),全文. * |
Also Published As
Publication number | Publication date |
---|---|
CN109614743A (zh) | 2019-04-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109614743B (zh) | 挖掘机及其铲斗定位方法、电子设备、存储介质 | |
CN107905275B (zh) | 一种挖掘机数字化辅助施工系统及其辅助施工方法 | |
JP5873607B1 (ja) | 作業機械の較正装置、及び作業機械の作業機パラメータの較正方法 | |
EP3597831A1 (en) | Construction machinery | |
JP5841300B1 (ja) | 作業機械の較正装置、及び作業機械の作業機パラメータの較正方法 | |
CN103852059B (zh) | 反铲挖掘机的铲斗定位装置及方法 | |
WO2023072044A1 (zh) | 挖掘机铲斗齿尖定位方法、装置和挖掘机 | |
EP3865914A1 (en) | Gnss/imu surveying and mapping system and method | |
JP6966218B2 (ja) | 撮像装置の校正装置、作業機械および校正方法 | |
CN111380573B (zh) | 用于校准运动的对象传感器的取向的方法 | |
CN113047353B (zh) | 一种挖掘机智能施工引导系统及方法 | |
CN112684432B (zh) | 激光雷达标定方法、装置、设备及存储介质 | |
CN111637888B (zh) | 基于惯导和激光雷达单点测距的掘进机定位方法及系统 | |
CN109444936A (zh) | 一种利用gnss和倾角传感器确定斗尖坐标的方法 | |
CN113494104B (zh) | 建设作业机械的定位校正方法及其定位校正控制器 | |
CN111679306A (zh) | 一种基于卫星导航的挖掘机智能化高精度定位方法 | |
CN107255446B (zh) | 一种矮化密植果树冠层三维地图构建系统和方法 | |
CN110926459A (zh) | 一种多波束数据的处理方法、设备及其存储介质 | |
CN112987069B (zh) | 一种基于车体位姿的作业部件末端位姿测量方法 | |
CN108594281A (zh) | 基于载波相位差分技术的挖掘设备水平定姿定位辅助方法 | |
CN216049921U (zh) | 一种高精度大水深水下工程定位系统 | |
WO2021253958A1 (zh) | 一种基于卫星导航的挖掘机智能化高精度定位方法 | |
CN114489041A (zh) | 矿区无人驾驶车辆的装载点位置的指定方法和指定系统 | |
CN106908036A (zh) | 一种基于局部偏移的auv多波束数据构图方法 | |
CN111521996A (zh) | 一种激光雷达的安装标定方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20220613 Address after: 511400 Room 202, Building 13, Tian'an Headquarters Center, 555 North Panyu Avenue, Donghuan Street, Panyu District, Guangzhou City, Guangdong Province Applicant after: GUANGZHOU HI-TARGET SURVEYING INSTRUMENT Co.,Ltd. Address before: 511400 No. 106 Fengze East Road, Nansha District, Guangzhou City, Guangdong Province (self compiled Building 1) x1301-a4669 (cluster registration) (JM) Applicant before: GUANGZHOU HAIDA ANKONG TECHNOLOGY Co.,Ltd. |
|
TA01 | Transfer of patent application right | ||
GR01 | Patent grant | ||
GR01 | Patent grant |