CN107905275A - 一种挖掘机数字化辅助施工***及其辅助施工方法 - Google Patents
一种挖掘机数字化辅助施工***及其辅助施工方法 Download PDFInfo
- Publication number
- CN107905275A CN107905275A CN201711125918.9A CN201711125918A CN107905275A CN 107905275 A CN107905275 A CN 107905275A CN 201711125918 A CN201711125918 A CN 201711125918A CN 107905275 A CN107905275 A CN 107905275A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- msubsup
- mtd
- mtr
- 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.)
- Granted
Links
Classifications
-
- 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
- E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
-
- 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/425—Drive systems for dipper-arms, backhoes or the like
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Operation Control Of Excavators (AREA)
- Component Parts Of Construction Machinery (AREA)
- Mobile Radio Communication Systems (AREA)
Abstract
本发明公开了一种挖掘机数字化辅助施工***及其辅助施工方法,***包括GNSS天线与接收机、IMU设备、单轴倾角传感器、双轴姿态传感器和智能控制终端。本发明采用GNSS/INS组合导航技术,通过机身尺寸与GNSS天线的相对位置关系推算出挖掘机铲齿在WGS84坐标系下的坐标。根据挖掘机铲齿的坐标建模,然后在智能控制终端实时显示挖掘机铲齿模型在工程目标区域地图中的位置,辅助操作者完成施工。本发明的挖掘机辅助施工***具有实时性、精度高、操作方便等特点,降低了施工中对操作者技术的要求,提高了作业精度和效率,使得工程管理变得更加灵活。
Description
技术领域
本发明涉及一种挖掘机领域,具体涉及一种挖掘机数字化辅助施工***。
背景技术
现代施工建设的作业任务和类型日益繁多,挖掘机在各种工程领域中的应用日益广泛,同时各项工程对工程质量和施工工期的要求也越来越高。这对挖掘机的施工精度和操作者的熟练程度提出了较高要求。然而在实际操作过程中,因为挖掘机装置和操作者的原因,会出现一系列问题,导致了施工效率和精度变低。目前市场上大多数挖掘机都不带有辅助施工***,在进行作业时,主要靠操作者的技术和经验,一次施工后的作业面与标准作业面有较大的差距,这种施工模式阻碍了工程建设的发展。
发明内容
发明目的:针对上述现有技术,提出一种挖掘机数字化辅助施工***,能够实时得到挖掘机及其铲斗在WGS84坐标系下的三维坐标,设置好目标点坐标后引导操作者进行施工。
技术方案:一种挖掘机数字化辅助施工***,包括:
固定设置在挖掘机机身上的GNSS主站天线、GNSS从站天线以及接收机;所述接收机用于根据所述GNSS主站天线和GNSS从站天线接收到的信号解算所述GNSS主站天线在WGS84坐标系下的坐标以及GNSS主从站天线方位角;
固定在铲斗和斗杆连接处,用于测量铲斗摇杆与水平面夹角的铲斗角度传感器;
固定在斗杆上,用于测量斗杆与水平面夹角的斗杆角度传感器;
固定在动臂上,用于测量动臂与水平面夹角的动臂角度传感器;
固定在挖掘机机身上,用于测量挖掘机机身横滚角和俯仰角的双轴姿态传感器;
智能控制终端,所述智能控制终端包括存储器、处理器、显示器以及存储在存储器上并可在处理器上运行的计算机程序,所述处理器在执行所述计算机程序时实现以下步骤:
步骤a:根据所述GNSS主站天线在WGS84坐标系下的坐标、所述GNSS主从站天线方位角、所述铲斗角度传感器的输出值、所述斗杆角度传感器的输出值、动臂角度传感器的输出值、双轴姿态传感器的输出值、以及挖掘机身尺寸参数计算得到挖掘机铲齿的二维/三维坐标;
步骤b:根据获取的工程目标区域,控制所述显示器显示所述工程目标区域地图;
步骤c:根据所述挖掘机铲齿的二维/三维坐标建模,然后在所述显示器上实时显示挖掘机铲齿模型在所述工程目标区域地图中的位置。
进一步的,还包括固定在所述挖掘机身上,用于辅助定位的IMU设备。
进一步的,所述GNSS主站天线和GNSS从站天线固定设置在挖掘机尾部,两天线的连线与挖掘机纵向主轴垂直。
进一步的,所述斗杆角度传感器为固定在斗杆上并与斗杆主轴垂直设置的单轴倾角传感器,所述动臂角度传感器固定在动臂上并与动臂主轴垂直设置的单轴倾角传感器。
进一步的,所述工程目标区域根据人机交互设备输入二维/三维坐标获得。
进一步的,所述工程目标区域根据通过挖掘机铲齿置于目标区域边界线/边界顶点后,利用所述步骤a获得掘机铲齿的二维坐标即所述目标区域边界线/边界顶点的二维坐标/三维坐标,然后通过人机交互设备输入挖掘深度值后,在显示器上生成所述目标区域的三维图像。
进一步的,所述步骤a包括如下具体步骤:
步骤a1:对所述双轴姿态传感器输出的俯仰角θobs进行转换后用于构建旋转矩阵,具体为:
其中,θcal为转换后用于构建旋转矩阵的俯仰角;γ为所述双轴姿态传感器(10)输出的横滚角;
步骤a2:构建挖掘机身姿态旋转矩阵为:
Rattitude=R2(γ)R1(θcal) (2)
其中,Rattitude为姿态旋转矩阵;Ri(radian)表示绕笛卡尔坐标系第i轴旋转radian弧度的旋转矩阵,i=1,2;
步骤a3:以挖掘机回转接头为坐标原点,以挖掘机前进方向为y轴,过坐标原点且垂直于y轴为x轴,z轴与x、y轴构成右手坐标系,建立车身三维坐标系,根据挖掘机机身姿态对GNSS主从站天线的基线方向进行修正,具体为:
Brot=RattitudeB (3)
αB=arctan2(yBrot,xBrot) (4)
ψcal=90-(ψobs-αB) (5)
其中,B为车身坐标系下的基线向量;Brot为进行姿态旋转后的基线向量;xBrot、yBrot分别为Brot的x、y方向的分量;arctan2(y,x)为方位角计算函数;αB为旋转后基线向量的方位角;ψobs为GNSS定位定向设备测得的方位角;ψcal为修正后的航向角;
步骤a4:建立直角坐标系如下:取y轴和z轴所在平面上的一点P1为坐标原点,且已知该点与挖掘机回转接头的坐标差值,m轴与车身坐标系的y轴平行且方向相同,n轴与车身坐标系的z轴平行且方向相同,建立m、P1、n二维平面直角坐标系,则求得P1、P2、P3坐标如下
其中,P1为动臂与挖掘机身旋转连接点,P2为动臂与斗杆旋转连接点,P3为斗杆与铲斗旋转连接点;为P1与P2之间的距离;为P2与P3之间的距离;α1为动臂角度传感器测得的角度值;α2为斗杆角度传感器测得的角度值;
再计算P10、P9坐标如下:
其中,P10为斗杆与摇杆的连接点;P9为摇杆与连杆的连接点;为P3与P10之间的距离;为P9与P10之间的距离;为点P2、P3连线与点P3、P10连线的夹角;α3为铲斗角度传感器测得的角度值;
根据P11至P3与P9距离为定值得到:
其中,P11为连杆与铲斗的连接点;为P3与P11之间的距离;为P9与P11之间的距离;
用xi与yi表示Pi的m轴分量与n轴分量,i取3、11,将式(11)改写为:
使用牛顿迭代法对式(12)进行求解,则用于牛顿迭代的递推公式为:
其中:
其中,与为上一步迭代的结果,x11与y11为本次迭代的结果;用P10点坐标相对于P3和P9点的连线做对称来作为P11初值;
再由P3和P11坐标计算两点的方向
在计算P3至P12的方向
则得到P12的坐标为:
其中,点P11、P3连线与点P3、P12连线的夹角;P12为铲齿;为P3与P12之间的距离。
进一步的,还包括对坐标增量进行俯仰角改正的步骤,具体包括如下步骤:
步骤a5:首先以P1为坐标系零点,车身坐标系的X轴作为X轴,在水平面上与X轴垂直且指向工作装置朝向的方向为Y轴,Z轴与X轴、Y轴组成右手坐标系,建立三维工作装置坐标系,则P12坐标可如式(18)在该坐标系下表示为
所述三维工作装置坐标系与所述车身坐标系之间相差一个俯仰角的旋转,因此按式(19)推算车身坐标系下的P12坐标
步骤a6:计算车身坐标系下所述GNSS主站天线至P12的坐标增量
其中,为车身坐标系下所述GNSS主站天线至P1的坐标增量;
步骤a7:计算修正后的铲齿坐标pos12为:
其中,posa1为所述接收机输出的所述GNSS主站天线坐标。
一种挖掘机数字化辅助施工***的辅助挖坑方法,对于短坑,首先将铲齿分别置于目标坑的四个边界顶点,拾取点坐标为a,b,c,d并存储;对于长坑,首先将铲齿置于任一短边的两个端点及长边上任意一点,拾取点坐标为a,b,c并存储;然后输入设计坑深,在智能控制终端上生成目标坑的三维图像;操作者根据铲齿模型在图像的位置进行作业,在超挖或欠挖时,智能控制终端上显示到目标点/边的距离,操作者根据提示完成作业。
一种挖掘机数字化辅助施工***的辅助修坡方法,将挖掘机铲齿放到坡底,拾取坡底点的坐标,移动铲齿至坡顶,拾取坡顶点坐标,存储两点坐标;在能控制终端中选择参考模型,建立整个坡的三维模型;开始施工,作业平面和铲齿模型以三维图像的形式显示在智能控制终端上,操作者根据提示进行修坡。
有益效果:本发明的挖掘机数字化辅助施工***及其辅助施工方法,运用GNSS/INS导航定位技术实时解算出挖掘机机身和铲齿在WGS84坐标系下的三维坐标。获取目标点坐标后,该***可以辅助操作者完成挖坑、修坡功能,降低了工程的难度,提高了工作效率。
附图说明
图1是本发明挖掘机数字化辅助施工***的结构示意图;
图2是挖掘机结构简化示意图;
图3是本发明辅助挖坑功能流程图;
图4是本发明辅助修坡功能流程图;
图中:挖掘机机身1、铲斗2、斗杆3、动臂4、GNSS主站天线5、GNSS从站天线6、铲斗角度传感器7、斗杆角度传感器8、动臂角度传感器9、双轴姿态传感器10、接收机11、智能控制终端12、集线盒13、IMU设备14、掘机回转接头15、铲斗摇杆16、连杆17、铲齿18。
具体实施方式
下面结合附图对本发明做更进一步的解释。
一种挖掘机数字化辅助施工***,如图1所示,包括GNSS主站天线5、GNSS从站天线6、铲斗角度传感器7、斗杆角度传感器8、动臂角度传感器9、双轴姿态传感器10、接收机11、智能控制终端12、集线盒13以及IMU设备14。
GNSS主站天线5和GNSS从站天线6固定设置在挖掘机机身1的尾部位置,两天线的连线与挖掘机纵向主轴垂直,接收机11于挖掘机机身1固定。接收机11用于根据GNSS主站天线5和GNSS从站天线6接收到的信号解算GNSS主站天线5在WGS84坐标系下的坐标以及GNSS主从站天线方位角。及IMU设备14用于在已知挖掘机起始坐标的情况下,在一定时间段内可以获得较高精度的载体坐标,弥补了GNSS设备在外界环境较差时无法获得高精度定位的缺陷,以达到高精度无缝定位。
铲斗角度传感器7固定在铲斗2和斗杆3连接处,用于测量铲斗摇杆16与水平面夹角。斗杆角度传感器8为固定在斗杆3上并与斗杆主轴垂直设置的单轴倾角传感器,用于测量斗杆3与水平面夹角。动臂角度传感器9为固定在动臂4上并与动臂主轴垂直设置的单轴倾角传感器,用于测量动臂4与水平面夹角的动臂角度传感器9。双轴姿态传感器10固定在挖掘机机身1上水平的位置,用于测量挖掘机机身1横滚角和俯仰角。
铲斗角度传感器7、斗杆角度传感器8、动臂角度传感器9、双轴姿态传感器10、接收机11以及IMU设备14通过集线盒13连接到智能控制终端12,智能控制终端12设置于驾驶室内。智能控制终端12包括存储器、处理器、显示器以及存储在存储器上并可在处理器上运行的计算机程序,处理器在执行计算机程序时实现以下步骤:
步骤a:根据GNSS主站天线5在WGS84坐标系下的坐标、GNSS主从站天线方位角、铲斗角度传感器7的输出值、斗杆角度传感器8的输出值、动臂角度传感器9的输出值、双轴姿态传感器10的输出值、以及挖掘机身尺寸参数计算得到挖掘机铲齿的二维/三维坐标。步骤a包括如下具体步骤:
步骤a1:对双轴姿态传感器10输出的俯仰角θobs进行转换后用于构建旋转矩阵,具体为:
其中,θcal为转换后用于构建旋转矩阵的俯仰角;γ为双轴姿态传感器10输出的横滚角。
步骤a2:构建挖掘机身姿态旋转矩阵为:
Rattitude=R2(γ)R1(θcal) (2)
其中,Rattitude为姿态旋转矩阵;Ri(radian)表示绕笛卡尔坐标系第i轴旋转radian弧度的旋转矩阵,i=1,2。
步骤a3:以挖掘机回转接头15为坐标原点,以挖掘机前进方向为y轴,过坐标原点且垂直于y轴为x轴,z轴与x、y轴构成右手坐标系,建立车身三维坐标系,根据挖掘机机身姿态对GNSS主从站天线的基线方向进行修正,具体为:
Brot=RattitudeB (3)
ψcal=90-(ψobs-αB) (5)
其中,B为车身坐标系下的基线向量;Brot为进行姿态旋转后的基线向量; 分别为Brot的x、y方向的分量;arctan2(y,x)为方位角计算函数;αB为旋转后基线向量的方位角;ψobs为GNSS定位定向设备测得的方位角;ψcal为修正后的航向角。
步骤a4:根据如图2所示的挖掘机结构简化示意图,建立直角坐标系如下:取y轴和z轴平面上的一点P1为坐标原点,且已知该点与挖掘机回转接头15的坐标差值,m轴与车身坐标系的y轴平行且方向相同,n轴与车身坐标系的z轴平行且方向相同,建立m、P1、n二维平面直角坐标系,则求得P1、P2、P3坐标如下:
其中,P1为动臂4与挖掘机身1旋转连接点,P2为动臂4与斗杆3旋转连接点,P3为斗杆3与铲斗2旋转连接点;为P1与P2之间的距离;为P2与P3之间的距离;α1为动臂角度传感器9测得的角度值;α2为斗杆角度传感器8测得的角度值。
再计算P10、P9坐标如下:
其中,P10为斗杆与摇杆的连接点;P9为摇杆与连杆的连接点;为P3与P10之间的距离;为P9与P10之间的距离;为点P2、P3连线与点P3、P10连线的夹角;α3为铲斗角度传感器7测得的角度值。
根据P11至P3与P9距离为定值得到:
其中,P11为连杆与铲斗的连接点;为P3与P11之间的距离;为P9与P11之间的距离。
用xi与yi表示Pi的m轴分量与n轴分量,i取3、11,将式(11)改写为:
使用牛顿迭代法对式(12)进行求解,则用于牛顿迭代的递推公式为:
其中:
其中,与为上一步迭代的结果,x11与y11为本次迭代的结果;用P10点坐标相对于P3和P9点的连线做对称来作为P11初值。
再由P3和P11坐标计算两点的方向
在计算P3至P12的方向
则得到P12的坐标为:
其中,点P11、P3连线与点P3、P12连线的夹角;P12为铲齿;为P3与P12之间的距离。
还包括对坐标增量进行俯仰角改正的步骤,具体包括如下步骤:
步骤a5:首先以P1为坐标系零点,车身坐标系的X轴作为X轴,在水平面上与X轴垂直且指向工作装置朝向的方向为Y轴,Z轴与X轴、Y轴组成右手坐标系,建立三维工作装置坐标系,则P12坐标可如式(18)在该坐标系下表示为
三维工作装置坐标系与车身坐标系之间相差一个俯仰角的旋转,因此按式(19)推算车身坐标系下的P12坐标
步骤a6:计算车身坐标系下GNSS主站天线至P12的坐标增量
其中,为车身坐标系下所述GNSS主站天线至P1的坐标增量。
步骤a7:计算修正后的铲齿坐标pos12为:
其中,posa1为接收机11输出的GNSS主站天线坐标。
步骤b:根据获取的工程目标区域,控制显示器显示工程目标区域地图。其中,工程目标区域有两种获取方法,其中一种为通过人机交互设备输入二维/三维坐标获得,另一种为,利用步骤a获得掘机铲齿的二维坐标即目标区域边界线/边界顶点的二维坐标,然后通过人机交互设备输入挖掘深度值后,在显示器上生成目标区域的三维图像。
步骤c:根据挖掘机铲齿的二维/三维坐标建模,控制在显示器实时显示挖掘机铲齿模型在所述工程目标区域地图中的位置,智能控制终端12从而可以引导操作者进行施工。
本***在施工区域建立基站或使用当地CORS站,使用载波差分定位技术定位,得到挖掘机机身的三维坐标后,根据机身尺寸参数和传感器输出参数计算出铲齿的三维坐标并建模,精度为2-5cm;当周围环境遮挡较为严重时,GNSS定位效果较差,使用INS进行定位,保证定位定向的无缝连接;然后通过智能控制终端12显示铲齿建模在工程目标区域地图中的实时位置,使其在目标区域地图中显示,操作者可以实时掌握铲斗的姿态和位置,不仅提高了作业精度,而且降低了对操作者的技术要求,工作效率大大提高。
上述基站为在测区内建立的半永久性装置,基站接收机需架设在有强制对中装置的固体桩上,并且已知该点的精确三维坐标。通过电台对测区内的流动站接收机发送差分信息进行载波差分,覆盖范围十公里左右。
根据上述挖掘机数字化辅助施工***的辅助挖坑方法:对于短坑,首先将铲齿分别置于目标坑的四个边界顶点,拾取点坐标为a,b,c,d并存储;对于长坑,首先将铲齿置于任一短边的两个端点及长边上任意一点,拾取点坐标为a,b,c并存储;然后输入设计坑深,在智能控制终端上生成目标坑的三维图像;操作者根据铲齿模型在图像的位置进行作业,在超挖或欠挖时,智能控制终端能够显示到目标点/边的距离,操作者根据提示完成作业。
根据上述挖掘机数字化辅助施工***的辅助修坡方法:将挖掘机铲齿放到坡底,拾取坡底点的坐标S,移动铲齿至坡顶,拾取坡顶点坐标E,存储两点坐标;在控制器中选择参考模型,建立整个坡的三维模型;开始施工,作业平面和铲齿模型以三维图像的形式显示在智能控制终端上,操作者根据提示进行修坡,如果铲斗挖的过多和过少,智能控制终端将提示操作者。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (10)
1.一种挖掘机数字化辅助施工***,其特征在于,包括:
固定设置在挖掘机机身(1)上的GNSS主站天线(5)、GNSS从站天线(6)以及接收机(11);所述接收机(11)用于根据所述GNSS主站天线(5)和GNSS从站天线(6)接收到的信号解算所述GNSS主站天线(5)在WGS84坐标系下的坐标以及GNSS主从站天线方位角;
固定在铲斗(2)和斗杆(3)连接处,用于测量铲斗摇杆与水平面夹角的铲斗角度传感器(7);
固定在斗杆(3)上,用于测量斗杆(3)与水平面夹角的斗杆角度传感器(8);
固定在动臂(4)上,用于测量动臂(4)与水平面夹角的动臂角度传感器(9);
固定在挖掘机机身(1)上,用于测量挖掘机机身(1)横滚角和俯仰角的双轴姿态传感器(10);
智能控制终端(12),所述智能控制终端(12)包括存储器、处理器、显示器以及存储在存储器上并可在处理器上运行的计算机程序,所述处理器在执行所述计算机程序时实现以下步骤:
步骤a:根据所述GNSS主站天线(5)在WGS84坐标系下的坐标、所述GNSS主从站天线方位角、所述铲斗角度传感器(7)的输出值、所述斗杆角度传感器(8)的输出值、动臂角度传感器(9)的输出值、双轴姿态传感器(10)的输出值、以及挖掘机身尺寸参数计算得到挖掘机铲齿的二维/三维坐标;
步骤b:根据获取的工程目标区域,控制所述显示器显示所述工程目标区域地图;
步骤c:根据所述挖掘机铲齿的二维/三维坐标建模,然后在所述显示器上实时显示挖掘机铲齿模型在所述工程目标区域地图中的位置。
2.根据权利要求1所述的挖掘机数字化辅助施工***,其特征在于,还包括固定在所述挖掘机身(1)上,用于辅助定位的IMU设备(14)。
3.根据权利要求1所述的挖掘机数字化辅助施工***,其特征在于,所述GNSS主站天线(5)和GNSS从站天线(6)固定设置在挖掘机尾部,两天线的连线与挖掘机纵向主轴垂直。
4.根据权利要求1所述的挖掘机数字化辅助施工***,其特征在于,所述斗杆角度传感器(8)为固定在斗杆(3)上并与斗杆主轴垂直设置的单轴倾角传感器,所述动臂角度传感器(9)固定在动臂(4)上并与动臂主轴垂直设置的单轴倾角传感器。
5.根据权利要求1所述的挖掘机数字化辅助施工***,其特征在于,所述工程目标区域根据人机交互设备输入二维/三维坐标获得。
6.根据权利要求1所述的挖掘机数字化辅助施工***,其特征在于,所述工程目标区域根据通过挖掘机铲齿置于目标区域边界线/边界顶点后,利用所述步骤a获得掘机铲齿的二维坐标即所述目标区域边界线/边界顶点的二维坐标/三维坐标,然后通过人机交互设备输入挖掘深度值后,在显示器上生成所述目标区域的三维图像。
7.根据权利要求1所述的挖掘机数字化辅助施工***,其特征在于,所述步骤a包括如下具体步骤:
步骤a1:对所述双轴姿态传感器(10)输出的俯仰角θobs进行转换后用于构建旋转矩阵,具体为:
<mrow>
<msub>
<mi>&theta;</mi>
<mrow>
<mi>c</mi>
<mi>a</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>=</mo>
<mi>arcsin</mi>
<mfrac>
<mrow>
<msub>
<mi>sin&theta;</mi>
<mrow>
<mi>o</mi>
<mi>b</mi>
<mi>s</mi>
</mrow>
</msub>
</mrow>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&gamma;</mi>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,θcal为转换后用于构建旋转矩阵的俯仰角;γ为所述双轴姿态传感器(10)输出的横滚角;
步骤a2:构建挖掘机身姿态旋转矩阵为:
Rattitude=R2(γ)R1(θcal) (2)
其中,Rattitude为姿态旋转矩阵;Ri(radian)表示绕笛卡尔坐标系第i轴旋转radian弧度的旋转矩阵,i=1,2;
步骤a3:以挖掘机回转接头(15)为坐标原点,以挖掘机前进方向为y轴,过坐标原点且垂直于y轴为x轴,z轴与x、y轴构成右手坐标系,建立车身三维坐标系,根据挖掘机机身姿态对GNSS主从站天线的基线方向进行修正,具体为:
Brot=RattitudeB (3)
<mrow>
<msub>
<mi>&alpha;</mi>
<mi>B</mi>
</msub>
<mo>=</mo>
<mi>arctan</mi>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<msub>
<mi>B</mi>
<mrow>
<mi>r</mi>
<mi>o</mi>
<mi>t</mi>
</mrow>
</msub>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<msub>
<mi>B</mi>
<mrow>
<mi>r</mi>
<mi>o</mi>
<mi>t</mi>
</mrow>
</msub>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
ψcal=90-(ψobs-αB) (5)
其中,B为车身坐标系下的基线向量;Brot为进行姿态旋转后的基线向量; 分别为Brot的x、y方向的分量;arctan2(y,x)为方位角计算函数;αB为旋转后基线向量的方位角;ψobs为GNSS定位定向设备测得的方位角;ψcal为修正后的航向角;
步骤a4:建立直角坐标系如下:取y轴和z轴所在平面上的一点P1为坐标原点,且已知该点与挖掘机回转接头(15)的坐标差值,m轴与车身坐标系的y轴平行且方向相同,n轴与车身坐标系的z轴平行且方向相同,建立m、P1、n二维平面直角坐标系,则求得P1、P2、P3坐标如下
<mrow>
<msub>
<mi>P</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>P</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mi>P</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msubsup>
<mi>L</mi>
<mn>2</mn>
<mn>1</mn>
</msubsup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>cos&alpha;</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>sin&alpha;</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>P</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<msub>
<mi>P</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msubsup>
<mi>L</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>cos&alpha;</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>sin&alpha;</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,P1为动臂(4)与挖掘机身(1)旋转连接点,P2为动臂(4)与斗杆(3)旋转连接点,P3为斗杆(3)与铲斗(2)旋转连接点;为P1与P2之间的距离;为P2与P3之间的距离;α1为动臂角度传感器(9)测得的角度值;α2为斗杆角度传感器(8)测得的角度值;
再计算P10、P9坐标如下:
<mrow>
<msub>
<mi>P</mi>
<mn>10</mn>
</msub>
<mo>=</mo>
<msub>
<mi>P</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msubsup>
<mi>L</mi>
<mn>10</mn>
<mn>3</mn>
</msubsup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<mo>&angle;</mo>
<mover>
<mrow>
<msub>
<mi>P</mi>
<mn>2</mn>
</msub>
<msub>
<mi>P</mi>
<mn>3</mn>
</msub>
<msub>
<mi>P</mi>
<mn>10</mn>
</msub>
</mrow>
<mo>&OverBar;</mo>
</mover>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&alpha;</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<mo>&angle;</mo>
<mover>
<mrow>
<msub>
<mi>P</mi>
<mn>2</mn>
</msub>
<msub>
<mi>P</mi>
<mn>3</mn>
</msub>
<msub>
<mi>P</mi>
<mn>10</mn>
</msub>
</mrow>
<mo>&OverBar;</mo>
</mover>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>P</mi>
<mn>9</mn>
</msub>
<mo>=</mo>
<msub>
<mi>P</mi>
<mn>10</mn>
</msub>
<mo>+</mo>
<msubsup>
<mi>L</mi>
<mn>10</mn>
<mn>9</mn>
</msubsup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>cos&alpha;</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>sin&alpha;</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>10</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,P10为斗杆与摇杆的连接点;P9为摇杆与连杆的连接点;为P3与P10之间的距离;为P9与P10之间的距离;为点P2、P3连线与点P3、P10连线的夹角;α3为铲斗角度传感器(7)测得的角度值;
根据P11至P3与P9距离为定值得到:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>|</mo>
<msub>
<mi>P</mi>
<mn>11</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>3</mn>
</msub>
<mo>|</mo>
<mo>=</mo>
<msubsup>
<mi>L</mi>
<mn>11</mn>
<mn>3</mn>
</msubsup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>|</mo>
<msub>
<mi>P</mi>
<mn>11</mn>
</msub>
<mo>-</mo>
<msub>
<mi>P</mi>
<mn>9</mn>
</msub>
<mo>|</mo>
<mo>=</mo>
<msubsup>
<mi>L</mi>
<mn>11</mn>
<mn>9</mn>
</msubsup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>11</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,P11为连杆与铲斗的连接点;为P3与P11之间的距离;为P9与P11之间的距离;
用xi与yi表示Pi的m轴分量与n轴分量,i取3、11,将式(11)改写为:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>11</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mn>11</mn>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>=</mo>
<msup>
<msubsup>
<mi>L</mi>
<mn>11</mn>
<mn>3</mn>
</msubsup>
<mn>2</mn>
</msup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>11</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>9</mn>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mn>11</mn>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>9</mn>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>=</mo>
<msup>
<msubsup>
<mi>L</mi>
<mn>11</mn>
<mn>9</mn>
</msubsup>
<mn>2</mn>
</msup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
使用牛顿迭代法对式(12)进行求解,则用于牛顿迭代的递推公式为:
<mrow>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msubsup>
<mi>x</mi>
<mn>11</mn>
<mn>0</mn>
</msubsup>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msubsup>
<mi>y</mi>
<mn>11</mn>
<mn>0</mn>
</msubsup>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msubsup>
<mi>x</mi>
<mn>11</mn>
<mn>0</mn>
</msubsup>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>9</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msubsup>
<mi>y</mi>
<mn>11</mn>
<mn>0</mn>
</msubsup>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>9</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>x</mi>
<mn>11</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>y</mi>
<mn>11</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mi>b</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>13</mn>
<mo>)</mo>
</mrow>
</mrow>
其中:
<mrow>
<mi>b</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<msubsup>
<mi>L</mi>
<mn>11</mn>
<mn>3</mn>
</msubsup>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msubsup>
<mi>x</mi>
<mn>11</mn>
<mn>0</mn>
</msubsup>
<mn>2</mn>
</msup>
<mo>-</mo>
<msup>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msubsup>
<mi>y</mi>
<mn>11</mn>
<mn>0</mn>
</msubsup>
<mn>2</mn>
</msup>
<mo>-</mo>
<msup>
<msub>
<mi>y</mi>
<mn>3</mn>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msubsup>
<mi>L</mi>
<mn>11</mn>
<mn>9</mn>
</msubsup>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msubsup>
<mi>x</mi>
<mn>11</mn>
<mn>0</mn>
</msubsup>
<mn>2</mn>
</msup>
<mo>-</mo>
<msup>
<msub>
<mi>x</mi>
<mn>9</mn>
</msub>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<msubsup>
<mi>y</mi>
<mn>11</mn>
<mn>0</mn>
</msubsup>
<mn>2</mn>
</msup>
<mo>-</mo>
<msup>
<msub>
<mi>y</mi>
<mn>9</mn>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>14</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,与为上一步迭代的结果,x11与y11为本次迭代的结果;用P10点坐标相对于P3和P9点的连线做对称来作为P11初值;
再由P3和P11坐标计算两点的方向
<mrow>
<msubsup>
<mi>&alpha;</mi>
<mn>3</mn>
<mn>11</mn>
</msubsup>
<mo>=</mo>
<mi>arctan</mi>
<mn>2</mn>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mn>11</mn>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>3</mn>
</msub>
<mo>,</mo>
<msub>
<mi>x</mi>
<mn>11</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>15</mn>
<mo>)</mo>
</mrow>
</mrow>
在计算P3至P12的方向
<mrow>
<msubsup>
<mi>&alpha;</mi>
<mn>3</mn>
<mn>12</mn>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>&alpha;</mi>
<mn>3</mn>
<mn>11</mn>
</msubsup>
<mo>-</mo>
<mo>&angle;</mo>
<mover>
<mrow>
<msub>
<mi>P</mi>
<mn>11</mn>
</msub>
<msub>
<mi>P</mi>
<mn>3</mn>
</msub>
<msub>
<mi>P</mi>
<mn>12</mn>
</msub>
</mrow>
<mo>&OverBar;</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>16</mn>
<mo>)</mo>
</mrow>
</mrow>
则得到P12的坐标为:
<mrow>
<msub>
<mi>P</mi>
<mn>12</mn>
</msub>
<mo>=</mo>
<msub>
<mi>P</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msubsup>
<mi>L</mi>
<mn>12</mn>
<mn>3</mn>
</msubsup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msubsup>
<mi>cos&alpha;</mi>
<mn>3</mn>
<mn>12</mn>
</msubsup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msubsup>
<mi>sin&alpha;</mi>
<mn>3</mn>
<mn>12</mn>
</msubsup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>17</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,点P11、P3连线与点P3、P12连线的夹角;P12为铲齿;为P3与P12之间的距离。
8.根据权利要求7所述的挖掘机数字化辅助施工***,其特征在于,还包括对坐标增量进行俯仰角改正的步骤,具体包括如下步骤:
步骤a5:首先以P1为坐标系零点,车身坐标系的X轴作为X轴,在水平面上与X轴垂直且指向工作装置朝向的方向为Y轴,Z轴与X轴、Y轴组成右手坐标系,建立三维工作装置坐标系,则P12坐标可如式(18)在该坐标系下表示为
<mrow>
<msubsup>
<mi>P</mi>
<mn>12</mn>
<mrow>
<mn>3</mn>
<mi>D</mi>
</mrow>
</msubsup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>18</mn>
<mo>)</mo>
</mrow>
</mrow>
所述三维工作装置坐标系与所述车身坐标系之间相差一个俯仰角的旋转,因此按式(19)推算车身坐标系下的P12坐标
<mrow>
<msubsup>
<mi>P</mi>
<mn>12</mn>
<mrow>
<mi>v</mi>
<mi>e</mi>
<mi>h</mi>
</mrow>
</msubsup>
<mo>=</mo>
<msub>
<mi>R</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>(</mo>
<mo>-</mo>
<msub>
<mi>&theta;</mi>
<mrow>
<mi>c</mi>
<mi>a</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<msubsup>
<mi>P</mi>
<mn>12</mn>
<mrow>
<mn>3</mn>
<mi>D</mi>
</mrow>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>19</mn>
<mo>)</mo>
</mrow>
</mrow>
步骤a6:计算车身坐标系下所述GNSS主站天线至P12的坐标增量
<mrow>
<msubsup>
<mi>inc</mi>
<mrow>
<mi>a</mi>
<mn>1</mn>
</mrow>
<mn>12</mn>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>inc</mi>
<mrow>
<mi>a</mi>
<mn>1</mn>
</mrow>
<mn>1</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>P</mi>
<mn>12</mn>
<mrow>
<mi>v</mi>
<mi>e</mi>
<mi>h</mi>
</mrow>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>20</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,为车身坐标系下所述GNSS主站天线至P1的坐标增量;
步骤a7:计算修正后的铲齿坐标pos12为:
<mrow>
<msub>
<mi>pos</mi>
<mn>12</mn>
</msub>
<mo>=</mo>
<msub>
<mi>pos</mi>
<mrow>
<mi>a</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>R</mi>
<mn>3</mn>
</msub>
<mrow>
<mo>(</mo>
<msub>
<mi>&psi;</mi>
<mrow>
<mi>c</mi>
<mi>a</mi>
<mi>l</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>R</mi>
<mrow>
<mi>a</mi>
<mi>t</mi>
<mi>t</mi>
<mi>i</mi>
<mi>t</mi>
<mi>u</mi>
<mi>d</mi>
<mi>e</mi>
</mrow>
</msub>
<msubsup>
<mi>inc</mi>
<mrow>
<mi>a</mi>
<mn>1</mn>
</mrow>
<mn>12</mn>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>21</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,posa1为所述接收机(11)输出的所述GNSS主站天线坐标。
9.一种根据权利要求1所述挖掘机数字化辅助施工***的辅助挖坑方法,其特征在于:对于短坑,首先将铲齿分别置于目标坑的四个边界顶点,拾取点坐标为a,b,c,d并存储;对于长坑,首先将铲齿置于任一短边的两个端点及长边上任意一点,拾取点坐标为a,b,c并存储;然后输入设计坑深,在智能控制终端上生成目标坑的三维图像;操作者根据铲齿模型在图像的位置进行作业,在超挖或欠挖时,智能控制终端上显示到目标点/边的距离,操作者根据提示完成作业。
10.一种根据权利要求1所述挖掘机数字化辅助施工***的辅助修坡方法,其特征在于:将挖掘机铲齿放到坡底,拾取坡底点的坐标,移动铲齿至坡顶,拾取坡顶点坐标,存储两点坐标;在能控制终端中选择参考模型,建立整个坡的三维模型;开始施工,作业平面和铲齿模型以三维图像的形式显示在智能控制终端上,操作者根据提示进行修坡。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711125918.9A CN107905275B (zh) | 2017-11-15 | 2017-11-15 | 一种挖掘机数字化辅助施工***及其辅助施工方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711125918.9A CN107905275B (zh) | 2017-11-15 | 2017-11-15 | 一种挖掘机数字化辅助施工***及其辅助施工方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107905275A true CN107905275A (zh) | 2018-04-13 |
CN107905275B CN107905275B (zh) | 2020-08-25 |
Family
ID=61845474
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711125918.9A Active CN107905275B (zh) | 2017-11-15 | 2017-11-15 | 一种挖掘机数字化辅助施工***及其辅助施工方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107905275B (zh) |
Cited By (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108643277A (zh) * | 2018-05-21 | 2018-10-12 | 山东天星北斗信息科技有限公司 | 基于gnss-sins与位移传感器的挖掘机位置信息服务***及方法 |
CN108951750A (zh) * | 2018-08-08 | 2018-12-07 | 上海宝冶集团有限公司 | 一种挖掘机施工作业方法、***及挖掘机 |
CN109269462A (zh) * | 2018-11-01 | 2019-01-25 | 南京天辰礼达电子科技有限公司 | 一种基于角度传感器的深松深度的测量*** |
CN109371798A (zh) * | 2018-11-09 | 2019-02-22 | 山东天星北斗信息科技有限公司 | 一种划线机辅助施工装置及其方法 |
CN109444936A (zh) * | 2018-10-18 | 2019-03-08 | 南京天辰礼达电子科技有限公司 | 一种利用gnss和倾角传感器确定斗尖坐标的方法 |
CN109440854A (zh) * | 2018-10-18 | 2019-03-08 | 南京天辰礼达电子科技有限公司 | 一种计算斗尖与大臂轴心位置关系的方法 |
CN109614743A (zh) * | 2018-12-26 | 2019-04-12 | 广州海达安控智能科技有限公司 | 挖掘机及其铲斗定位方法、电子设备、存储介质 |
CN110081847A (zh) * | 2019-05-20 | 2019-08-02 | 南京天辰礼达电子科技有限公司 | 一种基于角度传感器的挖机相对坐标解算*** |
CN110409530A (zh) * | 2019-08-13 | 2019-11-05 | 中国水利水电第五工程局有限公司 | 一种推土机自动控制***及控制方法 |
CN110939135A (zh) * | 2019-11-19 | 2020-03-31 | 中交疏浚技术装备国家工程研究中心有限公司 | 应用于斜坡摊铺工程机械作业的定位定向方法及*** |
CN111679306A (zh) * | 2020-06-18 | 2020-09-18 | 万宝矿产有限公司 | 一种基于卫星导航的挖掘机智能化高精度定位方法 |
CN111708067A (zh) * | 2020-08-04 | 2020-09-25 | 中国铁道科学研究院集团有限公司铁道建筑研究所 | 挖掘机自动引导*** |
CN112031052A (zh) * | 2020-08-28 | 2020-12-04 | 山东四维卓识信息技术有限公司 | 推土机施工管控***及方法 |
CN112380663A (zh) * | 2020-04-13 | 2021-02-19 | 青岛慧拓智能机器有限公司 | 一种用于电铲计算指定装载点的方法 |
CN113047353A (zh) * | 2021-03-23 | 2021-06-29 | 武汉理工大学 | 一种挖掘机智能施工引导***及方法 |
CN113128742A (zh) * | 2020-01-14 | 2021-07-16 | 中联重科股份有限公司 | 工程机械的施工方法、装置、可读存储介质和处理器 |
CN113393220A (zh) * | 2021-07-26 | 2021-09-14 | 立澈(上海)自动化有限公司 | 基于扫码付费的施工引导***及共享方法 |
WO2021253958A1 (zh) * | 2020-06-18 | 2021-12-23 | 万宝矿产有限公司 | 一种基于卫星导航的挖掘机智能化高精度定位方法 |
CN114045893A (zh) * | 2021-10-25 | 2022-02-15 | 上海华兴数字科技有限公司 | 挖掘机铲斗齿尖定位方法、装置和挖掘机 |
CN115184969A (zh) * | 2022-09-13 | 2022-10-14 | 青岛秀山移动测量有限公司 | 一种用于工程机械的多传感器融合定位定姿测速方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101535573B (zh) * | 2006-08-24 | 2013-07-17 | 卡特彼勒天宝控制技术有限责任公司 | 挖掘机3d综合式激光和无线电定位引导*** |
CN103857854A (zh) * | 2012-10-05 | 2014-06-11 | 株式会社小松制作所 | 挖掘机械的显示***及挖掘机械 |
JP5555367B1 (ja) * | 2013-11-18 | 2014-07-23 | 株式会社シーティーエス | 締固め及び敷均し管理システム |
CN105971050A (zh) * | 2015-03-13 | 2016-09-28 | 住友重机械工业株式会社 | 挖掘机 |
US20160334804A1 (en) * | 2003-03-20 | 2016-11-17 | Agjunction Llc | Gnss and optical guidance and machine control |
CN106988357A (zh) * | 2015-11-04 | 2017-07-28 | 住友建机株式会社 | 挖土机 |
-
2017
- 2017-11-15 CN CN201711125918.9A patent/CN107905275B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20160334804A1 (en) * | 2003-03-20 | 2016-11-17 | Agjunction Llc | Gnss and optical guidance and machine control |
CN101535573B (zh) * | 2006-08-24 | 2013-07-17 | 卡特彼勒天宝控制技术有限责任公司 | 挖掘机3d综合式激光和无线电定位引导*** |
CN103857854A (zh) * | 2012-10-05 | 2014-06-11 | 株式会社小松制作所 | 挖掘机械的显示***及挖掘机械 |
JP5555367B1 (ja) * | 2013-11-18 | 2014-07-23 | 株式会社シーティーエス | 締固め及び敷均し管理システム |
CN105971050A (zh) * | 2015-03-13 | 2016-09-28 | 住友重机械工业株式会社 | 挖掘机 |
CN106988357A (zh) * | 2015-11-04 | 2017-07-28 | 住友建机株式会社 | 挖土机 |
Cited By (27)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108643277B (zh) * | 2018-05-21 | 2021-03-09 | 山东天星北斗信息科技有限公司 | 基于gnss-sins与位移传感器的挖掘机位置信息服务***及方法 |
CN108643277A (zh) * | 2018-05-21 | 2018-10-12 | 山东天星北斗信息科技有限公司 | 基于gnss-sins与位移传感器的挖掘机位置信息服务***及方法 |
CN108951750A (zh) * | 2018-08-08 | 2018-12-07 | 上海宝冶集团有限公司 | 一种挖掘机施工作业方法、***及挖掘机 |
CN109444936A (zh) * | 2018-10-18 | 2019-03-08 | 南京天辰礼达电子科技有限公司 | 一种利用gnss和倾角传感器确定斗尖坐标的方法 |
CN109440854A (zh) * | 2018-10-18 | 2019-03-08 | 南京天辰礼达电子科技有限公司 | 一种计算斗尖与大臂轴心位置关系的方法 |
CN109269462A (zh) * | 2018-11-01 | 2019-01-25 | 南京天辰礼达电子科技有限公司 | 一种基于角度传感器的深松深度的测量*** |
CN109371798A (zh) * | 2018-11-09 | 2019-02-22 | 山东天星北斗信息科技有限公司 | 一种划线机辅助施工装置及其方法 |
CN109371798B (zh) * | 2018-11-09 | 2021-08-31 | 山东天星北斗信息科技有限公司 | 一种划线机辅助施工装置及其方法 |
CN109614743A (zh) * | 2018-12-26 | 2019-04-12 | 广州海达安控智能科技有限公司 | 挖掘机及其铲斗定位方法、电子设备、存储介质 |
CN109614743B (zh) * | 2018-12-26 | 2023-11-21 | 广州市中海达测绘仪器有限公司 | 挖掘机及其铲斗定位方法、电子设备、存储介质 |
CN110081847A (zh) * | 2019-05-20 | 2019-08-02 | 南京天辰礼达电子科技有限公司 | 一种基于角度传感器的挖机相对坐标解算*** |
WO2020232980A1 (zh) * | 2019-05-20 | 2020-11-26 | 南京天辰礼达电子科技有限公司 | 一种基于角度传感器的挖机相对坐标解算*** |
CN110409530A (zh) * | 2019-08-13 | 2019-11-05 | 中国水利水电第五工程局有限公司 | 一种推土机自动控制***及控制方法 |
CN110939135A (zh) * | 2019-11-19 | 2020-03-31 | 中交疏浚技术装备国家工程研究中心有限公司 | 应用于斜坡摊铺工程机械作业的定位定向方法及*** |
CN113128742B (zh) * | 2020-01-14 | 2024-03-22 | 中联重科股份有限公司 | 工程机械的施工方法、装置、可读存储介质和处理器 |
CN113128742A (zh) * | 2020-01-14 | 2021-07-16 | 中联重科股份有限公司 | 工程机械的施工方法、装置、可读存储介质和处理器 |
CN112380663A (zh) * | 2020-04-13 | 2021-02-19 | 青岛慧拓智能机器有限公司 | 一种用于电铲计算指定装载点的方法 |
AU2021294070B2 (en) * | 2020-06-18 | 2023-01-05 | Wanbao Mining Ltd. | Method for smart high-precision positioning of excavator based on satellite navigation |
CN111679306A (zh) * | 2020-06-18 | 2020-09-18 | 万宝矿产有限公司 | 一种基于卫星导航的挖掘机智能化高精度定位方法 |
WO2021253958A1 (zh) * | 2020-06-18 | 2021-12-23 | 万宝矿产有限公司 | 一种基于卫星导航的挖掘机智能化高精度定位方法 |
CN111679306B (zh) * | 2020-06-18 | 2023-09-26 | 万宝矿产有限公司 | 一种基于卫星导航的挖掘机智能化高精度定位方法 |
CN111708067A (zh) * | 2020-08-04 | 2020-09-25 | 中国铁道科学研究院集团有限公司铁道建筑研究所 | 挖掘机自动引导*** |
CN112031052A (zh) * | 2020-08-28 | 2020-12-04 | 山东四维卓识信息技术有限公司 | 推土机施工管控***及方法 |
CN113047353A (zh) * | 2021-03-23 | 2021-06-29 | 武汉理工大学 | 一种挖掘机智能施工引导***及方法 |
CN113393220A (zh) * | 2021-07-26 | 2021-09-14 | 立澈(上海)自动化有限公司 | 基于扫码付费的施工引导***及共享方法 |
CN114045893A (zh) * | 2021-10-25 | 2022-02-15 | 上海华兴数字科技有限公司 | 挖掘机铲斗齿尖定位方法、装置和挖掘机 |
CN115184969A (zh) * | 2022-09-13 | 2022-10-14 | 青岛秀山移动测量有限公司 | 一种用于工程机械的多传感器融合定位定姿测速方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107905275B (zh) | 2020-08-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107905275A (zh) | 一种挖掘机数字化辅助施工***及其辅助施工方法 | |
CN108549771A (zh) | 一种挖掘机辅助施工***及方法 | |
US5996702A (en) | System for monitoring movement of a vehicle tool | |
FI125464B (en) | Arrangement and method for positioning the machine | |
JP4205676B2 (ja) | 建設機械の出来形情報処理装置 | |
JP4012448B2 (ja) | 建設機械の掘削作業教示装置 | |
CN109444936A (zh) | 一种利用gnss和倾角传感器确定斗尖坐标的方法 | |
CN109614743A (zh) | 挖掘机及其铲斗定位方法、电子设备、存储介质 | |
CN111679306A (zh) | 一种基于卫星导航的挖掘机智能化高精度定位方法 | |
CN109296370A (zh) | 一种自动测绘定位的掘进方法及*** | |
CN111121748A (zh) | 基于挖掘机械土石方开挖作业的施工测量***及方法 | |
JP2003056010A (ja) | 地下埋設物掘削システム | |
AU2017305111B2 (en) | Construction management system | |
CN113175888A (zh) | 一种用于边坡坡表变形监测的多功能目标物及其布设方法 | |
CN106193148B (zh) | 一种反铲挖掘机挖力引导装置及其使用方法 | |
Yamamoto et al. | Basic technology toward autonomous hydraulic excavator | |
JP6616149B2 (ja) | 施工方法、作業機械の制御システム及び作業機械 | |
JP6529058B1 (ja) | 建設機械管理システム、建設機械管理プログラム、建設機械管理方法、建設機械および建設機械の外部管理装置 | |
Vladimirovich et al. | Improving of positioning for measurements to control the operation and management of earth-moving and construction machinery | |
CN107780938A (zh) | 一种实现露天矿挖掘设备控制矿石出矿品位的方法 | |
CN211121250U (zh) | 挖掘机械土石方作业测量数据采集装置 | |
JP2023059667A (ja) | 建設機械の施工表示方法、建設機械の表示制御システムおよび建設機械の表示制御プログラム | |
JP3118173B2 (ja) | 測地システム | |
CN106767672B (zh) | 基于迹线确定岩体结构面产状的方法 | |
CN112031052A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |