CN103354854B - 挖掘控制系统 - Google Patents
挖掘控制系统 Download PDFInfo
- Publication number
- CN103354854B CN103354854B CN201280008763.XA CN201280008763A CN103354854B CN 103354854 B CN103354854 B CN 103354854B CN 201280008763 A CN201280008763 A CN 201280008763A CN 103354854 B CN103354854 B CN 103354854B
- Authority
- CN
- China
- Prior art keywords
- speed
- candidate
- relative velocity
- monitoring point
- large arm
- 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
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
-
- 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/30—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 with a dipper-arm pivoted on a cantilever beam, i.e. boom
-
- 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
- E02F3/437—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like providing automatic sequences of movements, e.g. linear excavation, keeping dipper angle constant
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
- E02F9/2203—Arrangements for controlling the attitude of actuators, e.g. speed, floating function
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
- E02F9/261—Surveying the work-site to be treated
- E02F9/262—Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
- E02F9/264—Sensors and their calibration for indicating the position of the work tool
- E02F9/265—Sensors and their calibration for indicating the position of the work tool with follow-up actions (e.g. control signals sent to actuate the work tool)
Abstract
挖掘控制系统(200)获取用于将第一相对速度(Q1)限制在第一候补速度(P1)所需要的大臂缸(10)的伸缩速度的第一调整速度(S1)及用于将第二相对速度(Q2)限制在第二候补速度(P2)所需要的大臂缸(10)的伸缩速度的第二调整速度(S2)。挖掘控制系统(200)选择与第一调整速度(S1)及第二调整速度(S2)中较大一方相关的候补速度(P)作为限制速度(U)。
Description
技术领域
本发明涉及一种执行工作装置的速度限制的挖掘控制系统。
背景技术
目前,在具有工作装置的建筑机械中,公知有一种通过使铲斗沿着表示挖掘对象的目标形状的设计面移动而对规定区域进行挖掘的方法(参照专利文献1)。
具体而言,专利文献1的控制装置对由操作员输入的操作信号进行修正,使得铲斗的刃尖与设计面之间的间隔越小,工作装置相对于设计面的相对速度越下降。这样,与操作员的操作无关地执行使刃尖沿着设计面自动移动的挖掘控制。
现有专利文献
专利文献
专利文献1:国际公开WO95/30059号
发明内容
(发明要解决的技术问题)
然而,在专利文献1所述的挖掘控制中,在进行铲取动作时,有可能使铲斗背面过度挖掘挖掘对象面。另外,在专利文献1所述的挖掘控制中,在进行地面最后挖掘时,有可能不能将铲斗背面控制在设计面上。
本发明鉴于上述状况而提出,目的在于提供一种能够执行合适的挖掘控制的挖掘控制系统。
(用于解决技术问题的技术方案)
第一方式的挖掘控制系统包括工作装置、多个液压缸、候补速度获取部、相对速度获取部、限制速度选择部及液压缸控制部。工作装置由包括铲斗在内的多个被驱动部件构成,以能够转动的方式支承于车辆主体。多个液压缸分别驱动多个被驱动部件。候补速度获取部获取与铲斗的第一监视点和表示挖掘对象的目标形状的设计面之间的第一间隔相对应的第一候补速度及与不同于第一监视点的铲斗的第二监视点和设计面之间的第二间隔相对应的第二候补速度。相对速度获取部获取第一监视点相对于设计面的第一相对速度及第二监视点相对于设计面的第二相对速度。基于第一相对速度与第一候补速度之间的相对关系及第二相对速度与第二候补速度之间的相对关系,选择第一候补速度及第二候补速度中的一方作为限制速度。液压缸控制部通过向多个液压缸供给工作油,将第一监视点及第二监视点中的与限制速度相关的监视点相对于设计面的相对速度限制在限制速度。
第二方式的挖掘控制系统在第一方式的基础上,包括调整速度获取部。调整速度获取部获取第一调整速度和第二调整速度,其中第一调整速度表示用于将第一相对速度限制在第一候补速度所需要的多个液压缸各自的伸缩速度的目标速度,第二调整速度表示用于将第二相对速度限制在第二候补速度限制所需要的多个液压缸各自的伸缩速度的目标速度。限制速度选择部在第一调整速度比第二调整速度大时,选择第一候补速度作为限制速度,在第二调整速度比第一调整速度大时,选择第二候补速度作为限制速度。
(发明效果)
能够提供一种能够顺利地执行挖掘控制的挖掘控制系统。
附图说明
图1是液压挖掘机100的立体图。
图2A是液压挖掘机100的侧视图。
图2B是液压挖掘机100的后视图。
图3是表示挖掘控制系统200的功能结构的框图。
图4是表示在显示部29中显示的设计地形的一例的示意图。
图5是交线47上的设计地形的剖面图。
图6是表示工作装置控制器26的结构的框图。
图7是表示刃尖8a与目标设计面45A之间的位置关系的示意图。
图8是背面端8b与目标设计面45A之间的位置关系的示意图。
图9是表示第一候补速度P1与第一距离d1之间的关系的曲线图。
图10是表示第二候补速度P2与第二距离d2之间的关系的曲线图。
图11是用于说明第一调整速度S1的获取方法的视图。
图12是用于说明第二调整速度S2的获取方法的视图。
图13是用于说明挖掘控制系统200的工作的流程图。
具体实施方式
以下参照附图说明本发明的实施方式。以下,作为“建筑机械”的一例,以液压挖掘机为例说明。
〈液压挖掘机100的整体结构〉
图1是实施方式的液压挖掘机100的立体图。液压挖掘机100具有车辆主体1及工作装置2。另外,在液压挖掘机100上搭载有挖掘控制系统200。挖掘控制系统200的结构及工作将于后文叙述。
车辆主体1具有上部旋转体3、驾驶室4及行驶装置5。上部旋转体3收纳未图示的发动机和液压泵等。在上部旋转体3的后端部上配置有第一GNSS天线21及第二GNSS天线22。第一GNSS天线21与第二GNSS天线22是RTK-GNSS(RealTimeKinematic-GlobalNavigationSatelliteSystems,GNSS为全球卫星导航系统。)用天线。驾驶室4搭载于上部旋转体3的前部。在驾驶室4内配置有后述的操作装置25(参照图3)。行驶装置5具有履带5a,5b,通过旋转履带5a,5b使液压挖掘机100行驶。
工作装置2安装于车辆主体1的前部,包括大臂6、小臂7、铲斗8、大臂缸10、小臂缸11及铲斗缸12。大臂6的基端部经由大臂销13以能够摆动的方式安装于车辆主体1的前部。小臂7的基端部经由小臂销14以能够摆动的方式安装于大臂6的前端部。铲斗8以能够摆动的方式经由铲斗销15安装于小臂7的前端部。
大臂缸10、小臂缸11及铲斗缸12是分别由工作油驱动的液压缸。大臂缸10驱动大臂6。小臂缸11驱动小臂7。铲斗缸12驱动铲斗8。
在此,图2A是液压挖掘机100的侧视图。图2B是液压挖掘机100的后视图。如图2A所示,大臂6的长度即从大臂销13到小臂销14的长度为L1。小臂7的长度即从小臂销14到铲斗销15的长度为L2。铲斗8的长度即从铲斗销15到铲斗8的斗齿的前端(以下称为“刃尖8a”,是“第一监视点”的一例)的长度为L3a。另外,从铲斗销15到铲斗8的背面侧最外端(以下称为“背面端8b”,是“第二监视点」的一例)的长度为L3b。
另外,如图2A所示,在大臂6、小臂7、铲斗8上分别设置有第一~第三行程传感器16~18。第一行程传感器16检测大臂缸10的行程长度(以下称为“大臂缸长度N1”)。后述的显示控制器28(参照图3)根据第一行程传感器16检测到的大臂缸长度N1计算大臂6相对于车辆主体坐标系垂直方向的倾斜角θ1。第二行程传感器17检测小臂缸11的行程长度(以下称为“小臂缸长度N2”)。显示控制器28根据第二行程传感器17检测到的小臂缸长度N2计算小臂7相对于大臂6的倾斜角θ2。第三行程传感器18检测铲斗缸12的行程长度(以下称为“铲斗缸长度N3”)。显示控制器28根据第三行程传感器18检测到的铲斗缸长度N3计算刃尖8a相对于小臂7的倾斜角θ3a及背面端8b相对于小臂7的倾斜角θ3b。
在车辆主体1上配备有位置检测部19。位置检测部19检测液压挖掘机100的当前位置。位置检测部19具有上述第一GNSS天线21、第二GNSS天线22、三维位置传感器23和倾斜角传感器24。第一GNSS天线21及第二GNSS天线22在车宽度方向上配置为分开一定距离。与第一GNSS天线21及第二GNSS天线22收到的GNSS电波相对应的信号被输入到三维位置传感器23。三维位置传感器23检测第一GNSS天线21及第二GNSS天线22的设置位置。如图2B所示,倾斜角传感器24检测车辆主体1的车宽度方向相对于重力方向(铅直线)的倾斜角θ4。
〈挖掘控制系统200的结构〉
图3是表示挖掘控制系统200的功能结构的框图。挖掘控制系统200包括操作装置25、工作装置控制器26、比例控制阀27、显示控制器28及显示部29。
操作装置25接受驱动工作装置2的操作员的操作并输出与操作员的操作相对应的操作信号。具体而言,操作装置25具有大臂操作部件31、小臂操作部件32、铲斗操作部件33。大臂操作部件31包括大臂操作杆31a及大臂操作检测部31b。大臂操作杆31a接受操作员对大臂6的操作。大臂操作检测部31b根据大臂操作杆31a的操作输出大臂操作信号M1。小臂操作杆32a接受操作员对小臂7的操作。小臂操作检测部32b根据小臂操作杆32a的操作输出小臂操作信号M2。铲斗操作装置33包括铲斗操作杆33a及铲斗操作检测部33b。铲斗操作杆33a接受操作员对铲斗8的操作。铲斗操作检测部33b根据铲斗操作杆33a的操作输出铲斗操作信号M3。
工作装置控制器26从操作装置25获取大臂操作信号M1、小臂操作信号M2及铲斗操作信号M3。工作装置控制器26从第一~第三行程传感器16~18获取大臂缸长度N1、小臂缸长度N2及铲斗缸长度N3。工作装置控制器26将基于这些各种信息的控制信号输出到比例控制阀27。由此,工作装置控制器26能够执行使铲斗8沿着设计面45(参照图4)自动移动的挖掘控制。此时,工作装置控制器26如后文所述在对大臂操作信号M1进行修正后将其输出到比例控制阀27。另一方面,工作装置控制器26在对小臂操作信号M2和铲斗操作信号M3不进行修正并将它们输出到比例控制阀27。工作装置控制器26的功能及工作将于后文叙述。
比例控制阀27配置于大臂缸10、小臂缸11及铲斗缸12与未图示的液压泵之间。比例控制阀27将与来自工作装置控制器26的控制信号相对应的流量的工作油分别供给到大臂缸10、小臂缸11及铲斗缸12。
显示控制器28具有RAM、ROM等储存部28a及CPU等运算部28b。储存部28a储存包括上述大臂6的长度L1、小臂7的长度L2、铲斗8的长度L3a,L3b在内的工作装置数据。工作装置数据包括大臂6的倾斜角θ1、小臂7的倾斜角θ2、刃尖8a的倾斜角θ3a及背面端8b的倾斜角θ3b各自的最小值及最大值。显示控制器28能够利用无线或有线的通信方式与工作装置控制器26进行通信。显示控制器28的储存部28a预先储存表示工作区域内的三维设计地形的形状和位置的设计地形数据。显示控制器28基于设计地形和来自上述各种传感器的检测结果等在显示部29中显示设计地形。
在此,图4是表示在显示部29中显示的设计地形的一例的示意图。如图4所示,设计地形由多个设计面45构成,各设计面45分别用三角形多面体表现。多个设计面45分别表示工作装置2的挖掘对象的目标形状。操作员选择多个设计面45中的一个设计面作为目标设计面45A。在操作员利用铲斗8挖掘目标设计面45A时,工作装置控制器26使铲斗8沿着通过铲斗8的刃尖8a的当前位置的平面46与目标设计面45A的交线47移动。需要说明的是,在图4中只对多个设计面中的一个设计面标记了符号45而省略了其他设计面的符号。
图5是交线47上的设计地形的剖面图,是在显示部29中显示的设计地形的一例的示意图。如图5所示,本实施方式的设计地形包括目标设计面45A与速度限制干预线C。
目标设计面45A是位于液压挖掘机100侧方位置的倾斜面。操作员通过使铲斗8从目标设计面45A的上方向下方移动,从而使铲斗8沿着目标设计面45A进行挖掘。
速度限制干预线C划分后述的执行速度限制的区域。如后文所述,在铲斗8侵入速度限制干预线C的内侧时,执行基于挖掘控制系统200的速度限制。速度限制干预线C设定于距目标设计面45A有直线距离h的位置。优选将直线距离h设定为操作员对工作装置2的操作感未受影响的距离。
〈工作装置控制器26的结构〉
图6是表示工作装置控制器26的结构的框图。图7表示刃尖8a与目标设计面45A之间的位置关系的示意图。图8是表示背面端8b与目标设计面45A之间的位置关系的示意图。图7和图8表示同一时刻的铲斗8的位置。
如图6所示,工作装置控制器26包括相对距离获取部261、候补速度获取部262、相对速度获取部263、调整速度获取部264、限制速度选择部265、液压缸控制部266。
如图7所示,相对距离获取部261获取垂直于目标设计面45A的垂直方向上的刃尖8a与目标设计面45A之间的第一距离d1。如图8所示,相对距离获取部261获取垂直方向上的背面端8b与目标设计面45A之间的第二距离d2。相对距离获取部261基于从显示控制器28获取的设计地形数据、液压挖掘机100的当前位置数据以及从第一~第三行程传感器16~18获取的大臂缸长度N1、小臂缸长度N2、铲斗缸长度N3计算出第一距离d1及第二距离d2。相对距离获取部261将第一距离d1和第二距离d2输出到候补速度获取部262。需要说明的是,在本实施方式中第一距离d1比第二距离d2小。
候补速度获取部262获取与第一距离d1相对应的第一候补速度P1和与第二距离d2相对应的第二候补速度P2。在此,第一候补速度P1是与第一距离d1对应而划一(画一)地确定的速度。如图9所示,第一候补速度P1在第一距离d1为直线距离h以上时达到最大并随着第一距离d1与直线距离h相比变小而变慢。同样地,第二候补速度P2是与第二距离d2对应而划一确定的速度。如图10所示,第二候补速度P2在第二距离d2为直线距离h以上时达到最大并随着第二距离d2与直线距离h相比变小而变慢。候补速度获取部262将第一候补速度P1及第二候补速度P2输出到调整速度获取部264及限制速度选择部265。需要说明的是,在图9中,向第一设计面45A接近的方向为负方向。在图10中,向第二设计面452接近的方向为负方向。在本实施方式中,第一候补速度P1比第二候补速度P2慢。
相对速度获取部263基于从操作装置25获取的大臂操作信号M1、小臂操作信号M2及铲斗操作信号M3计算出刃尖8a的速度Q及背面端8b的速度Q’。另外,如图7所示,相对速度获取部263基于速度Q获取刃尖8a相对于目标设计面45A的第一相对速度Q1。如图8所示,相对速度获取部263基于速度Q’获取背面端8b相对于目标设计面45A的第二相对速度Q2。相对速度获取部263将第一相对速度Q1和第二相对速度Q2输送到调整速度获取部264。
调整速度获取部264从候补速度获取部262获取第一候补速度P1并从相对速度获取部263获取第一相对速度Q1。调整速度获取部264获取用于将第一相对速度Q1限制在第一候补速度P1所需要的大臂缸10的伸缩速度的第一调整速度S1。
在此,图11是用于说明第一调整速度S1的获取方法的视图。如图11所示,为了将第一相对速度Q1控制在第一候补速度P1,需要使第一相对速度Q1减少第一差值R1(=Q1-P1)。另一方面,需要仅通过以大臂销13为中心的大臂6的旋转速度的减速而调整大臂6的速度,以便第一相对速度Q1减小第一差值R1。由此,能够获取基于第一差值R1的第一调整速度S1。
另外,调整速度获取部264从候补速度获取部262获取第二候补速度P2并且从相对速度获取部263获取第二相对速度Q2。调整速度获取部264获取用于将第二相对速度Q2限制在第二候补速度P2所需要的大臂缸10的伸缩速度的第二调整速度S2。
在此,图12是用于说明第二调整速度S2的获取方法的视图。如图12所示,为了将第二相对速度Q2控制在第二候补速度P2,需要使第二相对速度Q2减少第二差值R2(=Q2-P2)。另一方面,需要仅通过以大臂销13为中心的大臂6的旋转速度的减速而调整大臂6的速度,以便第二相对速度Q2减小第二差值R2。由此,能够获取基于第二差值R2的第二调整速度S2。
在本实施方式中,如图7和图8所示,不管第二间隔d2比第一间隔d1大,如图11及图12所示,第二调整速度S2都比第一调整速度S1大。这是因为,由于刃尖8a的速度Q与背面端8b的速度Q’不同,导致有时刃尖8a的第一相对速度Q1与背面端8b的第二相对速度Q2不同。因此,在本实施方式中,如后文所述,执行相比刀尖8a自目标设计面45A更分开的背面端8b为基准的速度限制。
限制速度选择部265从候补速度获取部262获取第一候补速度P1及第二候补速度P2,并且从调整速度获取部264获取第一调整速度S1及第二调整速度S2。限制速度选择部265基于第一调整速度S1及第二调整速度S2,选择第一候补速度P1和第二候补速度P2中的一方作为限制速度U。具体而言,限制速度选择部265在第一调整速度S1比第二调整速度S2大时,选择第一候补速度P1作为限制速度U。另一方面,限制速度选择部265在第二调整速度S2比第一调整速度S1大时,选择第二候补速度P2作为限制速度U。在本实施方式中,因为第二调整速度S2比第一调整速度S1大,所以限制速度选择部265选择第二候补速度P2作为限制速度U。
液压缸控制部266将背面端8b相对于与被选择作为限制速度U的第二候补速度P2相关的目标设计面45A的第二相对速度Q2限制在限制速度U(即,第二候补速度P2)。在本实施方式中,为了仅通过大臂6的旋转速度的减速将第二相对速度Q2控制在第二候补速度P2,液压缸控制部266修正大臂操作信号M1并将修正后的大臂操作信号M1输出到比例控制阀27。另一方面,工作装置控制器26对小臂操作信号M2及铲斗操作信号M3不进行修正并将它们输出到比例控制阀27。
由此,经由比例控制阀27供给到大臂缸10、小臂缸11及铲斗缸12的工作油的流量被控制,从而背面端8b的第二相对速度Q2被限制在第二候补速度P2。
〈挖掘控制系统200的工作〉
图13是用于说明挖掘控制系统200的工作的流程图。
在步骤S10中,挖掘控制系统200获取设计地形数据及液压挖掘机100的当前位置数据。
在步骤S20中,挖掘控制系统200获取大臂缸长度N1、小臂缸长度N2及铲斗缸长度N3。
在步骤S30中,挖掘控制系统200基于设计地形数据、当前位置数据、大臂缸长度N1、小臂缸长度N2及铲斗缸长度N3计算出第一距离d1及第二距离d2(参照图7、图8)。
在步骤S40中,挖掘控制系统200获取与第一距离d1相对应的第一候补速度P1和与第二距离d2相对应的第二候补速度P2(参照图9、图10)。
在步骤S50中,挖掘控制系统200基于大臂操作信号M1、小臂操作信号M2及铲斗操作信号M3,计算出刃尖8a的速度Q及背面端8b的速度Q’(参照图7、图8)。
在步骤S60中,挖掘控制系统200基于速度Q及速度Q’获取第一相对速度Q1及第二相对速度Q2(参照图7、图8)。
在步骤S70中,挖掘控制系统200获取用于将第一相对速度Q1限制在第一候补速度P1所需要的大臂缸10的伸缩速度的第一调整速度S1(参照图11)。
在步骤S80中,挖掘控制系统200获取用于将第二相对速度Q2限制在第二候补速度P2所需要的大臂缸10的伸缩速度的第二调整速度S2。(参照图12)。
在步骤S90中,挖掘控制系统200基于第一调整速度S1及第二调整速度S2,选择第一候补速度P1及第二候补速度P2中的一方作为限制速度U。挖掘控制系统200选择与第一调整速度S1和第二调整速度S2中较大的一方相关的候补速度P作为限制速度U。在本实施方式中,因为第二调整速度S2比第一调整速度S1大,所以选择第二候补速度P2作为限制速度U。
在步骤S100中,挖掘控制系统200将与被选择作为限制速度U的第二候补速度P2相关的背面端8b的第二相对速度Q2限制在限制速度U(即,第二候补速度P2)。
〈作用及效果〉
(1)本实施方式的挖掘控制系统200获取用于将第一相对速度Q1限制在第一候补速度P1所需要的大臂缸10的伸缩速度的第一调整速度S1和用于将第二相对速度Q2限制在第二候补速度P2所需要的大臂缸10的伸缩速度的第二调整速度S2。挖掘控制系统200选择与第一调整速度S1和第二调整速度S2中较大的一方相关的候补速度P作为限制速度U。
由此,监视刃尖8a和背面端8b,并且与第一间隔d1及第二间隔d2无关地基于大臂缸10的伸缩速度的调整速度S执行速度限制。因此,能够以刃尖8a与背面端8b中的大臂缸10的伸缩速度的调整速度S较大的一方为基准执行速度限制。
在此,在以调整速度S小的刃尖8a为基准进行速度限制后,如果在调整速度S大的背面端8b接近目标设计面45A时以背面端8b为基准进行速度限制,则存在来不及调整大臂缸10的伸缩速度的情况。在这种情况下,如果背面端8b越过目标设计面45A则不能按照设计面进行挖掘,另外如果强行调整大臂缸10就会产生紧急驱动引起的冲击,从而不能执行合适的挖掘控制。
另一方面,如上所述,利用本实施方式的挖掘控制系统200,因为以调整速度S大的背面端8b为基准执行速度限制,所以能够使大臂缸10的调整具有富余。因此,能够抑制背面端8b越过目标设计面45A及紧急驱动引起的冲击的产生,从而能够执行合适的挖掘控制。
(2)本实施方式的挖掘控制系统200利用大臂缸10的伸缩速度的调整执行速度限制。
因此,通过只修正与操作员的操作相对应的操作信号中的大臂操作信号M1来执行速度限制。即,大臂6、小臂7及铲斗8中不按照操作员的操作驱动的只有大臂6。因此,与调整大臂6、小臂7及铲斗8中两个以上的被驱动部件的伸缩速度的情况相比,能够抑制操作员的操作感受损。
〈其他实施方式〉
以上说明了本发明的一实施方式,但是本发明不限于上述实施方式,在不脱离本发明要旨的范围内能够进行各种变更。
(A)在上述实施方式中,挖掘控制系统200在铲斗8中将刃尖8a与背面端8b作为监视点设定,但是不限于此。在挖掘控制系统200中,可以在铲斗8的外周上设定两个以上的监视点。
(B)在上述实施方式中,挖掘控制系统200利用大臂6的旋转速度的减速将相对速度抑制在限制速度,但是不限于此。挖掘控制系统200除了调整大臂6的旋转速度以外,也可以调整小臂7与铲斗8中的至少一方的旋转速度。由此,因为能够抑制平行于设计面45方向的铲斗8的速度由于速度限制而降低,所以能够抑制操作员的操作感受损。需要说明的是,在这种情况下,可以计算出大臂6、小臂7及铲斗8各自的调整速度的和(总计)作为调整速度S。
(C)在上述实施方式中,挖掘控制系统200基于从操作装置25获取的操作信号M,计算刃尖8a的速度Q和背面端8b的速度Q’,但是不限于此。挖掘控制系统200能够基于从第一~第三行程传感器16~18获取的各缸长度N1~N3在单位时间内的变化量直接计算出速度Q和速度Q’。在这种情况下,与基于操作信号M计算出速度Q和速度Q’的情况相比,能够精确地计算出速度Q和速度Q’。
(D)在上述实施方式中,如图9和图10所示,候补速度与距离具有线性关系,但是并不限于此。将候补速度与距离之间的关系可以适当地设定,可以不是线性的,也可以不通过原点。
工业实用性
本发明因为能够提供能够执行合适的挖掘控制的工作装置控制系统,所以在建筑机械领域中是有用的。
符号说明
1…车辆主体、2…工作装置、3…上部旋转体、4…驾驶室、5…行驶装置、5a,5b…履带、6…大臂、7…小臂、8…铲斗、8a…刃尖、8b…背面端、10…大臂缸、11…小臂缸、12…铲斗缸、13…大臂销、14…小臂销、15…铲斗销、16…第一行程传感器、17…第二行程传感器、18…第三行程传感器、19…位置检测部、21…第一GNSS天线、22…第二GNSS天线、23…三维位置传感器、24…倾斜角传感器、25…操作装置、26…工作装置控制器、261…相对距离获取部、262…候补速度获取部、263…相对速度获取部、264…调整速度获取部、265…限制速度选择部、266…液压缸控制部、27…比例控制阀、28…显示控制器、29…显示部、31…大臂操作部件、…32小臂操作部件、33…铲斗操作部件、45…设计面、45A…目标设计面、100…液压挖掘机、200…挖掘控制系统、C…速度限制干预线、h…直线距离。
Claims (7)
1.一种挖掘控制系统,其特征在于,包括:
工作装置,由包括铲斗在内的多个被驱动部件构成,能够转动地支承于车辆主体;
多个液压缸,分别驱动多个所述被驱动部件;
候补速度获取部,获取第一候补速度和第二候补速度,所述第一候补速度对应于所述铲斗的第一监视点与表示挖掘对象的目标形状的设计面之间的第一间隔,所述第二候补速度对应于与所述第一监视点不同的所述铲斗的第二监视点与所述设计面之间的第二间隔;
相对速度获取部,获取所述第一监视点相对于所述设计面的第一相对速度和所述第二监视点相对于所述设计面的第二相对速度;
限制速度选择部,基于所述第一相对速度与所述第一候补速度之间的相对关系及所述第二相对速度与所述第二候补速度之间的相对关系,选择所述第一候补速度及所述第二候补速度中的一方作为限制速度;
液压缸控制部,通过向多个所述液压缸供给工作油,将与所述第一监视点及所述第二监视点中的与所述限制速度相关的监视点相对于所述设计面的相对速度限制在所述限制速度;
所述第一候补速度随着所述第一间隔变小而变慢;
所述第二候补速度随着所述第二间隔变小而变慢。
2.一种挖掘控制系统,其特征在于,包括:
工作装置,由包括铲斗在内的多个被驱动部件构成,能够转动地支承于车辆主体;
多个液压缸,分别驱动多个所述被驱动部件;
候补速度获取部,获取第一候补速度和第二候补速度,所述第一候补速度对应于所述铲斗的第一监视点与表示挖掘对象的目标形状的设计面之间的第一间隔,所述第二候补速度对应于与所述第一监视点不同的所述铲斗的第二监视点与所述设计面之间的第二间隔;
相对速度获取部,获取所述第一监视点相对于所述设计面的第一相对速度和所述第二监视点相对于所述设计面的第二相对速度;
限制速度选择部,基于所述第一相对速度与所述第一候补速度之间的相对关系及所述第二相对速度与所述第二候补速度之间的相对关系,选择所述第一候补速度及所述第二候补速度中的一方作为限制速度;
液压缸控制部,通过向多个所述液压缸供给工作油,将与所述第一监视点及所述第二监视点中的与所述限制速度相关的监视点相对于所述设计面的相对速度限制在所述限制速度;
调整速度获取部,所述调整速度获取部获取第一调整速度和第二调整速度,所述第一调整速度表示用于将所述第一相对速度限制在所述第一候补速度所需要的多个所述液压缸各自的伸缩速度的目标速度,所述第二调整速度表示用于将所述第二相对速度限制在所述第二候补速度所需要的多个所述液压缸各自的伸缩速度的目标速度;
所述限制速度选择部在所述第一调整速度比所述第二调整速度大时,选择所述第一候补速度作为所述限制速度,在所述第二调整速度比所述第一调整速度大时,选择所述第二候补速度作为所述限制速度。
3.如权利要求2所述的挖掘控制系统,其特征在于,
多个所述被驱动部件包括能够转动地安装于所述车辆主体的大臂,
多个所述液压缸包括驱动所述大臂的大臂缸,
所述第一调整速度及所述第二调整速度分别与所述大臂缸的伸缩速度的目标速度一致。
4.如权利要求2所述的挖掘控制系统,其特征在于,
多个所述被驱动部件包括能够转动地安装于所述车辆主体的大臂及与所述大臂和所述铲斗连结的小臂,
多个所述液压缸包括驱动所述大臂的大臂缸及驱动所述小臂的小臂缸,
所述第一调整速度及所述第二调整速度分别与所述大臂缸及所述小臂缸各自的伸缩速度的目标速度一致。
5.如权利要求2所述的挖掘控制系统,其特征在于,
包括操作部件,所述操作部件接收驱动所述工作装置的用户的操作并根据所述用户的操作输出操作信号,
所述相对速度获取部基于所述操作信号获取所述第一相对速度及所述第二相对速度。
6.如权利要求2所述的挖掘控制系统,其特征在于,
所述相对速度获取部基于多个所述液压缸各自的伸缩速度的总计,获取所述第一相对速度和所述第二相对速度。
7.如权利要求1所述的挖掘控制系统,其特征在于,
所述第一监视点设置在所述铲斗的刃尖上,
所述第二监视点设置在所述铲斗的底板上。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2011-066826 | 2011-03-24 | ||
JP2011066826 | 2011-03-24 | ||
PCT/JP2012/052687 WO2012127914A1 (ja) | 2011-03-24 | 2012-02-07 | 掘削制御システム |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103354854A CN103354854A (zh) | 2013-10-16 |
CN103354854B true CN103354854B (zh) | 2016-02-10 |
Family
ID=46879082
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201280008763.XA Active CN103354854B (zh) | 2011-03-24 | 2012-02-07 | 挖掘控制系统 |
Country Status (6)
Country | Link |
---|---|
US (1) | US9020709B2 (zh) |
JP (1) | JP5548307B2 (zh) |
KR (1) | KR101757366B1 (zh) |
CN (1) | CN103354854B (zh) |
DE (1) | DE112012000539B4 (zh) |
WO (1) | WO2012127914A1 (zh) |
Families Citing this family (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE112012000540B4 (de) * | 2011-03-24 | 2019-01-31 | Komatsu Ltd. | Steuersystem für eine Arbeitseinheit, Baumaschine und Steuerverfahren für eine Arbeitseinheit |
JP5603520B1 (ja) * | 2012-10-19 | 2014-10-08 | 株式会社小松製作所 | 油圧ショベルの掘削制御システム |
FI20135085L (fi) | 2013-01-29 | 2014-07-30 | John Deere Forestry Oy | Menetelmä ja järjestelmä työkoneen puomiston ohjaamiseksi kärkiohjauksella |
US9464406B2 (en) | 2013-04-12 | 2016-10-11 | Komatsu Ltd. | Control system for construction machine and control method |
US9458598B2 (en) * | 2014-04-24 | 2016-10-04 | Komatsu Ltd. | Work vehicle |
WO2015181989A1 (ja) * | 2014-05-30 | 2015-12-03 | 株式会社小松製作所 | 作業機械の制御システム、作業機械及び作業機械の制御方法 |
US20170121930A1 (en) * | 2014-06-02 | 2017-05-04 | Komatsu Ltd. | Construction machine control system, construction machine, and method of controlling construction machine |
CN105431597B (zh) * | 2014-06-02 | 2017-12-29 | 株式会社小松制作所 | 建筑机械的控制系统、建筑机械及建筑机械的控制方法 |
DE112014000106B4 (de) * | 2014-06-02 | 2017-04-06 | Komatsu Ltd. | Baumaschinen-Steuersystem, Baumaschine und Verfahren zum Steuern einer Baumaschine |
WO2015025987A1 (ja) * | 2014-09-10 | 2015-02-26 | 株式会社小松製作所 | 作業車両 |
KR102488448B1 (ko) * | 2015-03-27 | 2023-01-12 | 스미토모 겐키 가부시키가이샤 | 쇼벨 |
JP6703942B2 (ja) | 2016-03-17 | 2020-06-03 | 株式会社小松製作所 | 作業車両の制御システム、制御方法、及び作業車両 |
DE112016000064B4 (de) * | 2016-03-29 | 2020-10-22 | Komatsu Ltd. | Steuervorrichtung für Arbeitsmaschine, Arbeitsmaschine und Verfahren zur Steuerung der Arbeitsmaschine |
CN106759585A (zh) * | 2016-12-13 | 2017-05-31 | 太原重型机械集团工程技术研发有限公司 | 挖掘机的挖掘斗控制方法及装置 |
CN109563698B (zh) * | 2017-03-29 | 2021-04-20 | 日立建机株式会社 | 作业机械 |
KR102065478B1 (ko) | 2017-04-10 | 2020-01-13 | 가부시키가이샤 고마쓰 세이사쿠쇼 | 건설 기계 및 제어 방법 |
AU2018258521B2 (en) * | 2017-04-27 | 2020-04-30 | Komatsu Ltd. | Control system for work vehicle, method, and work vehicle |
CN111032969B (zh) * | 2017-10-30 | 2022-02-25 | 日立建机株式会社 | 作业机械 |
US11377813B2 (en) * | 2018-09-20 | 2022-07-05 | Hitachi Construction Machinery Co., Ltd. | Work machine with semi-automatic excavation and shaping |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1995030059A1 (fr) * | 1994-04-28 | 1995-11-09 | Hitachi Construction Machinery Co., Ltd. | Dispositif de commande d'excavation a limitation de surface de travail pour engin de terrassement |
JPH08134949A (ja) * | 1994-11-04 | 1996-05-28 | Hitachi Constr Mach Co Ltd | 建設作業機の制御装置 |
CN1157020A (zh) * | 1995-08-14 | 1997-08-13 | 日立建机株式会社 | 建筑机械中区域限制挖掘控制用的挖掘区域设定装置 |
JP2009179968A (ja) * | 2008-01-29 | 2009-08-13 | Hitachi Constr Mach Co Ltd | 油圧ショベルのフロント制御装置 |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1991013217A1 (en) * | 1990-02-28 | 1991-09-05 | Hitachi Construction Machinery Co., Ltd. | Hydraulic drive system in construction machine |
KR0173835B1 (ko) * | 1994-06-01 | 1999-02-18 | 오까다 하지모 | 건설기계의 영역제한 굴삭제어장치 |
JP3091667B2 (ja) * | 1995-06-09 | 2000-09-25 | 日立建機株式会社 | 建設機械の領域制限掘削制御装置 |
US5960378A (en) * | 1995-08-14 | 1999-09-28 | Hitachi Construction Machinery Co., Ltd. | Excavation area setting system for area limiting excavation control in construction machines |
US5957989A (en) * | 1996-01-22 | 1999-09-28 | Hitachi Construction Machinery Co. Ltd. | Interference preventing system for construction machine |
JP3811190B2 (ja) * | 1997-06-20 | 2006-08-16 | 日立建機株式会社 | 建設機械の領域制限掘削制御装置 |
JP3511453B2 (ja) * | 1997-10-08 | 2004-03-29 | 日立建機株式会社 | 油圧建設機械の原動機と油圧ポンプの制御装置 |
US6336067B1 (en) * | 1998-08-12 | 2002-01-01 | Hitachi Construction Machinery Co., Ltd. | Electronic control system and control device for construction machine |
JP4493990B2 (ja) * | 2003-11-26 | 2010-06-30 | 日立建機株式会社 | 走行式油圧作業機 |
US8214110B2 (en) * | 2007-03-29 | 2012-07-03 | Komatsu Ltd. | Construction machine and method of controlling construction machine |
US7762013B2 (en) * | 2007-06-29 | 2010-07-27 | Vermeer Manufacturing Company | Trencher with auto-plunge and boom depth control |
JP5156312B2 (ja) * | 2007-09-19 | 2013-03-06 | 株式会社小松製作所 | エンジンの制御装置 |
JP5383537B2 (ja) * | 2010-02-03 | 2014-01-08 | 日立建機株式会社 | 油圧システムのポンプ制御装置 |
-
2012
- 2012-02-07 CN CN201280008763.XA patent/CN103354854B/zh active Active
- 2012-02-07 US US13/983,116 patent/US9020709B2/en active Active
- 2012-02-07 DE DE112012000539.2T patent/DE112012000539B4/de active Active
- 2012-02-07 KR KR1020137020980A patent/KR101757366B1/ko active IP Right Grant
- 2012-02-07 JP JP2013505841A patent/JP5548307B2/ja active Active
- 2012-02-07 WO PCT/JP2012/052687 patent/WO2012127914A1/ja active Application Filing
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1995030059A1 (fr) * | 1994-04-28 | 1995-11-09 | Hitachi Construction Machinery Co., Ltd. | Dispositif de commande d'excavation a limitation de surface de travail pour engin de terrassement |
JPH08134949A (ja) * | 1994-11-04 | 1996-05-28 | Hitachi Constr Mach Co Ltd | 建設作業機の制御装置 |
CN1157020A (zh) * | 1995-08-14 | 1997-08-13 | 日立建机株式会社 | 建筑机械中区域限制挖掘控制用的挖掘区域设定装置 |
JP2009179968A (ja) * | 2008-01-29 | 2009-08-13 | Hitachi Constr Mach Co Ltd | 油圧ショベルのフロント制御装置 |
Also Published As
Publication number | Publication date |
---|---|
DE112012000539B4 (de) | 2018-07-26 |
DE112012000539T5 (de) | 2013-11-21 |
KR101757366B1 (ko) | 2017-07-12 |
KR20130113516A (ko) | 2013-10-15 |
CN103354854A (zh) | 2013-10-16 |
JP5548307B2 (ja) | 2014-07-16 |
US9020709B2 (en) | 2015-04-28 |
US20130315699A1 (en) | 2013-11-28 |
WO2012127914A1 (ja) | 2012-09-27 |
JPWO2012127914A1 (ja) | 2014-07-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103354854B (zh) | 挖掘控制系统 | |
CN103354855B (zh) | 挖掘控制系统及建筑机械 | |
CN103827400B (zh) | 液压挖掘机的挖掘控制系统 | |
CN103348063B (zh) | 工作装置控制系统、建筑机械及工作装置控制方法 | |
JP7441710B2 (ja) | ショベルとマルチコプタとを含むシステム、及び、ショベル | |
KR101752990B1 (ko) | 건설 기계의 제어 시스템, 건설 기계, 및 건설 기계의 제어 방법 | |
CN103890273B (zh) | 建筑机械的控制系统及控制方法 | |
JP5791827B2 (ja) | 作業車両 | |
KR101658326B1 (ko) | 작업 차량 및 작업 차량의 제어 방법 | |
CN103917717B (zh) | 液压挖掘机的挖掘控制系统 | |
CN104619922B (zh) | 作业车辆 | |
US20170121930A1 (en) | Construction machine control system, construction machine, and method of controlling construction machine | |
KR101821470B1 (ko) | 굴삭 기계의 제어 시스템 및 굴삭 기계 | |
JPWO2019187192A1 (ja) | 作業機械の制御システム、方法、及び作業機械 | |
US11634887B2 (en) | Method and system for controlling construction machinery |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |