CN109511268A - 作业机械以及作业机械的控制方法 - Google Patents
作业机械以及作业机械的控制方法 Download PDFInfo
- Publication number
- CN109511268A CN109511268A CN201780002863.4A CN201780002863A CN109511268A CN 109511268 A CN109511268 A CN 109511268A CN 201780002863 A CN201780002863 A CN 201780002863A CN 109511268 A CN109511268 A CN 109511268A
- Authority
- CN
- China
- Prior art keywords
- equipment
- operating device
- swing arm
- operational order
- control
- 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.)
- Withdrawn
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/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
- E02F3/32—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 working downwardly and towards the machine, e.g. with backhoes
-
- 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/2004—Control mechanisms, e.g. control levers
-
- 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/2025—Particular purposes of control systems not otherwise provided for
- E02F9/2037—Coordinating the movements of the implement and of the frame
-
- 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/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
- E02F9/2221—Control of flow rate; Load sensing arrangements
- E02F9/2232—Control of flow rate; Load sensing arrangements using one or more variable displacement pumps
- E02F9/2235—Control of flow rate; Load sensing arrangements using one or more variable displacement pumps including an electronic 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/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
- E02F9/2278—Hydraulic circuits
- E02F9/2292—Systems with two or more pumps
-
- 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/2278—Hydraulic circuits
- E02F9/2296—Systems with a variable displacement pump
-
- 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
-
- 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)
Landscapes
- Engineering & Computer Science (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Fluid Mechanics (AREA)
- Operation Control Of Excavators (AREA)
Abstract
一方案的作业机械具备工作装置、对工作装置进行操作的操作装置以及对工作装置进行控制的控制器。控制器基于来自操作装置的操作指令执行使工作装置上升的介入控制,判定从介入控制向按照操作装置的操作指令进行的工作装置的控制的切换,在基于判定结果的切换中,判断操作装置的操作指令是否是工作装置的上升指令或中立指令,基于判断结果,在操作装置的操作指令是工作装置的上升指令或中立指令的情况下,判断基于介入控制的工作装置的上升目标速度与按照操作装置的操作指令的目标速度的速度差,在速度差为规定值以上的情况下,以使工作装置的上升目标速度逐渐向按照操作装置的操作指令的目标速度变化的方式进行调整。
Description
技术领域
本发明涉及具备工作装置的作业机械以及作业机械的控制方法。
背景技术
在具备包含铲斗的前部装置的作业机械中,提出了使铲斗沿着示出施工对象的目标形状的边界面移动的控制(例如参照专利文献1)。将这样的控制称作介入控制。
在介入控制中,例如在施工对象的目标形状消失的情况下或者不由于操作员的操作而使工作装置侵占目标形状的情况下等,无需执行介入控制。无需为了避免工作装置侵占目标形状而执行使工作装置上升的控制。
在先技术文献
专利文献
专利文献1:国际公开第2016/111384号
发明内容
发明要解决的课题
在不执行介入控制时,切换成按照操作装置的操作指令进行的工作装置的控制。
由于基于介入控制的使工作装置上升的速度与按照操作装置的操作指令进行的工作装置的上升的速度之差,在控制的切换时有可能产生急剧的速度变化,可能使操作员产生不适感。
本发明是为了解决上述课题而完成的,其目的在于,提供一种能够抑制操作员的操作装置的操作的不适感的作业机械以及作业机械的控制方法。
用于解决课题的方案
一方案的作业机械具备:工作装置;对工作装置进行操作的操作装置;以及对工作装置进行控制的控制器。控制器基于来自操作装置的操作指令,执行使工作装置上升的介入控制,判定从介入控制向按照操作装置的操作指令进行的工作装置的控制的切换,在基于判定结果的切换中,判断操作装置的操作指令是否是工作装置的上升或中立指令,基于判断结果,在操作装置的操作指令是工作装置的上升或中立指令的情况下,判断基于介入控制的工作装置的上升目标速度与按照操作装置的操作指令的目标速度的速度差,在速度差为规定值以上的情况下,以使工作装置的上升目标速度逐渐向按照操作装置的操作指令的目标速度变化的方式进行调整。
优选的是,控制器包括:介入控制部,其基于来自操作装置的操作指令,执行使工作装置上升的介入控制;切换判定部,其判定从介入控制向按照操作装置的操作指令进行的工作装置的控制的切换;操作指令判断部,其在基于切换判定部的判定结果的切换中,判断操作装置的操作指令是否是工作装置的上升或中立指令;速度差判断部,其基于操作指令判断部的判断结果,在操作装置的操作指令为工作装置的上升或中立指令的情况下,判断基于介入控制的工作装置的上升目标速度与按照操作装置的操作指令的目标速度的速度差;以及速度调整部,其基于速度差判断部的判断结果,在速度差为规定值以上的情况下,以使工作装置的上升目标速度逐渐向按照操作装置的操作指令的目标速度变化的方式进行调整。
优选的是,控制器在速度差小于规定值的情况下,将工作装置的上升目标速度切换成按照操作装置的操作指令的目标速度。
一方案的作业机械的控制方法是具备工作装置和对工作装置进行操作的操作装置的作业机械的控制方法,其具备如下步骤:基于来自操作装置的操作指令,执行使工作装置上升的介入控制;判定从介入控制向按照操作装置的操作指令进行的工作装置的控制的切换;在基于判定结果的切换中,判断操作装置的操作指令是否是工作装置的上升或中立指令;基于判断结果,在操作装置的操作指令是工作装置的上升或中立指令的情况下,判断基于介入控制的工作装置的上升目标速度与按照操作装置的操作指令的目标速度的速度差;以及在速度差为规定值以上的情况下,以使工作装置的上升目标速度逐渐向按照操作装置的操作指令的目标速度变化的方式进行调整。
发明效果
作业机械以及作业机械的控制方法能够抑制操作员的操作装置的操作的不适感。
附图说明
图1是实施方式的作业机械的立体图。
图2是示出实施方式的液压挖掘机100的控制系统200以及液压系统300的结构的框图。
图3是示出实施方式的动臂缸10的液压回路301的一例的图。
图4是实施方式的工作装置控制器26的框图。
图5是示出实施方式的目标挖掘地形数据U以及铲斗8的图。
图6是用于对实施方式的动臂限制速度Vcy_bm进行说明的图。
图7是用于对实施方式的限制速度Vc_lmt进行说明的图。
图8是示出实施方式的铲斗8与目标挖掘地形43I的关系的图。
图9是示出实施方式的动臂6进行动作的速度即动臂目标速度Vbm与时间t的关系的图。
图10是对示出实施方式的作业机械的控制方法的流程进行说明的图。
具体实施方式
以下,基于附图对本发明的实施方式进行说明。需要说明的是,在以下的说明中,对同一部件标注相同的附图标记。它们的名称以及功能也相同,因此不再重复关于它们的详细说明。需要说明的是,在以下的说明中,“上”、“下”、“前”、“后”、“左”、“右”是以落座于驾驶席的操作员为基准的用语。
<作业机械的整体结构>
图1是实施方式的作业机械的立体图。
图2是示出实施方式的液压挖掘机100的控制系统200以及液压系统300的结构的框图。
如图1所示,作为作业机械的液压挖掘机100具有车辆主体1和工作装置2。
车辆主体1具有作为回转体的上部回转体3和作为行驶体的行驶装置5。上部回转体3在机室3EG的内部收容有作为动力产生装置的内燃机以及液压泵等装置。机室3EG配置在上部回转体3的一端侧。
在液压挖掘机100中,作为动力产生装置的内燃机例如使用柴油发动机等,但动力产生装置不局限于此。
液压挖掘机100的动力产生装置例如也可以为将内燃机、发电电动机以及蓄电装置组合而成的混合动力式的装置。
液压挖掘机100的动力产生装置也可以不具有内燃机而组合蓄电装置和发电电动机。
上部回转体3具有驾驶室4。驾驶室4设置在上部回转体3的另一端侧。驾驶室4设置在与配置有机室3EG的一侧相反的一侧。在驾驶室4内配置有图2所示的显示部29以及操作装置25。
行驶装置5对上部回转体3进行支承。行驶装置5具有履带5a、5b。行驶装置5通过设置于左右的行驶马达5c的一方或两方驱动履带5a、5b而使履带5a、5b旋转,从而使液压挖掘机100行驶。工作装置2安装在上部回转体3的驾驶室4的侧方。
液压挖掘机100也可以具备如下的行驶装置:该行驶装置具备轮胎来取代履带5a、5b,并将发动机的驱动力经由传动装置向轮胎传递而能够行驶。作为这种方式的液压挖掘机100,例如具有轮式液压挖掘机。
液压挖掘机100例如也可以为挖掘装载机。
就上部回转体3而言,配置有工作装置2以及驾驶室4的一侧是前侧,配置有机室3EG的一侧是后侧。当朝向前侧时,左侧为上部回转体3的左侧,当朝向前侧时,右侧为上部回转体3的右侧。上部回转体3的左右方向也称作宽度方向。液压挖掘机100或车辆主体1在以上部回转体3为基准时,行驶装置5侧为下侧,在以行驶装置5为基准时,上部回转体3侧为上侧。液压挖掘机100的前后方向为x方向,宽度方向为y方向,上下方向为z方向。在液压挖掘机100设置于水平面的情况下,下侧为铅垂方向即重力的作用方向侧,上侧为与铅垂方向相反的一侧。
工作装置2具有动臂6、斗杆7、作为作业用具的铲斗8、动臂缸10、斗杆缸11以及铲斗缸12。动臂6的基端部经由动臂销13安装于车辆主体1的前部。斗杆7的基端部经由斗杆销14安装于动臂6的前端部。在斗杆7的前端部经由铲斗销15安装有铲斗8。铲斗8以铲斗销15为中心而转动。铲斗8在与铲斗销15相反的一侧安装有多个斗齿8B。齿尖8T为斗齿8B的前端。
在实施方式中,工作装置2上升是指,工作装置2从液压挖掘机100的接地面向朝向上部回转体3的方向移动的动作。工作装置2下降是指,工作装置2从液压挖掘机100的上部回转体3向朝向接地面的方向移动的动作。液压挖掘机100的接地面是由履带5a、5b的接地部分处的至少三点定义的平面。
在为不具有上部回转体3的作业机械的情况下,工作装置2上升是指,工作装置2向远离作业机械的接地面的方向移动的动作。工作装置2下降是指,工作装置2向接近作业机械的接地面的方向移动的动作。在作业机械不具备履带而具备车轮的情况下,接地面是由至少三个车轮所接地的部分定义的平面。
铲斗8也可以不具有多个斗齿8B。也可以是不具有图1所示那样的斗齿8B、而是齿尖由钢板形成为笔直形状那样的铲斗。工作装置2例如也可以具备具有单个斗齿的倾转铲斗。倾转铲斗是指如下的铲斗:具备铲斗倾转缸,通过铲斗向左右倾转倾斜,从而即便液压挖掘机处于倾斜地面,也能够将斜面、平地成形、平整为自由的形状,并且也能够进行基于底盘的滚压作业。此外,工作装置2也可以代替铲斗8而具备法面铲斗或凿岩用附属件等来作为作业用具,该凿岩用附属件具备凿岩用的钎头。
图1所示的动臂缸10、斗杆缸11以及铲斗缸12分别是由工作油的压力(以下适当称作液压)驱动的液压缸。动臂缸10对动臂6进行驱动而使其升降。斗杆缸11对斗杆7进行驱动而使其绕斗杆销14动作。铲斗缸12对铲斗8进行驱动而使其绕铲斗销15动作。
在动臂缸10、斗杆缸11以及铲斗缸12等液压缸与图2所示的液压泵36、37之间设置有图2所示的方向控制阀64。方向控制阀64对从液压泵36、37向动臂缸10、斗杆缸11以及铲斗缸12等供给的工作油的流量进行控制,并且,切换工作油流动的方向。方向控制阀64包括:用于驱动行驶马达5c的行驶用方向控制阀;以及用于控制使动臂缸10、斗杆缸11、铲斗缸12以及上部回转体3回转的回转马达的工作装置用方向控制阀。
图2所示的工作装置控制器26通过对图2所示的控制阀27进行控制,从而控制从操作装置25向方向控制阀64供给的工作油的先导压。控制阀27设置于动臂缸10、斗杆缸11以及铲斗缸12的液压系统。工作装置控制器26通过对设置于先导油路450的控制阀27进行控制,从而能够控制动臂缸10、斗杆缸11以及铲斗缸12的动作。在实施方式中,工作装置控制器26通过将控制阀27关闭的控制,能够实现使动臂缸10、斗杆缸11以及铲斗缸12减速的控制。
在上部回转体3的上部安装有天线21、22。天线21、22用于检测液压挖掘机100的当前位置。天线21、22与图2所示的、用于检测液压挖掘机100的当前位置的位置检测部即位置检测装置19电连接。
位置检测装置19利用RTK-GNSS(Real Time Kinematic-Global NavigationSatellite Systems,GNSS称作全球导航卫星系统)来检测液压挖掘机100的当前位置。在以下的说明中,将天线21、22适当地称作GNSS天线21、22。与GNSS天线21、22接收到的GNSS电波相应的信号被向位置检测装置19输入。位置检测装置19对GNSS天线21、22的设置位置进行检测。位置检测装置19例如包括三维位置传感器。
<液压系统300>
如图2所示,液压挖掘机100的液压系统300具备作为动力产生源的内燃机35和液压泵36、37。液压泵36、37被内燃机35驱动而排出工作油。从液压泵36、37排出的工作油被供给至动臂缸10、斗杆缸11以及铲斗缸12。
液压挖掘机100具备回转马达38。回转马达38是液压马达,由从液压泵36、37排出的工作油驱动。回转马达38使上部回转体3回转。需要说明的是,图2中图示出两个液压泵36、37,但也可以仅设置一个液压泵。回转马达38不局限于液压马达,也可以是电动马达。
<控制系统200>
如图2所示,作业机械的控制系统即控制系统200包括位置检测装置19、全局坐标运算部23、操作装置25、实施方式的作业机械的控制装置即工作装置控制器26、传感器控制器39、显示控制器28以及显示部29。
操作装置25是用于对图1所示的工作装置2以及上部回转体3进行操作的装置。操作装置25是用于对工作装置2进行操作的装置。操作装置25受理用于驱动工作装置2的由操作员进行的操作,并输出与操作量相应的先导液压。
与操作量相应的先导液压是操作指令。操作指令是用于使工作装置2动作的指令。
操作指令由操作装置25生成。由于操作装置25由操作员进行操作,因此,操作指令是用于通过作为手动操作的操作员的操作而使工作装置2动作的指令。
基于手动操作的工作装置2的控制是按照来自操作装置25的操作指令进行的工作装置2的控制。是通过对工作装置2的操作装置25进行操作而进行的工作装置2的控制。
在实施方式中,操作装置25具有设置于操作员的左侧的左操作杆25L和配置于操作员的右侧的右操作杆25R。左操作杆25L以及右操作杆25R的前后左右的动作对应于斗杆7以及回转的两个轴的动作。
例如,右操作杆25R的前后方向的操作对应于动臂6的操作。当向前方操作右操作杆25R时,动臂6下降,当向后方操作右操作杆25R时,动臂6上升。与右操作杆25R的前后方向的操作相应地执行动臂6的下降上升的动作。
右操作杆25R的左右方向的操作对应于铲斗8的操作。当向左侧操作右操作杆25R时,铲斗8进行挖掘,当向右侧操作右操作杆25R时,铲斗8进行倾卸。与右操作杆25R的左右方向的操作相应地执行铲斗8的挖掘或倾卸动作。
左操作杆25L的前后方向的操作对应于斗杆7的操作。当向前方操作左操作杆25L时,斗杆7进行倾卸,当向后方操作左操作杆25L时,斗杆7进行挖掘。
左操作杆25L的左右方向的操作对应于上部回转体3的回转的操作。当向左侧操作左操作杆25L时,进行左回转,当向右侧操作左操作杆25L时,进行右回转。
在实施方式中,操作装置25使用先导液压方式。基于动臂操作、铲斗操作、斗杆操作以及回转操作,从液压泵36向操作装置25供给由减压阀25V减压至规定的先导压力的工作油。
能够与右操作杆25R的前后方向的操作相应地向先导油路450供给先导液压,从而受理操作员对动臂6的操作。右操作杆25R具备的阀装置与右操作杆25R的操作量相应地打开,向先导油路450供给工作油。
压力传感器66将先导油路450内的工作油的压力作为先导压进行检测。
压力传感器66将检测到的先导压作为动臂操作量MB向工作装置控制器26发送。以下,将右操作杆25R的前后方向的操作量适当称作动臂操作量MB。在先导油路50设置有控制阀(以下适当称作介入阀)27C以及梭阀51。之后对介入阀27C以及梭阀51进行叙述。
能够与右操作杆25R的左右方向的操作相应地向先导油路450供给先导液压,从而受理操作员对铲斗8的操作。右操作杆25R具备的阀装置与右操作杆25R的操作量相应地打开,向先导油路450供给工作油。
压力传感器66将先导油路450内的工作油的压力作为先导压进行检测。
压力传感器66将检测到的先导压作为铲斗操作量MT向工作装置控制器26发送。以下,将右操作杆25R的左右方向的操作量适当称作铲斗操作量MT。
能够与左操作杆25L的前后方向的操作相应地向先导油路450供给先导液压,从而受理操作员对斗杆7的操作。左操作杆25L具备的阀装置与左操作杆25L的操作量相应地打开,向先导油路450供给工作油。
压力传感器66将先导油路450内的工作油的压力作为先导压进行检测。
压力传感器66将检测到的先导压作为斗杆操作量MA向工作装置控制器26发送。以下,将左操作杆25L的前后方向的操作量适当称作斗杆操作量MA。
操作装置25通过右操作杆25R被操作而将与右操作杆25R的操作量相应的大小的先导液压向方向控制阀64供给。
操作装置25通过左操作杆25L被操作而将与左操作杆25L的操作量相应的大小的先导液压向方向控制阀64供给。在从操作装置25向方向控制阀64供给的先导液压的作用下,方向控制阀64动作。
控制系统200具有第一行程传感器16、第二行程传感器17以及第三行程传感器18。例如,第一行程传感器16设置于动臂缸10,第二行程传感器17设置于斗杆缸11,第三行程传感器18设置于铲斗缸12。
传感器控制器39具有RAM(Random Access Memory)及ROM(Read Only Memory)等存储部、以及CPU(Central Processing Unit)等处理部。
传感器控制器39根据第一行程传感器16检测到的动臂缸长LS1,算出动臂6相对于液压挖掘机100的局部坐标系、详细说是车辆主体1的局部坐标系中的与水平面(xy平面)正交的方向(z轴方向)的倾斜角度θ1,并将该倾斜角度θ1向工作装置控制器26以及显示控制器28输出。
传感器控制器39根据第二行程传感器17检测到的斗杆缸长LS2,算出斗杆7相对于动臂6的倾斜角度θ2,并将该倾斜角度θ2向工作装置控制器26以及显示控制器28输出。
传感器控制器39根据第三行程传感器18检测到的铲斗缸长LS3,算出铲斗8所具有的铲斗8的齿尖8T相对于斗杆7的倾斜角度θ3,并将该倾斜角度θ3向工作装置控制器26以及显示控制器28输出。
倾斜角度θ1、θ2、θ3的检测也能够由第一行程传感器16、第二行程传感器17以及第三行程传感器18以外的设备进行。例如也能够由电位计等角度传感器对倾斜角度θ1、θ2、θ3进行检测。
在传感器控制器39连接有IMU(Inertial Measurement Unit:惯性计测装置)24。IMU24获取图1所示的液压挖掘机100的绕y轴的俯仰角、绕x轴的侧倾角等这样的车身的倾斜信息并向传感器控制器39输出。
工作装置控制器26具有RAM及ROM(Read Only Memory)等存储部26Q与CPU等处理部26P。
工作装置控制器26基于图2所示的动臂操作量MB、铲斗操作量MT、斗杆操作量MA来对介入阀27C以及控制阀27进行控制。
图2所示的方向控制阀64例如是比例控制阀,由从操作装置25供给的工作油进行控制。
方向控制阀64配置在动臂缸10、斗杆缸11、铲斗缸12以及回转马达38等液压致动器与液压泵36、37之间。
方向控制阀64控制从液压泵36、37向动臂缸10、斗杆缸11、铲斗缸12以及回转马达38供给的工作油的流量以及方向。
控制系统200具备的位置检测装置19包括前述的GNSS天线21、22。与由GNSS天线21、22接收到的GNSS电波相应的信号被向全局坐标运算部23输入。
GNSS天线21从测位卫星接收表示自身位置的基准位置数据P1。GNSS天线22从测位卫星接收表示自身位置的基准位置数据P2。
GNSS天线21、22以规定的周期接收基准位置数据P1、P2。基准位置数据P1、P2是设置有GNSS天线的位置的信息。GNSS天线21、22在每次接收基准位置数据P1、P2时,向全局坐标运算部23输出。
全局坐标运算部23具有RAM及ROM等存储部和CPU等处理部。全局坐标运算部23基于两个基准位置数据P1、P2,生成表示上部回转体3的配置的回转体配置数据。
在实施方式中,回转体配置数据包括两个基准位置数据P1、P2中的一方的基准位置数据P、以及基于两个基准位置数据P1、P2而生成的回转体方位数据Q。回转体方位数据Q表示上部回转体3即工作装置2所朝向的方位。
全局坐标运算部23在每次以规定的周期从GNSS天线21、22获取两个基准位置数据P1、P2时,对作为回转体配置数据的基准位置数据P和回转体方位数据Q进行更新并向显示控制器28输出。
显示控制器28具有RAM及ROM等存储部和CPU等处理部。显示控制器28从全局坐标运算部23获取作为回转体配置数据的基准位置数据P以及回转体方位数据Q。
在实施方式中,显示控制器28生成表示铲斗8的齿尖8T的三维位置的铲斗齿尖位置数据S来作为工作装置位置数据。显示控制器28使用铲斗齿尖位置数据S和目标施工信息T,生成目标挖掘地形数据U。
目标施工信息T是成为液压挖掘机100具备的工作装置2的作业对象、在实施方式中为挖掘对象的完成目标的信息。对于目标施工信息T,例如举出液压挖掘机100的施工对象的设计信息。工作装置2的作业对象例如为地面。作为工作装置2的作业,例如举出挖掘作业以及地面的平整作业,但不局限于此。
显示控制器28导出基于目标挖掘地形数据U的显示用的目标挖掘地形数据Ua,基于显示用的目标挖掘地形数据Ua,使显示部29显示成为工作装置2的作业对象的目标的形状、例如地形。
显示部29例如是受理通过触摸面板进行的输入的液晶显示装置,但不局限于此。在实施方式中,与显示部29邻接地设置有开关29S。开关29S是用于执行后述的介入控制或者使执行中的介入控制停止的输入装置。
工作装置控制器26从压力传感器66获取动臂操作量MB、铲斗操作量MT以及斗杆操作量MA。工作装置控制器26从传感器控制器39获取动臂6的倾斜角度θ1、斗杆7的倾斜角度θ2、铲斗8的倾斜角度θ3。
工作装置控制器26从显示控制器28获取目标挖掘地形数据U。目标挖掘地形数据U是目标施工信息T中的、供液压挖掘机100今后进行作业的范围的信息。
目标挖掘地形数据U是目标施工信息T的一部分。目标挖掘地形数据U与目标施工信息T同样地表示成为工作装置2的作业对象的完成目标的形状。以下,将成为该完成目标的形状适当称作目标挖掘地形。
工作装置控制器26根据从传感器控制器39获取的工作装置2的角度,算出铲斗8的齿尖8T的位置(以下适当称作齿尖位置)。
工作装置控制器26基于目标挖掘地形数据U与铲斗8的齿尖8T的距离以及工作装置2的速度来控制工作装置2的动作,以使得铲斗8的齿尖8T沿着目标挖掘地形数据U移动。
工作装置控制器26将工作装置2的接近施工对象的方向的速度控制为限制速度以下,以抑制铲斗8侵占目标挖掘地形数据U即成为工作装置2的作业对象的目标的形状。将该控制适当称作介入控制。
介入控制在例如液压挖掘机100的操作员使用图2所示的开关29S而选择了执行介入控制的情况下被执行。在算出后述的目标挖掘地形与铲斗8的距离时,铲斗8的成为基准的位置不局限于齿尖8T,可以是任意的部位。
在介入控制中,工作装置控制器26生成动臂指令信号CBI并向图2所示的介入阀27C输出,以对工作装置2进行控制,使得铲斗8的齿尖8T沿着目标挖掘地形数据U移动。
动臂6与动臂指令信号CBI相应地动作。通过动臂6的与动臂指令信号CBI相应的动作,对工作装置2、更详细说是铲斗8的速度进行控制。与铲斗8和目标挖掘地形数据U的距离相应地,限制铲斗8向目标挖掘地形数据U接近的速度。
<液压回路301的结构>
图3是示出实施方式的动臂缸10的液压回路301的一例的图。
如图3所示,液压回路301在操作装置25与方向控制阀64之间设置有先导油路450。方向控制阀64是对向动臂缸10供给的工作油流动的方向进行控制的阀。
在实施方式中,方向控制阀64是通过使杆状的滑柱64S移动来切换工作油流动的方向的滑柱方式的阀。
滑柱64S利用从图2所示的操作装置25供给的工作油(以下适当称作先导油)而移动。方向控制阀64通过滑柱64S的移动,向动臂缸10供给工作油,从而使动臂缸10动作。
先导油路50以及先导油路450B与梭阀51连接。
梭阀51与方向控制阀64的一方由油路452B连接。方向控制阀64的另一方与操作装置25由先导油路450A和先导油路452A连接。在先导油路50设置有介入阀27C。介入阀27C调整先导油路50的先导压。
在先导油路450B设置有压力传感器66B以及控制阀27B。在先导油路450A的控制阀27A与操作装置25之间设置有压力传感器66A。压力传感器66的检测值被图2所示的工作装置控制器26获取,用于动臂缸10的控制。
压力传感器66A以及压力传感器66B对应于图2所示的压力传感器66。控制阀27A以及控制阀27B对应于图2所示的控制阀27。
从液压泵36、37供给来的工作油经由方向控制阀64向动臂缸10供给。通过滑柱64S沿轴向移动,来切断向动臂缸10的盖侧油室48R的工作油的供给与向杆侧油室47R的工作油的供给。
通过滑柱64S沿轴向移动,来调整向动臂缸10供给的工作油的每单位时间内的供给量即流量。通过对向动臂缸10供给的工作油的流量进行调整来调整动臂缸10的动作速度。
当方向控制阀64的滑柱64S向第一方向移动时,从方向控制阀64向盖侧油室48R供给工作油,当从杆侧油室47R向方向控制阀64返回工作油时,动臂缸10的活塞10P从盖侧油室48R朝向杆侧油室47R移动。其结果是,与活塞10P连接的杆10L从动臂缸10伸长。
方向控制阀64的滑柱64S在基于来自操作装置25的指令而向与第一方向相反的方向即第二方向移动时,从盖侧油室48R向方向控制阀64返回工作油。当从方向控制阀64向杆侧油室47R供给工作油时,动臂缸10的活塞10P从杆侧油室47R朝向盖侧油室48R移动。其结果是,与活塞10P连接的杆10L向动臂缸10退缩。这样,通过对方向控制阀64的滑柱64S的移动方向进行调整来变更动臂缸10的动作方向。
通过对方向控制阀64的滑柱64S的移动量进行调整,从而向动臂缸10供给、并从动臂缸10向方向控制阀64返回的工作油的流量发生改变,因此,动臂缸10的动作速度即活塞10P以及杆10L的移动速度发生改变。
如前所述,方向控制阀64的动作由操作装置25控制。从图2所示的液压泵36排出并被减压阀25V减压后的工作油作为先导油被供给至操作装置25。
操作装置25基于各操作杆的操作对先导液压进行调整。利用调整后的先导液压来驱动方向控制阀64。通过操作装置25对先导液压的大小以及先导液压的方向进行调整,从而调整关于轴向的滑柱64S的移动量以及移动方向。其结果是,动臂缸10的动作速度以及动作方向发生改变。
工作装置控制器26在介入控制中,如前述那样基于表示挖掘对象的目标形状即设计地形的目标挖掘地形(目标挖掘地形数据U)和用于求出铲斗8的位置的倾斜角度θ1、θ2、θ3,以使铲斗8接近目标挖掘地形43I的速度与目标挖掘地形43I和铲斗8的距离相应地变小的方式对动臂6的速度进行限制。
在实施方式中,在工作装置2基于操作装置25的操作而动作的情况下,工作装置控制器26生成动臂指令信号CBI,并使用该动臂指令信号CBI来控制动臂6的动作,以避免铲斗8的齿尖8T侵入目标挖掘地形43I。
详细而言,工作装置控制器26在介入控制中使动臂6上升,以避免齿尖8T侵入目标挖掘地形43I。将在介入控制中执行的使动臂6上升的控制适当称作动臂介入控制。
在实施方式中,为了使工作装置控制器26实现动臂介入控制,工作装置控制器26生成与动臂介入控制相关的动臂指令信号CBI并向介入阀27C输出。
介入阀27C能够对先导油路50的先导液压进行调整。梭阀51具有两个入口51Ia、51Ib和一个出口51E。一方的入口51Ia与介入阀27C连接。另一方的入口51Ib与控制阀27B连接。出口51E与连接到方向控制阀64的油路452B连接。
梭阀51将两个入口51Ia、51Ib中的先导液压高的入口与油路452B连接。
例如,在入口51Ia的先导液压比入口51Ib的先导液压高的情况下,梭阀51将介入阀27C与油路452B连接。其结果是,通过了介入阀27C的先导油经由梭阀51向油路452B供给。在入口51Ib的先导液压比入口51Ia的先导液压高的情况下,梭阀51将控制阀27B与油路452B连接。其结果是,通过了控制阀27B的先导油经由梭阀51向油路452B供给。
在不执行动臂介入控制时,基于通过操作装置25的操作而调整后的先导液压来驱动方向控制阀64。例如,工作装置控制器26利用控制阀27B来打开先导油路450B(成为全开),并且对介入阀27C进行控制而关闭先导油路50,以使得基于通过操作装置25的操作而调整后的先导液压来驱动方向控制阀64。
在执行动臂介入控制时,工作装置控制器26以基于由介入阀27C调整后的先导液压来驱动方向控制阀64的方式对控制阀27进行控制。例如,在执行作为动臂介入控制的对铲斗8向目标挖掘地形43I的移动进行限制的控制的情况下,工作装置控制器26以由介入阀27C调整后的先导油路50的先导液压高于由操作装置25调整的先导油路450B的先导液压的方式对介入阀27C进行控制。通过这种方式,将来自介入阀27C的先导油经由梭阀51供给至方向控制阀64。
工作装置控制器26在执行动臂介入控制的情况下,生成例如用于使动臂6上升的速度指令即动臂指令信号CBI,并对介入阀27C进行控制。通过这种方式,动臂缸10的方向控制阀64以使动臂6按照与动臂指令信号CBI对应的速度而上升的方式向动臂缸10供给工作油,因此,动臂缸10使动臂6上升。
对动臂缸10的液压回路301进行了说明,但斗杆缸11的液压回路以及铲斗缸12的液压回路是从动臂缸10的液压回路301中去掉了介入阀27C、梭阀51以及先导油路50的结构。
动臂介入控制是在介入控制中执行的使动臂6上升的控制,但在介入控制中,工作装置控制器26也可以在动臂6的上升的基础上或者取代动臂6的上升,而使斗杆7以及铲斗8中的至少一方上升。
在介入控制中,工作装置控制器26使构成工作装置2的动臂6、斗杆7以及铲斗8中的至少一者上升,由此使工作装置2向远离工作装置2的作业对象的目标形状、在实施方式中为目标挖掘地形43I的方向移动。
在实施方式中,将在工作装置2基于操作装置25的操作而动作的情况下,工作装置控制器26使构成工作装置2的动臂6、斗杆7以及铲斗8中的至少一者动作的控制称作介入控制。
介入控制是在工作装置2基于操作装置25的操作即手动操作而动作的情况下,工作装置控制器26使工作装置动作的控制。前述的动臂介入控制是介入控制的一方式。
图4是实施方式的工作装置控制器26的框图。
图5是示出实施方式的目标挖掘地形数据U以及铲斗8的图。
图6是用于对实施方式的动臂限制速度Vcy_bm进行说明的图。
图7是用于对实施方式的限制速度Vc_lmt进行说明的图。
工作装置控制器26包括判定部26J和控制部26CNT。控制部26CNT包括相对位置算出部26A、距离算出部26B、目标速度算出部26C、介入速度算出部26D、介入指令算出部26E以及介入速度修正部26F。
判定部26J、相对位置算出部26A、距离算出部26B、目标速度算出部26C、介入速度算出部26D、介入指令算出部26E以及介入速度修正部26F的功能由图2所示的工作装置控制器26的处理部26P来实现。
在执行介入控制时,工作装置控制器26使用动臂操作量MB、斗杆操作量MA、铲斗操作量MT、从显示控制器28获取的目标挖掘地形数据U、铲斗齿尖位置数据S以及从传感器控制器39获取的倾斜角度θ1、θ2、θ3,生成介入控制所需的动臂指令信号CBI,并根据需要生成斗杆指令信号以及铲斗指令信号,对控制阀27以及介入阀27C进行驱动来控制工作装置2。
相对位置算出部26A从显示控制器28获取铲斗齿尖位置数据S,从传感器控制器39获取倾斜角度θ1、θ2、θ3。相对位置算出部26A根据所获取的倾斜角度θ1、θ2、θ3而求出铲斗8的齿尖8T的位置即齿尖位置Pb。
距离算出部26B根据由相对位置算出部26A求出的齿尖位置Pb和从显示控制器28获取的目标挖掘地形数据U,算出铲斗8的齿尖8T与由作为目标施工信息T的一部分的目标挖掘地形数据U表示的目标挖掘地形43I之间的最短的距离d。距离d是齿尖位置Pb与位置Pu之间的距离,该位置Pu是正交于目标挖掘地形43I且通过齿尖位置Pb的直线与目标挖掘地形数据U交叉的位置。
目标挖掘地形43I根据在上部回转体3的前后方向上规定且通过挖掘对象位置Pdg的工作装置2的平面与由多个目标施工面表示的目标施工信息T的交线来求出。
更详细而言,前述的交线中的、目标施工信息T的挖掘对象位置Pdg的前后的单个或多个拐点及其前后的线为目标挖掘地形43I。
在图5所示的例子中,两个拐点Pv1、Pv2及其前后的线为目标挖掘地形43I。挖掘对象位置Pdg是铲斗8的齿尖8T的位置即齿尖位置Pb的正下方的点。这样,目标挖掘地形43I是目标施工信息T的一部分。目标挖掘地形43I由图2所示的显示控制器28生成。
目标速度算出部26C决定动臂目标速度Vc_bm、斗杆目标速度Vc_am以及铲斗目标速度Vc_bkt。动臂目标速度Vc_bm是动臂缸10被驱动时的齿尖8T的速度。斗杆目标速度Vc_am是斗杆缸11被驱动时的齿尖8T的速度。铲斗目标速度Vc_bkt是铲斗缸12被驱动时的齿尖8T的速度。动臂目标速度Vc_bm与动臂操作量MB相应地算出。斗杆目标速度Vc_am与斗杆操作量MA相应地算出。铲斗目标速度Vc_bkt与铲斗操作量MT相应地算出。
介入速度算出部26D基于铲斗8的齿尖8T与目标挖掘地形43I之间的距离d,求出动臂6的限制速度(动臂限制速度)Vcy_bm。
如图6所示,介入速度算出部26D从图1所示的工作装置2整体的限制速度Vc_lmt减去斗杆目标速度Vc_am以及铲斗目标速度Vc_bkt,由此求出动臂限制速度Vcy_bm。
限制速度Vc_lmt是铲斗8的齿尖8T在接近目标挖掘地形43I的方向上能够允许的齿尖8T的移动速度。
如图7所示,限制速度Vc_lmt在距离d为正的情况下是负值,是工作装置2下降时的下降速度,在距离d为负的情况下是正值,是工作装置2上升时的上升速度。
距离d为负值是指,铲斗8侵占了目标挖掘地形43I的状态。限制速度Vc_lmt随着距离d变小而速度的绝对值变小,当距离d为负值时,随着距离d的绝对值变大而速度的绝对值变大。
判定部26J判定是否对动臂限制速度Vcy_bm进行修正。
在判定部26J判定为对动臂限制速度Vcy_bm进行修正的情况下,介入速度修正部26F修正动臂限制速度Vcy_bm并输出。修正后的动臂限制速度由Vcy_bm’表示。
在判定部26J判定为不对动臂限制速度Vcy_bm进行修正的情况下,介入速度修正部26F将动臂限制速度Vcy_bm在不修正的状态下输出。介入指令算出部26E根据由介入速度修正部26F求出的动臂限制速度Vcy_bm来生成动臂指令信号CBI。
动臂指令信号CBI是用于使介入阀27C的开度成为使如下的先导压力作用于梭阀51所需的大小的指令,所述的先导压力是为了使动臂6以动臂限制速度Vcy_bm上升所需的先导压力。动臂指令信号CBI在实施方式中是与动臂指令速度相应的电流值。
判定部26J包括切换判定部26K、操作指令判断部26L以及速度差判断部26M。
切换判定部26K判定是否不需要介入控制。
操作指令判断部26L判断操作员是否对右操作杆25R进行使动臂6上升的操作或中立操作。中立操作是不进行上升或下降的操作的状态。是右操作杆25R处于中间位置的状态。
速度差判断部26M判断动臂限制速度Vcy_bm与按照操作员对右操作杆25R进行的使动臂6上升的操作的动臂目标速度Vc_bm之间的速度差。或者,速度差判断部26M判断动臂限制速度Vcy_bm与按照操作员对右操作杆25R进行的中立操作的动臂目标速度0之间的速度差。具体而言,判断该速度差是否为阈值Dr以上。
在实施例中,判定部26J在不需要介入控制的情况下,当操作员对右操作杆25R进行使动臂6上升的操作时,若动臂限制速度Vcy_bm与按照操作员对右操作杆25R进行的使动臂6上升的操作的动臂目标速度Vc_bm之间的速度差为阈值Dr以上,则对动臂限制速度Vcy_bm进行修正。另外,判定部26J在不需要介入控制的情况下,当操作员对右操作杆25R进行中立操作时,若动臂限制速度Vcy_bm与按照操作员对右操作杆25R进行的中立操作的动臂目标速度0之间的速度差为阈值Dr以上,则对动臂限制速度Vcy_bm进行修正。
<动臂介入控制的方式>
图8是示出实施方式的铲斗8与目标挖掘地形43I的关系的图。
如图8所示,介入控制是以避免铲斗8侵占目标挖掘地形43I的方式使铲斗8移动的控制。在工作装置控制器26执行介入控制的情况下,当铲斗8要侵占目标挖掘地形43I时,工作装置控制器26执行动臂介入控制。
如图8所示,介入控制在由于操作员操作而工作装置要侵占目标挖掘地形43I的情况下被执行。
在铲斗8向图8所示的箭头Y的方向移动而成为不会由于操作员操作使工作装置侵占目标挖掘地形43I的状况时,不再执行介入控制。
当成为不会由于操作员操作使工作装置侵占目标挖掘地形43I的状况时,不需要介入控制。
在工作装置控制器26执行介入控制的情况下,有时液压挖掘机100的操作员执行使工作装置2以及铲斗8朝上移动的操作。
在如图8所示那样铲斗8脱离了目标挖掘地形43I所存在的区域的情况下解除介入控制时,从介入控制切换为基于手动操作的工作装置2的控制。
在从介入控制向基于手动操作的工作装置2的控制切换时,发生急剧的速度变化,结果使操作员产生不适感。
图9是示出实施方式的动臂6动作的速度即动臂目标速度Vbm与时间t的关系的图。
如图9所示,纵轴是动臂目标速度Vbm,横轴是时间t。动臂目标速度Vbm在取正值的情况下表示动臂6上升的速度即上升速度,在取负值的情况下表示动臂6下降的速度即下降速度。
由于动臂6是工作装置2的一部分,因此,动臂目标速度Vbm是工作装置2的速度。动臂6的上升速度对应于工作装置2的上升速度,动臂6的下降速度对应于工作装置2的下降速度。
在实施方式中,将工作装置2的上升速度以及下降速度称作工作装置2的移动速度。工作装置2的移动速度在工作装置2上升时取正值,在下降时取负值。
工作装置控制器26在铲斗8脱离了目标挖掘地形43I所存在的区域的情况下,在不需要动臂介入控制的情况下,将动臂目标速度Vbm设定为由液压挖掘机100的操作员的操作决定的动臂目标速度Vbop。
工作装置控制器26在规定条件的情况下,使动臂目标速度Vbm从不需要动臂介入控制之前的动臂限制速度Vcy_bm1以一定的变化率VRC减少而设定成动臂目标速度Vbop。
在不需要动臂介入控制的情况下,从针对工作装置2的介入控制切换成基于来自操作装置25的操作指令进行的工作装置2的控制。
在实施方式中,工作装置控制器26在不需要动臂介入控制的情况下,在来自操作装置25的操作指令是动臂6的上升指令或中立指令的情况下,对按照动臂介入控制的动臂限制速度Vcy_bm1与由操作员的操作决定的动臂目标速度Vbop或0进行比较。然后,算出动臂限制速度Vcy_bm1与动臂目标速度Vbop或0的差D。动臂限制速度Vcy_bm1与动臂目标速度Vbop或0的差D越大,则意味着速度变化越大。
在实施方式中,判断动臂限制速度Vcy_bm1与动臂目标速度Vbop或0的差D是否为阈值Dr以上。
工作装置控制器26在不需要动臂介入控制的情况下,在来自操作装置25的操作指令为动臂6的上升指令或中立指令的情况下,若动臂限制速度Vcy_bm1与动臂目标速度Vbop或0的差D为阈值Dr以上,则使不需要动臂介入控制之前的动臂目标速度Vbm以一定的变化率VRC减少而变化成操作员指示的动臂目标速度Vbop。
在动臂6上升的情况下,即动臂目标速度Vbm为正的情况下,当使动臂目标速度Vbm以变化率VRC变化时,上升速度减少,因此,变化率VRC表示上升速度的减少率。
切换成基于来自操作装置25的操作指令进行的工作装置2的控制的结果是,在速度变化大的情况下,动臂6急剧地降低速度,因此,操作员感觉到不适感。
在动臂介入控制的执行中且操作员进行使动臂6上升的操作或中立操作的情况下,当铲斗8脱离了目标挖掘地形43I所存在的区域而不需要动臂介入控制时,动臂目标速度Vbm从动臂限制速度Vcy_bm1逐渐地变化至操作员指示的动臂目标速度Vbop或0。其结果是,动臂6的急剧减速得以缓和,因此,操作员的不适感降低。
另外,动臂6的急剧减速所产生的冲击也能够降低,对装载于铲斗8的砂土造成的影响也能够缓和。
详细而言,图4所示的工作装置控制器的介入速度算出部26D求出动臂限制速度Vcy_bm。
接着,在图4所示的工作装置控制器26的判定部26J中,切换判定部26K判定是否不需要动臂介入控制。操作指令判断部26L在不需要动臂介入控制的情况下,判断操作员是否对右操作杆25R进行使动臂6上升的操作或中立操作。速度差判断部26M在不需要动臂介入控制的情况下,在操作员对右操作杆25R进行使动臂6上升的操作或中立操作的情况下,判断动臂限制速度Vcy_bm与按照操作员进行的使动臂6上升的操作的动臂目标速度Vc_bm或按照中立操作的动臂目标速度0的速度差。
速度差判断部26M在判断为速度差为阈值Dr以上的情况下,判定部26J判定为对动臂限制速度Vcy_bm进行修正,向介入速度修正部26F发出修正动臂限制速度Vcy_bm的指示。
控制部26CNT的介入速度修正部26F求出修正后的动臂限制速度Vcy_bm’并向控制部26CNT的介入指令算出部26E输出。
控制部26CNT的介入指令算出部26E使用修正后的动臂限制速度Vcy_bm’生成动臂指令信号CBI,并对介入阀27C进行控制。通过这样的处理,工作装置控制器26使动臂6的上升速度变化。
具体而言,介入速度修正部26F以从动臂限制速度Vcy_bm按照变化率VRC变化成动臂目标速度Vbop的方式进行控制。
当变化率VRC大时,在不需要动臂介入控制的情况下,动臂6的上升迅速地停止,动臂目标速度Vbop的变化急剧,因此,会产生冲击或者使操作员感觉到不适感。
因此,变化率VRC被设定为不会使向动臂目标速度Vbop的变化过于急剧的范围。在实施方式中,变化率VRC例如通过操作员的感官评价来决定,但决定变化率VRC的方法不局限于这种方法。
<实施方式的作业机械的控制方法>
图10是对示出实施方式的作业机械的控制方法的流程进行说明的图。
如图10所示,实施方式的作业机械的控制方法由工作装置控制器26实现。
在步骤S2中,图4所示的工作装置控制器26的切换判定部26K判定是否不需要动臂介入控制。在切换判定部26K判定为不需要动臂介入控制的情况下(步骤S2中为是),在步骤S4中,操作指令判断部26L判断操作员是否进行使动臂6上升的操作或中立操作(步骤S4)。
在步骤S4中操作指令判断部26L判断为操作员进行使动臂6上升的操作或中立操作的情况下(步骤S4中为是),速度差判断部26M判断动臂限制速度Vcy_bm与按照操作员进行的使动臂6上升的操作的动臂目标速度Vc_bm或动臂目标速度0的速度差(步骤S5)。
速度差判断部26M判断该速度差是否为阈值Dr以上(步骤S6)。
在步骤S6中速度差判断部26M判断为速度差为阈值Dr以上的情况下(步骤S6中为是),在步骤S8中,工作装置控制器26的介入指令算出部26E根据由介入速度修正部26F求出的修正后的动臂限制速度Vcy_bm’生成动臂指令信号CBI,基于动臂指令信号来控制介入阀27C。
然后结束处理(结束)。
另一方面,在步骤S2中切换判定部26K判定为需要动臂介入控制的情况下(步骤S2中为否),在步骤S16中,工作装置控制器26的介入指令算出部26E使用未修正的动臂限制速度Vcy_bm,基于动臂指令信号CBI来控制介入阀27C。
另一方面,在步骤S4中判断为操作员未进行使动臂6上升的操作或中立操作的情况下(步骤S4中为否),或者在步骤S6中判断为速度差小于阈值Dr的情况下(步骤S6中为否),工作装置控制器26使用按照操作杆的指令的目标速度,生成动臂指令信号CBI,基于动臂指令信号来控制介入阀27C(步骤S12)。
然后结束处理(结束)。
<电动方式的操作杆>
在实施方式中,操作装置25具有先导液压方式的操作杆,但也可以具有电动方式的左操作杆25La以及右操作杆25Ra。
在左操作杆25La以及右操作杆25Ra为电动方式的情况下,各自的操作量分别由电位计进行检测。由电位计检测到的左操作杆25La以及右操作杆25Ra的操作量被工作装置控制器26获取。
检测到电动方式的操作杆的操作信号的工作装置控制器26执行与先导液压方式同样的控制。
以上,在实施方式中,在不需要介入控制的情况下,当操作员对右操作杆25R进行使动臂6上升的操作或中立操作时,若动臂限制速度Vcy_bm与按照使动臂6上升的操作的动臂目标速度Vc_bm或按照中立操作的动臂目标速度0的速度差为阈值Dr以上,则对动臂限制速度Vcy_bm进行修正。使动臂限制速度Vcy_bm以一定的变化率VRC减少而变化成操作员指示的动臂目标速度Vbop或0。
工作装置2具有动臂6、斗杆7、铲斗8,但装配于工作装置2的附属件不局限于此,不局限于铲斗8。作业机械具有工作装置即可,不局限于液压挖掘机100。
此次公开的实施方式是例示,不仅仅限定于上述内容。本发明的范围由权利请求的范围示出,包含与权利请求的范围同等的含义以及范围内的全部变更。
附图标记说明
1 车辆主体,2 工作装置,3 上部回转体,4 驾驶室,5 行驶装置,6 动臂,7 斗杆,8 铲斗,10 动臂缸,11 斗杆缸,12 铲斗缸,13 动臂销,14 斗杆销,15 铲斗销,16 第一行程传感器,17 第二行程传感器,18 第三行程传感器,19 位置检测装置,26 工作装置控制器,26A 相对位置算出部,26B 距离算出部,26C 目标速度算出部,26CNT 控制部,26D 介入速度算出部,26E 介入指令算出部,26F 介入速度修正部,26J 判定部,26K 切换判定部,26L 操作指令判断部,26M 速度差判断部,26P 处理部,26Q 存储部。
Claims (4)
1.一种作业机械,其具备:
工作装置;
对所述工作装置进行操作的操作装置;以及
对所述工作装置进行控制的控制器,
所述控制器基于来自所述操作装置的操作指令,执行使所述工作装置上升的介入控制,
判定从所述介入控制向按照所述操作装置的操作指令进行的所述工作装置的控制的切换,
在基于判定结果的所述切换中,判断所述操作装置的操作指令是否是所述工作装置的上升指令或中立指令,
基于判断结果,在所述操作装置的操作指令是所述工作装置的上升指令或中立指令的情况下,判断基于所述介入控制的所述工作装置的上升目标速度与按照所述操作装置的操作指令的目标速度的速度差,
在所述速度差为规定值以上的情况下,以使所述工作装置的上升目标速度逐渐向按照所述操作装置的操作指令的目标速度变化的方式进行调整。
2.根据权利要求1所述的作业机械,其中,
所述控制器包括:
介入控制部,其基于来自所述操作装置的操作指令,执行使所述工作装置上升的介入控制;
切换判定部,其判定从所述介入控制向按照所述操作装置的操作指令进行的所述工作装置的控制的切换;
操作指令判断部,其在基于所述切换判定部的判定结果的所述切换中,判断所述操作装置的操作指令是否是所述工作装置的上升指令或中立指令;
速度差判断部,其基于所述操作指令判断部的判断结果,在所述操作装置的操作指令为所述工作装置的上升指令或中立指令的情况下,判断基于所述介入控制的所述工作装置的上升目标速度与按照所述操作装置的操作指令的目标速度的速度差;以及
速度调整部,其基于所述速度差判断部的判断结果,在所述速度差为规定值以上的情况下,以使所述工作装置的上升目标速度逐渐向按照所述操作装置的操作指令的目标速度变化的方式进行调整。
3.根据权利要求1所述的作业机械,其中,
所述控制器在所述速度差小于所述规定值的情况下,将所述工作装置的上升目标速度切换成按照所述操作装置的操作指令的目标速度。
4.一种作业机械的控制方法,其是具备工作装置和对所述工作装置进行操作的操作装置的作业机械的控制方法,其中,
所述作业机械的控制方法具备如下步骤:
基于来自所述操作装置的操作指令,执行使所述工作装置上升的介入控制;
判定从所述介入控制向按照所述操作装置的操作指令进行的所述工作装置的控制的切换;
在基于判定结果的所述切换中,判断所述操作装置的操作指令是否是所述工作装置的上升指令或中立指令;
基于判断结果,在所述操作装置的操作指令是所述工作装置的上升指令或中立指令的情况下,判断基于所述介入控制的所述工作装置的上升目标速度与按照所述操作装置的操作指令的目标速度的速度差;以及
在所述速度差为规定值以上的情况下,以使所述工作装置的上升目标速度逐渐向按照所述操作装置的操作指令的目标速度变化的方式进行调整。
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2017/025778 WO2019012699A1 (ja) | 2017-07-14 | 2017-07-14 | 作業機械および作業機械の制御方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109511268A true CN109511268A (zh) | 2019-03-22 |
Family
ID=65002558
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201780002863.4A Withdrawn CN109511268A (zh) | 2017-07-14 | 2017-07-14 | 作业机械以及作业机械的控制方法 |
Country Status (6)
Country | Link |
---|---|
US (1) | US20190078289A1 (zh) |
JP (1) | JP6901406B2 (zh) |
KR (1) | KR102088784B1 (zh) |
CN (1) | CN109511268A (zh) |
DE (1) | DE112017000085T5 (zh) |
WO (1) | WO2019012699A1 (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20220037405A (ko) * | 2019-04-05 | 2022-03-24 | 볼보 컨스트럭션 이큅먼트 에이비 | 건설기계 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5361211A (en) * | 1990-10-31 | 1994-11-01 | Samsung Heavy Industries Co., Ltd. | Control system for automatically controlling actuators of an excavator |
JP2015196968A (ja) * | 2014-03-31 | 2015-11-09 | 住友建機株式会社 | ショベル |
WO2016111384A1 (ja) * | 2016-02-29 | 2016-07-14 | 株式会社小松製作所 | 作業機械の制御装置、作業機械及び作業機械の制御方法 |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS55119118A (en) * | 1979-03-09 | 1980-09-12 | Nisshin Steel Co Ltd | Denitrification method for iron alloy containing chromium |
JP3056254B2 (ja) * | 1994-04-28 | 2000-06-26 | 日立建機株式会社 | 建設機械の領域制限掘削制御装置 |
SE523988C2 (sv) * | 2002-04-22 | 2004-06-15 | Volvo Constr Equip Holding Se | Anordning och förfarande för styrning av en maskin |
DE10250694B3 (de) * | 2002-10-31 | 2004-02-12 | CNH Österreich GmbH | Verfahren zur Steuerung eines landwirtschaftlichen Nutzfahrzeuges |
JP4614839B2 (ja) * | 2005-07-25 | 2011-01-19 | トヨタ自動車株式会社 | 制動制御装置 |
US9085874B2 (en) * | 2007-08-09 | 2015-07-21 | Komatsu Ltd. | Working vehicle and hydraulic fluid amount control method for working vehicle |
EP2748379B1 (en) * | 2011-08-24 | 2016-11-23 | Volvo Construction Equipment AB | Method for controlling a working machine |
US9702117B2 (en) * | 2014-05-30 | 2017-07-11 | Komatsu Ltd. | Work vehicle control method, work vehicle control device, and work vehicle |
KR101746324B1 (ko) * | 2014-06-02 | 2017-06-12 | 가부시키가이샤 고마쓰 세이사쿠쇼 | 건설 기계의 제어 시스템, 건설 기계, 및 건설 기계의 제어 방법 |
US20170121930A1 (en) * | 2014-06-02 | 2017-05-04 | Komatsu Ltd. | Construction machine control system, construction machine, and method of controlling construction machine |
DE112015000035B4 (de) * | 2014-06-04 | 2019-01-10 | Komatsu Ltd. | Baumaschinensteuersystem, Baumaschine und Baumaschinensteuerverfahren |
DE112014000147B4 (de) * | 2014-09-10 | 2021-07-29 | Komatsu Ltd. | Baufahrzeug |
DE112014000176B4 (de) * | 2014-09-10 | 2021-06-17 | Komatsu Ltd. | Baufahrzeug sowie Verfahren zum Steuern des Baufahrzeugs |
-
2017
- 2017-07-14 JP JP2017560641A patent/JP6901406B2/ja active Active
- 2017-07-14 CN CN201780002863.4A patent/CN109511268A/zh not_active Withdrawn
- 2017-07-14 DE DE112017000085.8T patent/DE112017000085T5/de not_active Withdrawn
- 2017-07-14 KR KR1020187004640A patent/KR102088784B1/ko active IP Right Grant
- 2017-07-14 WO PCT/JP2017/025778 patent/WO2019012699A1/ja active Application Filing
- 2017-07-14 US US15/756,656 patent/US20190078289A1/en not_active Abandoned
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5361211A (en) * | 1990-10-31 | 1994-11-01 | Samsung Heavy Industries Co., Ltd. | Control system for automatically controlling actuators of an excavator |
JP2015196968A (ja) * | 2014-03-31 | 2015-11-09 | 住友建機株式会社 | ショベル |
WO2016111384A1 (ja) * | 2016-02-29 | 2016-07-14 | 株式会社小松製作所 | 作業機械の制御装置、作業機械及び作業機械の制御方法 |
Also Published As
Publication number | Publication date |
---|---|
JPWO2019012699A1 (ja) | 2020-05-07 |
WO2019012699A1 (ja) | 2019-01-17 |
US20190078289A1 (en) | 2019-03-14 |
DE112017000085T5 (de) | 2019-04-18 |
KR20190019037A (ko) | 2019-02-26 |
JP6901406B2 (ja) | 2021-07-14 |
KR102088784B1 (ko) | 2020-03-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105339561B (zh) | 作业机械的姿势运算装置、作业机械及作业机械的姿势运算方法 | |
CN104619921B (zh) | 作业车辆及作业车辆的控制方法 | |
CN105358769B (zh) | 作业机械的姿态运算装置、作业机械及作业机械的姿态运算方法 | |
CN105408554B (zh) | 作业机械的控制系统、作业机械以及作业机械的控制方法 | |
CN105008623B (zh) | 建筑机械的控制系统、建筑机械及建筑机械的控制方法 | |
CN105636659B (zh) | 作业机械的控制系统、作业机械、液压挖掘机的控制系统以及作业机械的控制方法 | |
CN105339558B (zh) | 建筑机械的控制系统、建筑机械及建筑机械的控制方法 | |
CN104619922B (zh) | 作业车辆 | |
CN109511267A (zh) | 作业机械以及作业机械的控制方法 | |
CN105431596B (zh) | 建筑机械的控制系统、建筑机械及建筑机械的控制方法 | |
CN105339759B (zh) | 作业机械的控制系统以及作业机械的控制方法 | |
KR101737389B1 (ko) | 작업 기계의 제어 장치, 작업 기계, 및 작업 기계의 제어 방법 | |
CN104619920B (zh) | 作业车辆 | |
CN105102726B (zh) | 建筑机械的控制系统、建筑机械及建筑机械的控制方法 | |
CN104769189B (zh) | 作业车辆 | |
CN105517645B (zh) | 作业机械及液压挖掘机的姿势运算装置以及作业机械 | |
WO2018174154A1 (ja) | ショベル並びにショベルの管理装置及び支援装置 | |
CN104541001B (zh) | 作业车辆 | |
CN106029991B (zh) | 作业车辆的控制系统、控制方法以及作业车辆 | |
CN107306500A (zh) | 作业机械的控制装置、作业机械以及作业机械的控制方法 | |
CN105339560B (zh) | 挖掘机械的控制系统以及挖掘机械 | |
US11591768B2 (en) | Control system of work machine and method for controlling work machine | |
CN106460363B (zh) | 作业机械的控制系统、作业机械以及作业机械的控制方法 | |
CN110300827A (zh) | 工程机械 | |
CN107109820A (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 | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20190322 |
|
WW01 | Invention patent application withdrawn after publication |