CN109642409B - 工程机械 - Google Patents

工程机械 Download PDF

Info

Publication number
CN109642409B
CN109642409B CN201780052651.7A CN201780052651A CN109642409B CN 109642409 B CN109642409 B CN 109642409B CN 201780052651 A CN201780052651 A CN 201780052651A CN 109642409 B CN109642409 B CN 109642409B
Authority
CN
China
Prior art keywords
information
unit
target surface
angle
ground angle
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
Application number
CN201780052651.7A
Other languages
English (en)
Other versions
CN109642409A (zh
Inventor
森木秀一
坂本博史
枝村学
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hitachi Construction Machinery Co Ltd
Original Assignee
Hitachi Construction Machinery Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Hitachi Construction Machinery Co Ltd filed Critical Hitachi Construction Machinery Co Ltd
Publication of CN109642409A publication Critical patent/CN109642409A/zh
Application granted granted Critical
Publication of CN109642409B publication Critical patent/CN109642409B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; 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/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/431Control of dipper or bucket position; Control of sequence of drive operations for bucket-arms, front-end loaders, dumpers or the like
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; 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/30Dredgers; 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 with a dipper-arm pivoted on a cantilever beam, i.e. boom
    • E02F3/32Dredgers; 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 with a dipper-arm pivoted on a cantilever beam, i.e. boom working downwardly and towards the machine, e.g. with backhoes
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; 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/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2025Particular purposes of control systems not otherwise provided for
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2264Arrangements or adaptations of elements for hydraulic drives
    • E02F9/2271Actuators and supports therefor and protection therefor
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/261Surveying the work-site to be treated
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/264Sensors and their calibration for indicating the position of the work tool
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; 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/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like

Abstract

本发明提供一种作业点的位置的运算精度高的工程机械。工程机械具备:车身(9、10);具有摆动自如的多个作业要素(8、11、12)的作业机(15);驱动作业机的多个液压执行机构(5、6、7);检测多个作业要素的对地角度的多个对地角度传感器(13a~13d);和包括信息处理装置(100)的挖掘支援装置(400),该工程机械的特征在于,信息处理装置包括:负荷信息获取部(130),其基于来自多个对地角度传感器的信号来获取包括多个作业要素中的至少一个作业要素的摆动中心处的负荷方向在内的负荷信息;和作业点位置运算部(150),其基于来自多个对地角度传感器的信号和来自负荷信息获取部的负荷信息来运算作业机的作业点的位置。

Description

工程机械
技术领域
本发明涉及工程机械,尤其涉及在挖掘作业中支援操作员的操作的技术领域。
背景技术
已知一种在通过工程机械将原本的地形施工成三维的目标地形时在挖掘作业中支援操作员的操作的挖掘支援装置。例如,代替以往用于施工的标桩,而采用在监视器上显示目标地形与作业机(例如铲斗等)的位置关系的机器引导(machine guidance)、和根据目标地形与作业机的位置间的偏差来半自动控制工程机械的机器控制(machine control)等。
这些挖掘支援装置以作业机的尺寸为基础并根据由姿势传感器获取的作业机的姿势来运算作业机的作业点的位置。例如如图1所示,以动臂脚销位置为原点O,并相对于车身以前方为x轴、以上方为z轴,根据作为作业要素的各连杆(动臂、斗杆、铲斗)的角度θBM、θAM、θBK来运算作为作业点的铲斗齿尖W的位置(Wx、Wz)。
作业点的位置的运算精度受机构松动的影响。通常在各连杆的位于摆动中心的销与销孔之间设有间隙,连杆的摆动中心因外力而偏心,由此会产生机构松动。例如,在作为姿势传感器而使用对驱动各连杆的执行机构的行程进行检测的行程传感器的情况下,因机构松动的影响,在根据行程求出连杆角度的运算中会产生误差。因此,为了高精度地运算作业点的位置,需要根据作用于连杆的摆动中心的负荷的方向来检测或运算偏心的方向。
专利文献1公开了一种除了姿势传感器之外还具备负荷传感器、并基于姿势传感器和负荷传感器的信号来运算作业点的位置的控制系统。在专利文献1记载的控制系统中,根据摆动中心的间隙、和基于负荷传感器的信号而运算出的负荷的方向来修正各连杆的相对角度,由此提高了作业点的位置的运算精度。
现有技术文献
专利文献
专利文献1:美国专利第6934616号说明书
发明内容
然而,在专利文献1记载的控制系统中,由于以重力的方向相对于车身为下方作为前提来运算作用于各连杆的外力,所以例如在车身倾斜的情况下,存在负荷的方向会产生误差、且由此作业点的位置的运算精度会下降的课题。
本发明是鉴于上述课题而做出的,其目的在于,提供一种作业点的位置的运算精度高的工程机械。
为了达成上述目的,具有代表性的本发明为一种工程机械,其具备:车身;设于所述车身上且具有摆动自如的多个作业要素的作业机;驱动所述作业机的多个液压执行机构;检测所述多个作业要素的对地角度的多个对地角度传感器;和包括生成用于对操作员的挖掘作业进行支援的信息的信息处理装置在内的挖掘支援装置,该工程机械的特征在于,所述信息处理装置包括:负荷信息获取部,其基于来自所述多个对地角度传感器的信号来获取包括所述多个作业要素中的至少一个作业要素的摆动中心处的负荷方向在内的负荷信息;和作业点位置运算部,其基于来自所述多个对地角度传感器的信号和来自所述负荷信息获取部的负荷信息来运算所述作业机的作业点的位置。
发明效果
根据本发明能够提供一种作业点的位置的运算精度高的工程机械。此外,上述以外的课题、结构及效果由以下实施方式的说明来阐明。
附图说明
图1是说明各连杆的角度与铲斗的齿尖位置之间的关系的图。
图2是表示本发明第一实施方式的工程机械的立体图。
图3是表示搭载于图2所示的工程机械中的挖掘支援装置的结构图。
图4是表示图3所示的信息处理装置的详细结构的框图。
图5是用于说明作用于动臂的外力的运算的图。
图6是用于说明作用于斗杆的外力的运算的图。
图7是说明铲斗的旋转方向的运算的图。
图8是表示搭载于本发明第二实施方式的工程机械中的挖掘支援装置的信息处理装置的详细结构的框图。
图9是表示图8示出的尺寸设定部进行的运算处理的步骤的流程图。
图10是用于说明本发明与现有技术之间的作业点的运算精度的差异的图。
具体实施方式
<第一实施方式>
以下,使用附图来说明本发明的工程机械的实施方式。图2是表示本发明第一实施方式的工程机械的立体图。如图2所示,本实施方式的工程机械具备作为车身的下部行驶体9及上部旋转体10、和作业机15。下部行驶体9具有左右的履带式行驶装置,由左右的行驶液压马达3b、3a(仅图示左侧3b)驱动。上部旋转体10以能够旋转的方式搭载于下部行驶体9上,并由旋转液压马达4旋转驱动。上部旋转体10具备作为原动机的发动机14和由发动机14驱动的液压泵装置2。
作业机15以能够摆动的方式安装在上部旋转体10的前部。上部旋转体10具备驾驶室,在驾驶室内配置有行驶用右操作杆装置1a、行驶用左操作杆装置1b、用于指示作业机15的动作及上部旋转体10的旋转动作的右操作杆装置1c和左操作杆装置1d等操作装置。
作业机15是具有作为摆动自如的作业要素的动臂11、斗杆12、铲斗8的多关节构造,动臂11通过动臂液压缸5的伸缩而相对于上部旋转体10沿上下方向摆动,斗杆12通过斗杆液压缸6的伸缩而相对于动臂11沿上下及前后方向摆动,铲斗8通过铲斗液压缸7的伸缩而相对于斗杆12沿上下及前后方向摆动。另外,动臂液压缸5具备检测动臂液压缸5的缸底侧压力的动臂缸底压力传感器17a、和检测动臂液压缸5的活塞杆侧压力的动臂活塞杆压力传感器17b。另外,斗杆液压缸6具备检测斗杆液压缸6的缸底侧压力的斗杆缸底压力传感器17c。
为了算出作业机15的任意点的位置,工程机械具备:第一对地角度传感器13a,其设于上部旋转体10与动臂11的连结部附近,并检测动臂11相对于水平面的角度(动臂角度);第二对地角度传感器13b,其设于动臂11与斗杆12的连结部附近,并检测斗杆12相对于水平面的角度(斗杆角度);第三对地角度传感器13c,其设于连结斗杆12与铲斗8的铲斗连杆8a上,并检测铲斗连杆8a相对于水平面的角度(铲斗角度);和车身对地角度传感器13d,其检测上部旋转体10相对于水平面的倾斜角度(翻滚角、俯仰角)。
作为姿势传感器的一例的对地角度传感器13a~13d分别至少具备两轴的加速度传感器,能够检测对地角度和负荷的方向。这些对地角度传感器13a~13d检测到的姿势传感器信号、和作为压力传感器的一例的前述动臂缸底压力传感器17a、动臂活塞杆压力传感器17b、斗杆缸底压力传感器17c的信号被输入至后述的信息处理装置100。此外,从对地角度传感器13a~13d输出的各姿势传感器信号至少是二维的加速度矢量。
控制阀20对从液压泵装置2分别向上述的旋转液压马达4、动臂液压缸5、斗杆液压缸6、铲斗液压缸7及左右的行驶液压马达3b、3a等液压执行机构供给的液压油的流动(流量和方向)进行控制。此外,在本实施方式中,以动臂液压缸5、斗杆液压缸6具备压力传感器17a~17c的结构来进行说明,但也可以在控制阀20或控制阀20与各个液压缸5、6的中途的配管上设置压力传感器17a~17c。
[工程机械的挖掘支援装置]
图3是表示搭载于图2所示的工程机械中的挖掘支援装置的结构图。在图3中,工程机械的挖掘支援装置400包括生成用于对操作员的挖掘作业进行支援的信息的信息处理装置100、和向操作员显示挖掘作业的支援信息的例如液晶面板等显示装置200。信息处理装置100例如使用包括如下部分的硬件来构成:未图示的CPU(Central Processing Unit:中央处理器);储存用于执行CPU的处理的各种程序的ROM(Read Only Memory:只读存储器)和HDD(Hard Disc Drive:硬盘驱动器)等存储装置;和成为CPU执行程序时的作业区域的RAM(Random Access Memory:随机存取存储器)。
信息处理装置100从第一对地角度传感器13a、第二对地角度传感器13b、第三对地角度传感器13c及车身对地角度传感器13d分别接收第一姿势传感器信号、第二姿势传感器信号、第三姿势传感器信号及车身姿势传感器信号,从动臂缸底压力传感器17a、动臂活塞杆压力传感器17b分别接收动臂缸底压、动臂活塞杆压,从斗杆缸底压力传感器17c接收斗杆缸底压,从设计数据输入装置18接收设计面信息,并将运算结果向显示装置200发送。此外,由信息处理装置100进行的运算详见后述,但由显示装置200进行的运算与现有技术相同,因此,省略其详细说明。
[信息处理装置]
图4是表示图3所示的信息处理装置100的详细结构的框图。如图4所示,信息处理装置100具备尺寸存储部110、角度运算部120、负荷信息获取部130、目标面信息设定部140和作业点位置运算部150。
尺寸存储部110预先存储有作业机15的尺寸信息L、∠及作业机15的各摆动中心的偏心量信息δ,并向负荷信息获取部130和作业点位置运算部150输出信息L、∠、δ。
角度运算部120输入来自各对地角度传感器13a~13d的各姿势传感器信号a,并将动臂11、斗杆12、铲斗连杆8a及上部旋转体10的对地角度θ向负荷信息获取部130和作业点位置运算部150输出。在角度运算部120中,为了运算对地角度θ而例如利用式(1)。
[式1]
Figure BDA0001979268070000061
在此,i=1、2、3分别为动臂11、斗杆12及铲斗8,aix、aiz为各个加速度矢量成分。此外,对地角度θ的运算方法并不限于此,也可以作为对地角度传感器而使用具备陀螺仪的对地角度传感器,并通过公知的传感器融合等来运算对地角度θ。
负荷信息获取部130输入来自各对地角度传感器13a~13d的各姿势传感器信号a、来自压力传感器17a~17c的压力传感器信号P、来自尺寸存储部110的尺寸信息L、∠、来自角度运算部120的动臂11、斗杆12及铲斗连杆8a的对地角度θ、和来自目标面信息设定部140的目标面信息Ls、θs,并将作用于动臂11、斗杆12及铲斗8的负荷信息F向作业点位置运算部150输出。由负荷信息获取部130进行的运算详见后述。
目标面信息设定部140输入来自设计数据输入装置18的设计面信息和来自作业点位置运算部150的作业点W的位置信息,将多个设计面中的离作业点W最近的设计面作为目标面而提取,并将目标面相对于车身的基准点(例如表示旋转中心的动臂脚销高度的点)的距离Ls和角度θs作为目标面信息而向负荷信息获取部130和显示装置200输出。
作业点位置运算部150输入来自尺寸存储部110的作业机15的尺寸信息L、∠及偏心量信息δ、来自角度运算部120的动臂11、斗杆12、铲斗连杆8a及上部旋转体10的对地角度θ、和来自负荷信息获取部130的作用于动臂11、斗杆12及铲斗13的负荷信息F,运算作业点W的位置,并将其向显示装置200和目标面信息设定部140输出。由作业点位置运算部150进行的运算详见后述。
[负荷信息获取部]
用图5~7说明由负荷信息获取部130进行的运算。图5是用于说明作用于动臂11的外力的运算的图,图6是用于说明作用于斗杆12的外力的图,图7是用于说明铲斗8的旋转方向的运算的图。图5所示的箭头表示作用于动臂11的外力。G1是动臂11的重心位置,重力FG1作用于G1。重力FG1由作为姿势传感器信号a的加速度矢量aG1与动臂11的质量相乘来运算。Fbm、Fam分别为动臂液压缸5、斗杆液压缸6的推力,由各压力传感器信号P与各液压缸5、6的有效面积相乘来运算。
此外,在本实施方式中,仅将基于斗杆回收的挖掘时作为运算对象,并将斗杆液压缸6的活塞杆压设为0来运算,但在斗杆放出时也作为运算对象的情况下,获取斗杆液压缸6的活塞杆压即可。FB、FE分别为作用于动臂11的摆动中心B、斗杆12的摆动中心E的外力。以点B为原点、以从点B向E的方向为x轴时的这些力的均衡由式(2)表示。
[式2]
Figure BDA0001979268070000071
在此,各外力的上角标的添加字表示坐标系的x轴。
另外,点B周围的力矩的均衡由式(3)表示。
[式3]
Figure BDA0001979268070000072
FB、FE是未知数,无法仅由式(2)、(3)来运算。因此,也同时运算作用于斗杆12的外力。图6所示的箭头表示作用于斗杆12的外力。G2是斗杆12的重心位置,重力FG2作用于G2。重力FG2由作为姿势传感器信号a的加速度矢量aG2与斗杆12的质量相乘来求出。FE、FK分别为作用于斗杆12的摆动中心E、铲斗8的摆动中心K的外力。以点E为原点、以从点F向E的方向为x轴时的这些力的均衡由式(4)表示。
[式4]
Figure BDA0001979268070000081
另外,点E周围的力矩的均衡由下式表示。
[式5]
Figure BDA0001979268070000082
在此,FE是相互作用于动臂11和斗杆12的外力,彼此向相反方向作用。
以点B为原点的坐标系与以点E为原点的坐标系之间的FE的坐标转换由式(6)表示。
[式6]
Figure BDA0001979268070000083
将式(4)(5)及式(6)的z成分合并整理则成为式(7)。
[式7]
Figure BDA0001979268070000084
在此,由于右边的FBE Ez是将式(3)变形,MamG是式(5)的左边第一项至第三项,所以能够分别利用式(8)、(9)来运算。
[式8]
Figure BDA0001979268070000085
[式9]
Figure BDA0001979268070000086
如上所述,在根据式(7)运算出外力FE、FK之后,通过利用式(2)运算FB而可知作用于动臂11、斗杆12及铲斗8的摆动中心的外力。此外,在本实施方式中,由于以作为姿势传感器信号a的加速度矢量为基础来运算重力FG1、FG2,所以即使是车身(即下部行驶体9及上部旋转体10)倾斜的情况下,也能高精度地运算作用于动臂11、斗杆12及铲斗8的摆动中心的外力。
此外,在本实施方式中为了简化说明而并未合并运算作用于铲斗8的外力,也可以是,铲斗液压缸7具备压力传感器,还考虑到铲斗液压缸7的推力,合并运算作用于铲斗8的外力。
接着,用图7说明由负荷信息获取部130进行的铲斗8的旋转方向的运算。图7所示的点划线表示目标面,虚线箭头表示因机构松动而意外产生的铲斗8的旋转方向。如图7的(a)所示,与从铲斗8的摆动中心K下到目标面的垂线与目标面的交点Q相比,若作业点W远离斗杆摆动中心E则判断为铲斗8向卸载方向旋转。另外,如图7的(b)所示,与从铲斗8的摆动中心K下到目标面的垂线与目标面的交点Q相比,若作业点W靠近斗杆摆动中心E则判断为铲斗8向装载方向旋转。
如上所述,即使是铲斗液压缸7不具备压力传感器的情况下,也能基于目标面的角度来简单地运算铲斗8的旋转方向。
[作业点位置运算部]
在作业点位置运算部150中,基于来自角度运算部120的动臂11、斗杆12、铲斗连杆8a及上部旋转体10的对地角度θ来运算作业点W的位置。在此,在本实施方式中,由于使用对地角度传感器13a、13b、13d直接检测动臂11、斗杆12及上部旋转体10的对地角度θ,所以这些角度不受机构松动的影响。另一方面,铲斗13的角度由于以铲斗连杆8a的对地角度θ为基础来运算,所以受机构松动的影响。因此,首先,根据来自角度运算部120的铲斗连杆8a的对地角度θbkl和来自负荷信息获取部130的基于机构松动的铲斗8的旋转方向,并利用式(10)来运算铲斗8的对地角度θbk
[式10]
Figure BDA0001979268070000101
在此,δI、δJ分别为铲斗连杆8a的摆动中心I、J(参照图7)的偏心量,在基于机构松动的铲斗8的旋转方向为装载方向的情况下输入正值来运算,并在为卸载方向的情况下输入负值来运算。由此,向基于机构松动的铲斗8的对地角度θbk的转换误差被修正。
接着,根据来自角度运算部120的动臂11、斗杆12的对地角度θbm、θam和来自负荷信息获取部130的作为负荷信息的作用于动臂11、斗杆12及铲斗8的摆动中心的外力FB、FE、FK、以及基于机构松动的铲斗8的旋转方向,并利用式(11)来运算作业点W的位置。
[式11]
Figure BDA0001979268070000102
Figure BDA0001979268070000103
Figure BDA0001979268070000104
在此,上角标的添加字Body表示以上部旋转体10为基准的坐标系。另外,δB、δE、δK是分别从尺寸存储部110输入的动臂11、斗杆12及铲斗8的摆动中心B、E、K的偏心量。
另外,θB、θE、θK表示作用于动臂11、斗杆12及铲斗8的摆动中心B、E、K的外力的以上部旋转体10为基准的方向,通过在这些方向的相反方向上补足偏心量来修正基于机构松动的并进方向上的移动量,能够提高作业点W的位置的运算精度。
如以上说明的那样,根据第一实施方式,通过使用至少具备两轴的加速度传感器的对地角度传感器13a~13d来检测重力的方向和大小,并根据重力来运算作用于作业机15的摆动中心B、E、K的外力,因此,即使是车身倾斜的情况下,也能提高起因于机构松动的作业点W的位置的运算精度。另外,对驱动作业机15的两个以上的液压执行机构(具体为动臂液压缸5及斗杆液压缸6)的压力进行检测,由此运算挖掘反作用力的大小和方向,并根据挖掘反作用力来运算作用于作业机15的摆动中心B、E、K的外力,能够提高起因于机构松动的作业点W的位置的运算精度。
<第二实施方式>
接着,使用附图对本发明第二实施方式的工程机械进行说明。在此,对与第一实施方式相同的结构标注同一附图标记并省略其说明。图8是表示搭载于本发明第二实施方式的工程机械中的挖掘支援装置的信息处理装置的详细结构的框图。如图8所示,第二实施方式中的信息处理装置300将第一实施方式中的尺寸存储部110替换为尺寸设定部160,尺寸设定部160输入外部测量值、来自各对地角度传感器13a~13d的各姿势传感器信号a、和来自负荷信息获取部130的负荷信息F,运算作业机15的尺寸信息L、∠及作业机15的各摆动中心的偏心量信息δ,并将运算结果向负荷信息获取部130和作业点位置运算部150输出。
在此,外部测量值是使用全站仪等测量出的动臂11、斗杆12及铲斗8的摆动中心的坐标,尺寸设定部160仅在输入了这些外部测量值时运算作业机15的尺寸信息L、∠和各摆动中心的偏心量信息δ,而在未输入时继续输出上次运算出的值。
用图9说明由尺寸设定部160进行的运算。图9是表示图8所示的尺寸设定部160进行的运算处理的步骤的流程图。图9示出的处理针对作业机15的每个连杆均进行,在此以动臂11为例进行说明。在该情况下,外部测量值为动臂11的摆动中心的坐标(EX、EZ)和斗杆12的摆动中心的坐标(BX、BZ)。
尺寸设定部160判定有无上次的外部测量值(S1601),在有上次的外部测量值的情况下(S1601/是),将输入了上次的外部测量值时的动臂11的摆动中心处的负荷方向与输入了此次的外部测量值时的进行比较(S1602)。在各个负荷方向是相反方向的情况下(S1602/是),尺寸设定部160设定后述的动臂11的尺寸值LBE(S1605),并同样设定后述的动臂11的摆动中心的偏心量δB(S1606)。
另一方面,在没有上次的外部测量值的情况下(S1601/否)或负荷方向不是相反方向的情况下(S1602/否),尺寸设定部160存储此次的外部测量值(S1603),并存储输入了此次的外部测量值时的动臂11的摆动中心处的负荷方向(S1604)。
在步骤S1605中,根据此次的外部测量值和上次的外部测量值并利用式(12)来运算动臂11的尺寸值LBE
[式12]
Figure BDA0001979268070000121
在此,动臂11、斗杆12各自的摆动中心E、B的上角标的添加字表示输入了外部测量值的定时,i=1表示上次的值,i=2表示此次的外部测量值。
在步骤S1606中,根据此次的外部测量值和上次的外部测量值并利用式(13)来运算动臂11的摆动中心的偏心量δB
[式13]
Figure BDA0001979268070000122
此外,由尺寸设定部160进行的运算并不限于此,也可以将负荷方向分割成n个,并根据n次量的外部测量值来运算尺寸和偏心量,在那种情况下分别利用式(14)、(15)。
[式14]
Figure BDA0001979268070000123
[式15]
Figure BDA0001979268070000124
即,根据n次量的外部测量值的平均值来运算尺寸,并根据偏差来运算偏心量。此外,在式(12)中将标准偏差的二倍设为偏心量,但也可以是一倍乃至三倍。
以上,根据第二实施方式,除了发挥与第一实施方式相同的作用效果之外,通过利用外部测量值重新设定尺寸和偏心量,即使是偏心量因磨损等而变化了的情况下,也能维持作业点W的位置的运算精度。另外,通过利用负荷方向不同的情况下的外部测量值进行运算,能够避免外部测量值的偏差而准确设定尺寸和偏心量。
在此,当来自对地角度传感器13a~13d的姿势传感器信号a相同时,用图10说明应用本发明运算作业点W的位置的情况与利用现有技术(仅对地角度传感器)运算作业点W的位置的情况之间的差异。图10是用于说明本发明与现有技术之间的作业点W的运算精度的差异的图。图中的点划线表示目标面,箭头表示作业机15的行进方向。用现有技术运算的结果是,即使如图中A那样铲斗8的齿尖(作业点W)相对于目标面接触,但由于在挖掘时向作业机15的行进方向的相反侧且是远离目标面的方向产生挖掘反作用力,所以实际上因机构松动的影响也存在如图中B那样铲斗8的齿尖(作业点W’)未到达目标面的情况。
此时的作业点W与作业点W’在高度方向上的误差δS由式(16)表示。
[式16]
δS=-δBsinθBEsinθEKsinθK-Lbk{sin(θObkBody)-sin(θbkBody)}…(16)
此外,θ0bk是由式(10)计算为δI、δJ=0的情况下的铲斗对地角度。
如以上说明的那样,当应用本发明时,由于能够在考虑到与负荷方向相应的机构松动的情况下运算作业点W的位置,所以能够抑制挖掘反作用力的影响,能够去除误差δS。因此,作业点W的位置的运算精度会提高而大大有助于操作员的作业支援。另外,由于能够使显示装置200显示以高精度运算出的作业点W为基础的作业支援信息,所以能够提高操作员的作业效率。
此外,本发明并不限定于上述实施方式,而是包括各种各样的变形例。例如,上述实施方式为了易于理解地说明本发明而进行了详细说明,但并不一定限于具备所说明的所有结构。
附图标记说明
5 动臂液压缸(液压执行机构)
6 斗杆液压缸(液压执行机构)
7 铲斗液压缸(液压执行机构)
8 铲斗(作业要素)
9 下部行驶体(车身)
10 上部旋转体(车身)
11 动臂(作业要素)
12 斗杆(作业要素)
13a 第一对地角度传感器(对地角度传感器)
13b 第二对地角度传感器(对地角度传感器)
13c 第三对地角度传感器(对地角度传感器)
13d 车身对地角度传感器(对地角度传感器)
17a 动臂缸底压力传感器(压力传感器)
17b 动臂活塞杆压力传感器(压力传感器)
17c 斗杆缸底压力传感器(压力传感器)
15 作业机
100 信息处理装置
110 尺寸存储部
120 角度运算部
130 负荷信息获取部
140 目标面信息设定部
150 作业点位置运算部
160 尺寸设定部
200 显示装置
300 信息处理装置
400 挖掘支援装置

Claims (8)

1.一种工程机械,其具备:车身;设于所述车身上且具有摆动自如的多个作业要素的作业机;驱动所述作业机的多个液压执行机构;检测所述多个作业要素的对地角度的多个对地角度传感器;和包括生成用于对操作员的挖掘作业进行支援的信息的信息处理装置在内的挖掘支援装置,该工程机械的特征在于,
多个所述对地角度传感器分别具备两轴的加速度传感器,
所述信息处理装置包括:
负荷信息获取部,其基于来自所述多个对地角度传感器的二维的加速度信息来获取包括所述多个作业要素中的至少一个作业要素的摆动中心处的负荷方向在内的负荷信息;
作业点位置运算部,其基于来自所述多个对地角度传感器的所述二维的加速度信息、和由所述负荷信息获取部获取到的负荷信息,来运算所述作业机的作业点的位置;
角度运算部,其基于来自所述多个对地角度传感器的所述二维的加速度信息来运算所述多个作业要素各自的所述对地角度;和
尺寸存储部,其预先存储所述多个作业要素各自的尺寸信息,
所述作业点位置运算部在来自所述负荷信息获取部的所述负荷信息的基础上,还基于所述尺寸存储部内存储的所述尺寸信息和由所述角度运算部运算出的所述对地角度来运算所述作业机的作业点的位置。
2.根据权利要求1所述的工程机械,其特征在于,
还具备检测所述多个液压执行机构的压力的多个压力传感器,
所述信息处理装置还包括目标面信息设定部,该目标面信息设定部基于从外部输入的设计面的信息和由所述作业点位置运算部运算出的所述作业机的作业点的位置,来设定包括所述设计面相对于所述车身的角度在内的目标面信息,
所述负荷信息获取部在来自所述多个对地角度传感器的所述二维的加速度信息的基础上,还基于所述尺寸存储部内存储的所述尺寸信息、来自所述多个压力传感器的信号、由所述角度运算部运算出的所述对地角度、和由所述目标面信息设定部设定的所述目标面信息来获取所述负荷信息。
3.根据权利要求2所述的工程机械,其特征在于,
所述尺寸存储部存储作为所述尺寸信息的、所述多个作业要素各自的尺寸及摆动中心的偏心量,
所述目标面信息设定部设定作为所述目标面信息的、所述设计面相对于所述车身的基准点的距离及角度。
4.根据权利要求3所述的工程机械,其特征在于,
所述挖掘支援装置还包括显示装置,该显示装置向操作员显示以由所述作业点位置运算部运算出的所述作业机的作业点的位置、和由所述目标面信息设定部设定的所述目标面信息为基础的信息。
5.一种工程机械,其具备:车身;设于所述车身上且具有摆动自如的多个作业要素的作业机;驱动所述作业机的多个液压执行机构;检测所述多个作业要素的对地角度的多个对地角度传感器;和包括生成用于对操作员的挖掘作业进行支援的信息的信息处理装置在内的挖掘支援装置,该工程机械的特征在于,
多个所述对地角度传感器分别具备两轴的加速度传感器,
所述信息处理装置包括:
负荷信息获取部,其基于来自所述多个对地角度传感器的二维的加速度信息来获取包括所述多个作业要素中的至少一个作业要素的摆动中心处的负荷方向在内的负荷信息;
作业点位置运算部,其基于来自所述多个对地角度传感器的所述二维的加速度信息、和由所述负荷信息获取部获取到的负荷信息,来运算所述作业机的作业点的位置;
角度运算部,其基于来自所述多个对地角度传感器的二维的加速度信息来运算所述多个作业要素各自的所述对地角度;和
尺寸设定部,其基于从外部输入的测量值、来自所述多个对地角度传感器的所述二维的加速度信息、和来自所述负荷信息获取部的所述负荷信息,通过运算来设定所述多个作业要素各自的尺寸信息,
所述作业点位置运算部在来自所述负荷信息获取部的所述负荷信息的基础上,还基于由所述尺寸设定部设定的所述尺寸信息和由所述角度运算部运算出的所述对地角度来运算所述作业机的作业点的位置。
6.根据权利要求5所述的工程机械,其特征在于,
还具备检测所述多个液压执行机构的压力的多个压力传感器,
所述信息处理装置还包括目标面信息设定部,该目标面信息设定部基于从外部输入的设计面的信息和由所述作业点位置运算部运算出的所述作业机的作业点的位置来设定包括所述设计面相对于所述车身的角度在内的目标面信息,
所述负荷信息获取部在来自所述多个对地角度传感器的所述二维的加速度信息的基础上,还基于由所述尺寸设定部设定的所述尺寸信息、来自所述多个压力传感器的信号、由所述角度运算部运算出的所述对地角度、和由所述目标面信息设定部设定的所述目标面信息来获取所述负荷信息。
7.根据权利要求6所述的工程机械,其特征在于,
所述尺寸设定部运算作为所述尺寸信息的、所述多个作业要素各自的尺寸及摆动中心的偏心量,
所述目标面信息设定部设定作为所述目标面信息的、所述设计面相对于所述车身的基准点的距离及角度。
8.根据权利要求7所述的工程机械,其特征在于,
所述挖掘支援装置还包括显示装置,该显示装置向操作员显示以由所述作业点位置运算部运算出的所述作业机的作业点的位置、和由所述目标面信息设定部设定的所述目标面信息为基础的信息。
CN201780052651.7A 2016-11-21 2017-10-25 工程机械 Active CN109642409B (zh)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2016226255A JP6779759B2 (ja) 2016-11-21 2016-11-21 建設機械
JP2016-226255 2016-11-21
PCT/JP2017/038570 WO2018092533A1 (ja) 2016-11-21 2017-10-25 建設機械

Publications (2)

Publication Number Publication Date
CN109642409A CN109642409A (zh) 2019-04-16
CN109642409B true CN109642409B (zh) 2021-04-27

Family

ID=62146366

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201780052651.7A Active CN109642409B (zh) 2016-11-21 2017-10-25 工程机械

Country Status (6)

Country Link
US (1) US11091900B2 (zh)
EP (1) EP3543409B1 (zh)
JP (1) JP6779759B2 (zh)
KR (1) KR102210871B1 (zh)
CN (1) CN109642409B (zh)
WO (1) WO2018092533A1 (zh)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6633464B2 (ja) * 2016-07-06 2020-01-22 日立建機株式会社 作業機械
JP6945540B2 (ja) * 2016-09-30 2021-10-06 住友重機械工業株式会社 ショベル
JP2019214824A (ja) * 2018-06-11 2019-12-19 株式会社フジタ 作業機械
JP7082011B2 (ja) 2018-08-23 2022-06-07 株式会社神戸製鋼所 掘削作業機械の油圧駆動装置
CN110374163A (zh) * 2019-07-17 2019-10-25 三一重机有限公司 挖掘机称重系统、方法和挖掘机
US11585071B2 (en) 2020-04-28 2023-02-21 Caterpillar Inc. Hystat swing motion actuation, monitoring, and control system
JP7009590B1 (ja) * 2020-10-20 2022-01-25 日立建機株式会社 建設機械
CN115030247B (zh) * 2022-05-27 2023-10-31 三一重机有限公司 一种臂架位姿信息的校正方法、装置及挖掘机

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6169948B1 (en) * 1996-06-26 2001-01-02 Hitachi Construction Machinery Co., Ltd. Front control system, area setting method and control panel for construction machine
CN105339558A (zh) * 2014-06-04 2016-02-17 株式会社小松制作所 建筑机械的控制系统、建筑机械及建筑机械的控制方法
CN105518220A (zh) * 2014-03-31 2016-04-20 日立建机株式会社 工程机械的区域限制挖掘控制装置

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6374147B1 (en) * 1999-03-31 2002-04-16 Caterpillar Inc. Apparatus and method for providing coordinated control of a work implement
US6934616B2 (en) 2002-12-17 2005-08-23 Caterpillar Inc System for determining an implement arm position
US7007415B2 (en) * 2003-12-18 2006-03-07 Caterpillar Inc. Method and system of controlling a work tool
AU2005227398B1 (en) * 2005-10-28 2006-04-27 Leica Geosystems Ag Method and apparatus for determining the loading of a bucket
US7631445B2 (en) * 2006-07-14 2009-12-15 Raymond E. Bergeron Underwater dredging system
CL2009000010A1 (es) * 2008-01-08 2010-05-07 Ezymine Pty Ltd Metodo para determinar la posicion global de una pala minera electrica.
JP5969379B2 (ja) * 2012-12-21 2016-08-17 住友建機株式会社 ショベル及びショベル制御方法
JP6314105B2 (ja) * 2015-03-05 2018-04-18 株式会社日立製作所 軌道生成装置および作業機械
JP6633052B2 (ja) 2015-03-27 2020-01-22 住友建機株式会社 ショベル
JPWO2016157463A1 (ja) * 2015-03-31 2018-01-18 株式会社小松製作所 作業機械の周辺監視装置
WO2016157462A1 (ja) * 2015-03-31 2016-10-06 株式会社小松製作所 作業機械の周辺監視装置
JP6782256B2 (ja) * 2017-07-13 2020-11-11 株式会社小松製作所 油圧ショベル

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6169948B1 (en) * 1996-06-26 2001-01-02 Hitachi Construction Machinery Co., Ltd. Front control system, area setting method and control panel for construction machine
CN105518220A (zh) * 2014-03-31 2016-04-20 日立建机株式会社 工程机械的区域限制挖掘控制装置
CN105339558A (zh) * 2014-06-04 2016-02-17 株式会社小松制作所 建筑机械的控制系统、建筑机械及建筑机械的控制方法

Also Published As

Publication number Publication date
EP3543409A1 (en) 2019-09-25
JP6779759B2 (ja) 2020-11-04
EP3543409B1 (en) 2022-08-03
US11091900B2 (en) 2021-08-17
US20190284783A1 (en) 2019-09-19
CN109642409A (zh) 2019-04-16
KR20190032538A (ko) 2019-03-27
EP3543409A4 (en) 2020-06-24
JP2018084042A (ja) 2018-05-31
WO2018092533A1 (ja) 2018-05-24
KR102210871B1 (ko) 2021-02-02

Similar Documents

Publication Publication Date Title
CN109642409B (zh) 工程机械
JP6701224B2 (ja) 作業機械の校正装置、作業機械及び作業機械の校正方法
EP3597831B1 (en) Construction machinery
JP6068730B2 (ja) 作業機械、及び作業機械の作業機パラメータ補正方法
US10975551B2 (en) Construction machine
CN114687395B (zh) 工程机械
CN110300827B (zh) 工程机械
KR102479701B1 (ko) 작업 기계
JP7252762B2 (ja) 作業機械
JP7016297B2 (ja) 作業機械
KR101776819B1 (ko) 굴삭기 전도 상태 판별 방법
JP7314429B2 (ja) 作業機械
JP7143117B2 (ja) ショベル
JP6912687B2 (ja) 油圧ショベル
CN114575408A (zh) 自推进式作业车辆和控制机具的移动的计算机实现的方法
JP2021152275A (ja) 作業機械
JP7263287B2 (ja) 作業機械
WO2021075400A1 (ja) 加速度検出装置、作業機械および加速度検出方法
JP2023051133A (ja) 作業機械を制御するためのシステムおよび方法

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