CN107709672A - 工程机械 - Google Patents
工程机械 Download PDFInfo
- Publication number
- CN107709672A CN107709672A CN201680037755.6A CN201680037755A CN107709672A CN 107709672 A CN107709672 A CN 107709672A CN 201680037755 A CN201680037755 A CN 201680037755A CN 107709672 A CN107709672 A CN 107709672A
- Authority
- CN
- China
- Prior art keywords
- reaction force
- angle
- forepiece
- practical operation
- correction
- 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
- 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
- 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/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
- 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
-
- 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/2029—Controlling the position of implements in function of its load, e.g. modifying the attitude of implements in accordance to vehicle speed
-
- 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/2041—Automatic repositioning of implements, i.e. memorising determined positions of the implement
-
- 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/2264—Arrangements or adaptations of elements for hydraulic drives
- E02F9/2271—Actuators and supports therefor and protection therefor
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Mechanical Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Paleontology (AREA)
- Operation Control Of Excavators (AREA)
Abstract
工程机械具备控制装置,该控制装置具有反作用力修正控制部,该反作用力修正控制部在前部件的目标操作量与实际操作量之差比预先设定的范围大的情况下,执行使通过反作用力施加装置向对驱动该前部件的执行机构进行操作的操作部施加的操作反作用力增加的修正,在前部件的目标操作量与实际操作量之差处于上述范围内的情况下,执行使通过反作用力施加装置向对驱动该前部件的执行机构进行操作的操作部施加的操作反作用力减少的修正。
Description
技术领域
本发明涉及工程机械。
背景技术
公知有具备由动臂、斗杆、铲斗等多个前部件构成的前作业装置的液压挖掘机等工程机械(参照专利文献1)。前作业装置通过与各前部件分别对应的操作部件***作而被驱动。专利文献1所记载的工程机械的操作装置具备反作用力控制机构,该反作用力控制机构以将与基于各操作部件的操作实现的前作业装置向作业范围边界接近的程度相应的操作反作用力分别对各操作部件的操作施加的方式,对反作用力施加机构进行控制。
专利文献1所记载的反作用力控制机构基于前作业装置的姿势和各操作部件的操作分别运算基于各操作部件的操作实现的规定时间后的前作业装置与作业范围边界之间的距离。反作用力控制机构施加以仅对运算出的距离比前作业装置的当前位置与作业范围边界之间的距离短那样的操作部件的操作施加操作反作用力的方式,对反作用力施加机构进行控制。
现有技术文献
专利文献
专利文献1:日本特开2005-320846号公报
发明内容
前作业装置由多个前部件构成,因此,在进行例如直线挖掘作业等使铲斗的爪尖沿着直线的目标轨迹运动的作业的情况下,需要使多个前部件复合地动作,操作需要熟练。另外,存在如下问题:即使是熟练的操作者,高精度且高速的作业也并不容易,若进行长期作业,则导致疲劳而作业效率降低。
在专利文献1中,虽然提出了利用操作反作用力来辅助操作者的方案,但无法解决上述问题点。
根据本发明的一形态,工程机械具备:前作业装置,其具有至少包括第1前部件和第2前部件的多个前部件;多个执行机构,其驱动多个前部件;以及操作部,其对多个执行机构进行操作,在该工程机械中,具备反作用力施加装置以及控制装置,该反作用力施加装置基于实际操作量对操作部施加操作反作用力,该控制装置具有:操作量检测部,其对操作部的实际操作量进行检测,以便生成针对该反作用力施加装置的控制信号;轨迹决定部,其决定前作业装置的预先设定的部位的目标轨迹;位置检测部,其对通过多个前部件驱动而移动的前作业装置的预先设定的部位的位置进行检测;目标速度决定部,其以沿着目标轨迹的方式决定前作业装置的预先设定的部位的目标速度;目标操作量决定部,其基于目标速度来决定至少第1前部件和第2前部件各自的目标操作量;以及反作用力修正控制部,其在前部件的目标操作量与实际操作量之差比预先设定的范围大的情况下,执行使通过反作用力施加装置向对驱动该前部件的执行机构进行操作的操作部施加的操作反作用力增加的修正,在前部件的目标操作量与实际操作量之差处于上述范围内的情况下,执行使通过反作用力施加装置向对驱动该前部件的执行机构进行操作的操作部施加的操作反作用力减少的修正。
发明效果
根据本发明,能够简单地进行沿着目标轨迹的作业,能够实现作业效率的提高。
附图说明
图1是适用本实施方式的工程机械的侧视图。
图2是表示本实施方式的控制器的概略构成的图。
图3是说明液压挖掘机的与左操作杆和右操作杆的操作方向相对应的动作的图。
图4是对目标轨迹TL的决定方法进行说明的图。
图5是表示斜面的平整作业的图。
图6中,(a)是表示爪尖Pb的实际速度矢量VAc的图,(b)是表示爪尖Pb的目标速度矢量VTc的图。
图7是表示实际操作角θ与基准操作反作用力FB之间的关系的图。
图8是表示基于由控制器执行的操作反作用力控制程序的处理的一个例子的流程图。
图9是表示基于由控制器执行的操作反作用力控制程序的第1修正控制处理和第2修正控制处理的一个例子的流程图。
图10是表示根据实际操作角θ而由反作用力施加装置产生的操作反作用力F的特性的图。
图11是表示操作反作用力的修正方法的变形例(变形例1-1、1-2、1-3)的图。
图12是表示操作反作用力的修正方法的变形例(变形例1-4)的图。
具体实施方式
图1是作为适用本实施方式的工程机械的一个例子的液压挖掘机(反铲挖掘机)100的侧视图。此外,为了方便说明,如图1所示那样规定前后和上下方向。如图1所示,液压挖掘机100具备行驶体101和能够旋转地搭载于行驶体101上的旋转体102。行驶体101通过利用行驶马达驱动左右一对的履带来行驶。
在旋转体102的前部左侧设置有驾驶室107,在驾驶室107的后部设置有发动机室。在发动机室中收容有作为动力源的发动机、液压设备等。在发动机室的后部安装有用于取得作业时的机身的平衡的配重109。在旋转体102的前部右侧设置有前作业装置103。
前作业装置103具备多个前部件、即动臂104、斗杆105、以及铲斗106。动臂104的基端部能够转动地安装于旋转体102的前部。斗杆105的一端能够转动地安装于动臂104的前端。动臂104和斗杆105由动臂缸104a和斗杆缸105a分别驱动而起伏。铲斗106能够相对于斗杆105向上下方向转动地安装于斗杆105的前端,由铲斗缸106a驱动。
图2是表示本实施方式的控制器120的概略构成的图。液压挖掘机100具备控制器120。控制器120包括CPU、作为存储装置的ROM和RAM、具有其他周边电路等的运算处理装置而构成,进行液压挖掘机100的各部分的控制。
在控制器120上连接有输出与配设于驾驶室107内的电气式的左操作杆111的操作方向和实际操作角相当的信号的操作量传感器111d、以及输出与电气式的右操作杆112的操作方向和实际操作角相当的信号的操作量传感器112d。实际操作角(实际操作量)是操作杆111、112相对于中立位置NP的倾斜角。与左操作杆111和右操作杆112的操作方向和实际操作角θ相当的信号输入至控制器120。控制器120功能性地具备操作量检测部120d。操作量检测部120d基于来自各操作量传感器111d、112d的信号对左操作杆111和右操作杆112的操作方向和实际操作角θ进行检测。图3是对液压挖掘机100的与左操作杆111和右操作杆112的操作方向相对应的动作进行说明的图。左操作杆111位于驾驶席的左侧,右操作杆112位于驾驶席的右侧。
左操作杆111是对斗杆105相对于动臂104的转动动作、以及旋转体102的旋转动作进行操作的操作部件。若使左操作杆111从中立位置NP向前方倾斜,则进行斗杆推出动作。斗杆推出动作是指,斗杆缸105a收缩,斗杆105以与实际操作角相应的速度相对于动臂104向斗杆105的相对角度扩大的方向转动的(在图1中是顺时针转动的)动作。若使左操作杆111从中立位置NP向后方倾斜,则进行斗杆拉回动作。斗杆拉回动作是指,斗杆缸105a伸长,以使斗杆105向动臂104侧折叠的方式,斗杆105以与实际操作角相应的速度转动的(在图1中是逆时针转动的)动作。
若使左操作杆111从中立位置NP向左方倾斜,则旋转马达(未图示)被驱动,旋转体102以与实际操作角相应的速度向左旋转。若使左操作杆111从中立位置NP向右方倾斜,则旋转马达(未图示)被驱动,旋转体102以与实际操作角相应的速度向右旋转。
右操作杆112是对动臂104相对于旋转体102的转动动作、以及铲斗106相对于斗杆105的转动动作进行操作的操作部件。若使右操作杆112从中立位置NP向前方倾斜,则进行动臂下降动作。动臂下降动作是指,动臂缸104a收缩,动臂104以与实际操作角相应的速度向下方转动的动作。若使右操作杆112从中立位置NP向后方倾斜,则进行动臂抬升动作。动臂抬升动作是指,动臂缸104a伸长,动臂104以与实际操作角相应的速度向上方转动的动作。
若使右操作杆112从中立位置NP向左方倾斜,则进行铲斗挖掘动作。铲斗挖掘动作是指,铲斗缸106a伸长,以铲斗106的爪尖(前端)Pb靠近斗杆105的腹面的方式,铲斗106以与实际操作角相应的速度转动的(在图1中是逆时针转动的)动作。若使右操作杆112从中立位置NP向右方倾斜,则进行铲斗卸载动作。铲斗卸载动作是指,铲斗缸106a收缩,以铲斗106的爪尖Pb从斗杆105的腹面远离的方式,铲斗106以与实际操作角相应的速度转动的(在图1中是顺时针转动的)动作。
若使左操作杆111从中立位置NP向左斜前方等倾斜方向倾斜,则能够使斗杆105和旋转体102复合地动作。若使右操作杆112从中立位置NP向左斜前方等倾斜方向倾斜,则能够使动臂104和铲斗106复合地动作。因此,在本实施方式的液压挖掘机100中,通过对左操作杆111和右操作杆112同时进行操作,能够最多使4个动作复合地进行。
如图2所示,在控制器120上连接有反作用力施加装置111r,该反作用力施加装置111r针对左操作杆111产生与操作者的操作方向为相反侧的力即操作反作用力。在控制器120上连接有反作用力施加装置112r,该反作用力施加装置112r针对右操作杆112产生与操作者的操作方向为相反侧的力即操作反作用力。
反作用力施加装置111r和反作用力施加装置112r是同样的构成,能够由多个电磁马达等电磁致动器构成。如随后论述那样,若表示控制器120所决定的操作反作用力的控制信号被输出至反作用力施加装置111r、112r,则通过反作用力施加装置111r、112r对左操作杆111和右操作杆112产生操作反作用力。
控制阀108与控制器120连接。控制器120基于上述的左操作杆111的操作方向和实际操作角以及右操作杆112的操作方向和实际操作角,输出对控制阀108进行控制的控制信号。控制阀108根据来自控制器120的控制信号而被切换。控制阀108对从未图示的液压泵向各前部件的执行机构(动臂缸104a、斗杆缸105a和铲斗缸106a)供给的压力油的流动进行控制。因此,各前部件的与左操作杆111和右操作杆112的操作方向相应的动作以与实际操作角相应的速度被驱动。
在控制器120上连接有用于求出前部件的位置的多个角度传感器,由各角度传感器检测到的信号输入至控制器120。多个角度传感器包括动臂角度传感器110a、斗杆角度传感器110b、以及铲斗角度传感器110c。动臂角度传感器110a设置于动臂104与旋转体102之间的连接部,对动臂104相对于旋转体102的转动角度进行检测。斗杆角度传感器110b设置于动臂104与斗杆105之间的连接部,对斗杆105相对于动臂104的转动角度进行检测。铲斗角度传感器110c设置于斗杆105与铲斗106之间的连接部,对铲斗106相对于斗杆105的转动角度进行检测。
控制器120具备姿势运算部121、目标轨迹决定部122、实际速度运算部123、目标速度运算部124、矢量分解部125、目标操作量运算部126、基准反作用力运算部127、判定部128、以及反作用力修正部129。
姿势运算部121对液压挖掘机100的姿势、即作为构成前作业装置103的各前部件的动臂104、斗杆105以及铲斗106的位置进行运算。在控制器120的存储装置中存储有各前部件和旋转体102、行驶体101的各部分尺寸的信息。
控制器120使用前部件的各部分的尺寸、和由动臂角度传感器110a、斗杆角度传感器110b及铲斗角度传感器110c检测到的信息,对包括铲斗106的爪尖Pb在内的各前部件中的预先设定的部位的位置进行运算。作为前部件的各部分的尺寸,包括从动臂104的转动支点到斗杆105的转动支点的尺寸、从斗杆105的转动支点到铲斗106的转动支点的尺寸、以及从铲斗106的转动支点到铲斗106的爪尖Pb的尺寸。姿势运算部121按每规定的控制周期对铲斗106的爪尖Pb的位置进行运算。
也就是说,在本实施方式中,能够根据来自多个角度传感器110a、110b、110c的信息和多个前部件的尺寸的信息,对通过多个前部件驱动而移动的铲斗106的爪尖Pb的位置进行检测。
目标轨迹决定部122决定铲斗106的爪尖Pb的目标轨迹。参照图4对目标轨迹的决定方法的一个例子进行说明。图4是对目标轨迹TL的决定方法进行说明的图。如图4所示,操作者将铲斗106的爪尖Pb配置于第1位置P1,对位置设定开关(未图示)进行操作,利用深度设定开关(未图示)输入挖掘深度h1的数值。由此,目标轨迹决定部122将从第1位置P1以挖掘深度h1向下方分开的位置作为第1设定点P1T而存储于存储装置。
操作者将铲斗106的爪尖Pb配置于与第1位置P1不同的第2位置P2,对位置设定开关(未图示)进行操作,利用深度设定开关(未图示)输入挖掘深度h2的数值。由此,目标轨迹决定部122将从第2位置P2以挖掘深度h2向下方分开的位置作为第2设定点P2T而存储于存储装置。此外,第1设定点P1T和第2设定点P2T例如由与作为基准位置的旋转中心点BP相距的水平方向距离、以及与旋转中心点BP相距的铅垂方向距离来确定,并被存储于存储装置。
目标轨迹决定部122对相对于第1位置P1以深度h1位于下方的第1设定点P1T和相对于第2位置P2以深度h2位于下方的第2设定点P2T连结的直线的方程式进行计算,并将其设定为目标轨迹TL。
图5是表示作为直线挖掘作业的一个例子的斜面的平整作业的图。在图5所示的斜面的平整作业中,能够通过使斗杆拉回动作和动臂抬升动作复合来实现。在本实施方式中,在以手动进行操作的情况下,如图5所示,以铲斗106的爪尖Pb沿着目标轨迹TL移动的方式,执行对作用于左操作杆111和右操作杆112的操作反作用力进行调整来促使操作者进行恰当操作的反作用力修正控制。此外,在本实施方式中,为了方便说明,对不执行使铲斗106和旋转体102动作的操作的情况下的操作反作用力的修正控制进行说明。
图2所示的实际速度运算部123运算爪尖Pb的实际速度矢量VAc。图6的(a)是表示爪尖Pb的实际速度矢量VAc的图。实际速度运算部123基于由姿势运算部121运算出的当前时刻的铲斗106的位置与在1控制周期前由姿势运算部121运算出的铲斗106的位置之差、以及1控制周期的时间,对铲斗106的爪尖Pb的实际速度矢量VAc进行运算。
图2所示的目标速度运算部124以沿着目标轨迹TL的方式决定爪尖Pb的目标速度矢量VTc。图6的(b)是表示爪尖Pb的目标速度矢量VTc的图。如图6的(b)所示,在爪尖Pb位于目标轨迹TL上的情况下,爪尖Pb的目标速度矢量VTc的方向成为与目标轨迹TL平行的方向。另外,在本实施方式中,爪尖Pb的目标速度矢量VTc的范数被设定成与实际速度矢量VAc的范数相同的值(||VTc||=||VAc||)。也就是说,将爪尖Pb的实际速度的大小代用为目标速度的大小。
图2所示的矢量分解部125基于当前时刻的前作业装置103的姿势,如图6的(a)所示那样将实际速度矢量VAc分解成斗杆速度矢量VAa和动臂速度矢量VAb。矢量分解部125基于当前时刻的前作业装置103的姿势,如图6的(b)所示那样将目标速度矢量VTc分解成斗杆速度矢量VTa和动臂速度矢量VTb。
斗杆速度矢量VAa、VTa是由斗杆105相对于动臂104的转动动作引起的速度矢量,其方向是与将斗杆105的转动支点(斗杆105与动臂104连接的连接点)和爪尖Pb连结的直线垂直的方向。动臂速度矢量VAb、VTb是由动臂104相对于旋转体102的转动动作引起的速度矢量,其方向是与将动臂104的转动支点(动臂104与旋转体102连接的连接点)和爪尖Pb连结的直线垂直的方向。
图2所示的目标操作量运算部126通过使作为目标值的斗杆速度矢量VTa的范数除以作为实测值的斗杆速度矢量VAa的范数来运算修正系数Ka(Ka=||VTa||/||VAa||)。目标操作量运算部126通过使作为目标值的动臂速度矢量VTb的范数除以作为实测值的动臂速度矢量VAb的范数来运算修正系数Kb(Kb=||VTb||/||VAb||)。
修正系数Ka、Kb成为与实际操作角与目标操作角之差相当的系数,通过对实际操作角θ乘以修正系数Ka、Kb,而获得目标操作角θt。也就是说,在修正系数是1的情况下,表示目标操作角θt与实际操作角θ一致。在修正系数比1大的情况下,表示实际操作角θ比目标操作角θt小,在修正系数比1小的情况下,表示实际操作角θ比目标操作角θt大。
目标操作量运算部126对左操作杆111的斗杆拉回动作方向的实际操作角θ(以下也记作实际操作角θa)乘以修正系数Ka而求出使得产生成为目标的斗杆速度矢量VTa的目标操作角θt(θt=Ka·θa)。目标操作量运算部126对右操作杆112的动臂抬升动作方向的实际操作角θ(以下也记作实际操作角θb)乘以修正系数Kb而求出使得产生成为目标的动臂速度矢量VTb的目标操作角θt(θt=Kb·θb)。
基准反作用力运算部127基于实际操作角θ来决定由反作用力施加装置111r、112r产生的操作反作用力F。图7是表示实际操作角θ与基准操作反作用力FB之间的关系的图。在控制器120的存储装置中以查询表形式存储有随着左操作杆111和右操作杆112的实际操作角θa、θb的增加而变大的基准操作反作用力FB的特性Na、Nb。在不进行随后论述的操作反作用力的修正的情况下,按照该特性Na、Nb而通过反作用力施加装置111r、112r对操作杆111、112施加与实际操作角θa、θb相应的操作反作用力F。
基于实际操作角θa的特性Na和基于实际操作角θb的特性Nb既可以是相同的特性,也可以是不同的特性。在本实施方式中,设为特性Na和特性Nb相同,将特性Na、Nb统称而记作特性N、将实际操作角θa和实际操作角θb统称而记作实际操作角θ来进行说明。此外,对于左操作杆111和右操作杆11,也进行统称而简记为操作杆R。
特性N是随着实际操作角θ增加而基准操作反作用力FB线性增加的特性,其最大值是Fmax。若操作杆R被向前后方向操作,则基准反作用力运算部127参照特性N,对与由操作量传感器111d、112d检测到的实际操作角θ相应的基准操作反作用力FB进行运算。
图2所示的判定部128对操作杆R的实际操作角θ是增加、还是减少、或者没有变更进行判定。判定部128对在当前时刻由操作量传感器111d、112d检测到的实际操作角θ与在1控制周期前由操作量传感器111d、112d检测到的实际操作角θ进行比较。判定部128在当前时刻的实际操作角θ比1控制周期前的实际操作角θ大的情况下,判定为操作杆R的实际操作角θ增加。判定部128在当前时刻的实际操作角θ比1控制周期前的实际操作角θ小的情况下,判定为操作杆R的实际操作角θ减小。判定部128在当前时刻的实际操作角θ与1控制周期前的实际操作角θ相同的情况下,判定为操作杆R的实际操作角θ没有变更。
反作用力修正部129基于修正系数Ka、Kb进行操作反作用力的修正。以下,说明由反作用力修正部129进行的操作反作用力的修正的控制内容。针对左操作杆111的操作反作用力F的修正的控制、和针对右操作杆112的操作反作用力F的修正的控制大致相同。因此,将左操作杆111和右操作杆112统称为操作杆R,说明针对操作杆R的操作反作用力F的修正的控制。此外,对于修正系数Ka、Kb,进行统称而记作修正系数K,对于实际操作角θa、θb,与上述同样地进行统称而记作实际操作角θ。
反作用力修正部129随着操作杆R的实际操作角θ的变化而执行第1修正控制和第2修正控制中的某一个。在由判定部128判定为操作杆R的实际操作角θ减小的情况下,执行第1修正控制。第1修正控制持续进行直到由判定部128判定为操作杆R的实际操作角θ增加为止。
反作用力修正部129在由判定部128判定为操作杆R的实际操作角θ增加的情况下,执行第2修正控制。第2修正控制持续进行直到由判定部128判定为操作杆R的实际操作角θ减小为止。
-第1修正控制(实际操作角减小时的反作用力的修正控制)-
说明由反作用力修正部129进行的第1修正控制。反作用力修正部129对修正系数K是否小于阈值β、以及修正系数K是否是阈值α以上进行判定。阈值α是比1大的值,预先存储于存储装置(α>1)。阈值β是比1小的值,预先存储于存储装置(β<1)。
阈值α和阈值β根据目标轨迹TL的容许范围被设定。如图6所示,容许范围是从目标轨迹TL向上方偏移了规定量的目标轨迹上限TLU与从目标轨迹TL向下方偏移了规定量的目标轨迹下限TLL之间的范围。容许范围根据所要求的斜面的精度而被设定。此外,容许范围也能够设为可由操作者任意地设定变更的构成。从目标轨迹TL到目标轨迹上限TLU的距离与从目标轨迹TL到目标轨迹下限TLL的距离既可以设为不同的值,也可以设为相同的值。
在判定为实际操作角与目标操作角之差大、修正系数K小于阈值β的情况下,反作用力修正部129将修正量ΔF与基准操作反作用力FB相加而对操作反作用力F进行修正(F=FB+ΔF)。在判定为与实际操作角与目标操作角之差相当的修正系数K是预先设定的阈值β以上、且小于阈值α的情况下,反作用力修正部129判定为实际操作角θ达到了目标操作角θt。若判定为实际操作角θ达到了目标操作角θt,则反作用力修正部129从基准操作反作用力FB减去修正量ΔF而对操作反作用力F进行修正(F=FB-ΔF)。在判定为修正系数K是阈值α以上的情况下,反作用力修正部129不进行修正,将基准操作反作用力FB直接作为操作反作用力F输出(F=FB)。
此外,图10所示的θ1是修正系数K成为阈值α的实际操作角θ,操作角θ2是修正系数K成为阈值β的实际操作角θ。也就是说,在修正系数K是β以上且小于α时,意味着实际操作角θ处于包括目标操作角θt在内的预先设定的操作范围内(图10的(a)的θ1~θ2)。
-第2修正控制(实际操作角增加时的反作用力的修正控制)-
说明由反作用力修正部129进行的第2修正控制。反作用力修正部129对修正系数K是否是阈值γ以上、以及修正系数K是否小于阈值β进行判定。阈值γ是比阈值α大的值,预先存储于存储装置(γ>α)。
阈值γ被设定成,执行了从由特性N决定的基准操作反作用力FB减少修正量ΔF的修正后的操作反作用力F的大小,成为至少在操作杆R的非操作时使操作杆R返回中立位置NP的大小以上。在本实施方式中,执行操作反作用力F的修正控制的实际操作角θ的下限值是修正系数K成为阈值γ的操作角θ0(参照图10的(b))。换言之,在实际操作角θ比操作角θ0小时,不执行操作反作用力F的修正控制。实际操作角θ为操作角θ0时的操作反作用力F0是在操作者放开了操作杆R之后能够克服操作杆R的机械阻力(连结构造的摩擦等)而使操作杆R返回中立位置NP的大小以上的操作反作用力。
在判定为修正系数K是阈值γ以上的情况下,反作用力修正部129不进行修正,将基准操作反作用力FB直接作为操作反作用力F输出(F=FB)。
在判定为与实际操作角与目标操作角之差相当的修正系数K处于预先设定的阈值β以上、且小于阈值γ的范围内的情况下,反作用力修正部129判定为实际操作角θ处于包括目标操作角θt在内的预先设定的操作范围内(图10的(b)的θ0~θ2)。在判定为实际操作角θ处于上述操作范围内(图10的(b)的θ0~θ2)时,反作用力修正部129从基准操作反作用力FB减去修正量ΔF而对操作反作用力F进行修正(F=FB-ΔF)。在判定为实际操作角与目标操作角之差大、修正系数K小于阈值β的情况下,反作用力修正部129将基准操作反作用力FB与修正量ΔF相加而对操作反作用力F进行修正(F=FB+ΔF)。
修正量ΔF是正值,预先存储于存储装置(ΔF>0)。此外,针对左操作杆111的操作反作用力的修正量ΔF以及针对右操作杆112的操作反作用力的修正量ΔF既可以设为相同的值,也可以设为不同的值。
图2所示的判定部128决定是否执行对由基准反作用力运算部127基于特性N决定的基准操作反作用力FB进行修正的控制。判定部128从爪尖Pb的位置向目标轨迹TL引垂线,对从爪尖Pb到垂线的垂足的距离(以下成为垂线距离D)进行运算。垂线距离D是由目标轨迹决定部122决定的目标轨迹TL与由姿势运算部121运算出的爪尖Pb的位置之差。
判定部128在垂线距离D小于阈值Dt的情况下判定为修正执行条件成立。判定部128在垂线距离D是阈值Dt以上的情况下判定为修正执行条件不成立。阈值Dt由操作者任意地设定。例如在爪尖Pb从目标轨迹TL分开1m以上的情况下,为了不执行修正控制,预先将1m设定作为阈值Dt即可。
上述的由控制器120进行的修正操作反作用力的控制在修正执行条件成立的情况下执行,在修正执行条件不成立的情况下不执行。
图8和图9是表示基于由控制器120执行的操作反作用力控制程序的处理的一个例子的流程图。图9表示图8所示的第1修正控制处理和第2修正控制处理的内容。图8和图9的流程图所示的处理在基于操作者的操作设定了目标轨迹TL之后通过与控制器120连接的操作引导开关(未图示)的接通(ON)而开始,按每规定的控制周期反复执行步骤S100以后的处理,通过操作引导开关(未图示)的断开(OFF)而结束。
如图8所示,在步骤S100中,控制器120取得各种信息,进入步骤S110。在步骤S100中所取得的各种信息包括由角度传感器110a、110b、110c检测到的各前部件的转动角度的信息、由操作量传感器111d、112d检测到的操作杆的实际操作角θ的信息。
在步骤S110中,控制器120参照存储于存储装置的特性N(图7)的表格,基于在步骤S110中所取得的实际操作角θ的信息对基准操作反作用力FB进行运算,进入步骤S115。
在步骤S115中,控制器120基于存储于存储装置的各前部件的各部分尺寸以及在步骤S100中所取得的各前部件的转动角度的信息,对液压挖掘机100的作业姿势进行运算,进入步骤S120。在步骤S115的姿势运算处理中,对以旋转体102的旋转中心点BP为基准的铲斗106的爪尖Pb的位置、斗杆105的转动支点的位置、铲斗106的转动支点的位置进行运算。在步骤S115的姿势运算处理中,对从爪尖Pb到目标轨迹TL的垂线距离D进行运算。
在步骤S120中,控制器120对修正执行条件是否成立进行判定。若在步骤S120中进行了肯定判定,即判定为垂线距离D小于阈值Dt、修正执行条件成立,则进入步骤S125。若在步骤S120中进行否定判定,即判定为垂线距离D是阈值Dt以上、修正执行条件不成立,则进入步骤S180。
在步骤S180中,控制器120将基准操作反作用力FB直接决定为要产生的操作反作用力F,进入步骤S190。即,不进行基准操作反作用力的修正。
在步骤S125中,控制器120基于在步骤S115中运算出的爪尖Pb的位置(当前时刻的位置)与在1控制周期前的在步骤S115中运算出的爪尖Pb的位置之差,来对爪尖Pb的实际速度矢量VAc进行运算,进入步骤S130。
在步骤S130中,控制器120基于在步骤S115中运算出的爪尖Pb的位置、以及目标轨迹TL来对目标速度矢量VTc进行运算,进入步骤S135。
在步骤S135中,控制器120执行矢量分解处理,进入步骤S140。在矢量分解处理中,基于在步骤S125中运算出的实际速度矢量VAc以及在步骤S115中运算出的各前部件的位置的信息,将实际速度矢量VAc分解成斗杆速度矢量VAa和动臂速度矢量VAb。在矢量分解处理中,基于在步骤S130中运算出的目标速度矢量VTc以及在步骤S115中运算出的各前部件的位置的信息,将目标速度矢量VTc分解成斗杆速度矢量VTa和动臂速度矢量VTb。
在步骤S140中,控制器120基于在步骤S135中分解得到的斗杆速度矢量的目标值和实测值、以及动臂速度矢量的目标值和实测值,对修正系数K进行运算(修正系数运算处理),进入步骤S145。在修正系数运算处理中,控制器120通过使在步骤S135中运算出的斗杆速度矢量VTa(目标值)的范数除以在步骤S135中运算出的斗杆速度矢量VAa(实测值)的范数,来对修正系数Ka进行运算。在修正系数运算处理中,控制器120通过使在步骤S135中运算出的动臂速度矢量VTb(目标值)的范数除以在步骤S135中运算出的动臂速度矢量VAb(实测值)的范数,来对修正系数Kb进行运算。
在步骤S145中,控制器120通过对在步骤S140中运算出的修正系数K(Ka和Kb)乘以在步骤S100中所取得的实际操作角θ(θa和θb),来对目标操作角θt进行运算,进入步骤S150。
在步骤S150中,控制器120对实际操作角θ减小的杆操作是否被执行进行判定。在当前时刻的实际操作角θ比1控制周期前的步骤S100中所取得的实际操作角θ小的情况下,在步骤S150中进行肯定判定,将操作量减少标志设为ON,进入步骤S160。
在当前时刻的实际操作角θ比1控制周期前的步骤S100中所取得的实际操作角θ大的情况下,在步骤S150中进行否定判定,将操作量减少标志设为OFF,进入步骤在S170。在步骤S150中,在当前时刻的实际操作角θ与1控制周期前的实际操作角θ没有差异的情况下,根据操作量减少标志的状态而转向步骤S160或步骤S170。即,若操作量减少标志是ON,则转向步骤S160,若操作量减少标志是OFF,则转向步骤S170。
在步骤S160中,控制器120执行第1修正控制,进入步骤S190。在步骤S170中,控制器120执行第2修正控制,进入步骤S190。
图9的(a)是表示第1修正控制处理的流程的流程图。如图9的(a)所示,在第1修正控制处理中,基于在步骤S140中运算出的修正系数K以及存储于存储装置的阈值来决定操作反作用力F。
在步骤S161中,控制器120对修正系数K是否小于阈值β进行判定。若在步骤S161进行了肯定判定,则进入步骤S163,若在步骤S161中进行了否定判定,则进入步骤S165。
在步骤S165中,控制器120对修正系数K是否是阈值β以上且小于阈值α进行判定。若在步骤S165中进行了肯定判定,则进入步骤S167,若在步骤S165中进行了否定判定,则进入步骤S169。
在步骤S163中,控制器120将使存储于存储装置的修正量ΔF(恒定值)与基准操作反作用力FB相加而得到的值决定为修正后的操作反作用力F,进入步骤190。
在步骤S167中,控制器120将从基准操作反作用力FB减去存储于存储装置的修正量ΔF(恒定值)而得到的值决定为修正后的操作反作用力F,进入步骤S190。
在步骤S169中,控制器120将基准操作反作用力FB直接决定为要产生的操作反作用力F,进入步骤S190。即,不进行基准操作反作用力的修正。
图9的(b)是表示第2修正控制处理的流程的流程图。如图9的(b)所示,在第2修正控制处理中,基于在步骤S140中运算出的修正系数K以及存储于存储装置的阈值来决定操作反作用力F。
在步骤S171中,控制器120对修正系数K是否是阈值γ以上进行判定。若在步骤S171中进行了肯定判定,则进入步骤S173,若在步骤S171中进行了否定判定,则进入步骤S175。
在步骤S175中,控制器120对修正系数K是否是阈值β以上、且小于阈值γ进行判定。若在步骤S175中进行了肯定判定,则进入步骤S177,若在步骤S175中进行了否定判定,则进入步骤S179。
在步骤S173中,控制器120将基准操作反作用力FB直接决定为要产生的操作反作用力F,进入步骤S190。即,不进行基准操作反作用力的修正。
在步骤S177中,控制器120将从基准操作反作用力FB减去存储于存储装置的修正量ΔF(恒定值)而得到的值决定为修正后的操作反作用力F,进入步骤S190。
在步骤S179中,控制器120将使存储于存储装置的修正量ΔF(恒定值)与基准操作反作用力FB相加而得到的值决定为修正后的操作反作用力F,进入步骤190。
如图8所示,在步骤S190中,控制器120生成用于产生在步骤S160、S170、S180中决定的操作反作用力F的控制信号,并将所生成的控制信号向反作用力施加装置111r、112r输出。
参照图10,若以斜面的平整作业为例来总结本实施方式的液压挖掘机100的主要的动作,则如下所述。图10是表示根据实际操作角θ而由反作用力施加装置111r、112r产生的操作反作用力F的特性的图。图10的(a)表示在执行了实际操作角θ减小那样的杆操作时根据实际操作角θ而变化的操作反作用力F的特性。图10的(b)表示执行了实际操作角θ增加那样的杆操作时根据实际操作角θ而变化的操作反作用力F的特性。在图10的(a)、(b)中,横轴是实际操作角θ,纵轴是操作反作用力F。
操作者对各操作杆111、112进行操作,如图4所示,使铲斗106的爪尖Pb依次配置于第1位置P1和第2位置P2,在各位置对位置设定开关(未图示)进行操作,通过深度设定开关(未图示)输入这些位置处的挖掘深度h1、h2的数值。由此,通过控制器120设定目标轨迹TL,并将其存储于存储装置。
操作者对各操作杆111、112进行操作而进行斜面的平整作业。在此,如图5所示,使铲斗106的爪尖Pb的位置位于目标轨迹TL上,对操作引导开关(未图示)进行操作。由此,随着开关操作后的操作而执行操作反作用力的修正控制。
如图10的(a)所示,例如若以实际操作角θ从操作角θs1起减小的方式操作操作杆R,则执行第1修正控制(在步骤S150中为是,S160)。操作角θs1是实际操作角θ比目标操作角θt(θt=K·θ)大的情况、且、实际操作角θ与目标操作角θt之差大的情况(在步骤S161中为是)。此外,若各操作杆111、112的实际操作角θ分别比目标操作角θt大,则如图6所示,成为||VAa||>||VTa||、||VAb||>||VTb||。
在该情况下,如图10的(a)所示,以操作反作用力F比由特性N决定的基准操作反作用力FB增加ΔF的方式进行修改(步骤S163)。因此,操作者感知到比通常大的操作反作用力。
操作者通过感知到大的操作反作用力,能够知晓实际操作角θ与目标操作角θt相比过大这一情况。由此,若操作者以使实际操作角θ减小的方式对操作杆111、112进行操作,则如图10的(a)所示,随着实际操作角θ的减小而操作反作用力F也逐渐变小。
若实际操作角θ越过接近目标操作角θt的操作角θ2而变小(在步骤S161中为否,在S165中为是),则操作反作用力F以比由特性N决定的基准操作反作用力FB减少ΔF的方式被修正(步骤S167)。此外,操作角θ2是修正系数K成为阈值β的操作角。
操作者通过感知到操作反作用力F不连续地减少,能够知晓实际操作角θ接近了目标操作角θt这一情况。由此,操作者以使实际操作角θ不变的方式维持操作杆R。
此外,若以实际操作角θ与目标操作角θt相比变小的方式操作操作杆R、且实际操作角θ越过操作角θ1而变小(在步骤S161中为否,在S165中为否),则操作反作用力F成为由特性N决定的基准操作反作用力FB(步骤S169)。此外,操作角θ1是修正系数K成为阈值α的操作角。
操作者通过感知到操作反作用力F不连续地增加,能够知晓实际操作角θ越过目标操作角θt而变得过小这一情况。由此,操作者进行使操作杆R返回的操作,以使实际操作角θ接近目标操作角θt。
另一方面,如图10的(b)所示,例如若以实际操作角θ从操作角θs2起增加的方式操作操作杆R,则执行第2修正控制(在步骤S150中为否、S170)。操作角θs2是实际操作角θ比目标操作角θt小的情况、且、实际操作角θ与目标操作角θt之差处于预先设定的范围内(β以上且小于γ)的情况(在步骤S171中为否,S175中为是)。此外,虽未图示,但若各操作杆111、112的实际操作角θ分别比目标操作角θt小,则成为||VAa||<||VTa||、||VAb||<||VTb||。
在该情况下,如图10的(b)所示,以操作反作用力F比由特性N决定的基准操作反作用力FB减少ΔF的方式进行修改在(步骤S177)。因此,操作者感知到比通常小的操作反作用力。
操作者通过感知到小的操作反作用力,能够知晓实际操作角θ与目标操作角θt相比过小这一情况。由此,若操作者以使实际操作角θ增加的方式对操作杆R进行操作,则如图10的(b)所示,随着实际操作角θ的增加而操作反作用力F也逐渐变大。
若实际操作角θ超过接近目标操作角θt的操作角θ2而变大(在步骤S171中为否,在步骤S175中为否),则操作反作用力F以比由特性N决定的基准操作反作用力FB增加ΔF的方式被修正(步骤S179)。
操作者通过感知到操作反作用力F不连续地增加,能够知晓实际操作角θ超过目标操作角θt而变得过大这一情况。由此,操作者进行使操作杆R返回的操作,以使实际操作角θ接近目标操作角θt。
此外,在操作角θ0~θ1的操作范围中,若以实际操作角θ减小的方式操作操作杆R,即,若执行目标操作角θt与实际操作角θ之差变大的操作,则从第2修正控制切换成第1修正控制(在步骤S150中为是,S160)。由此,减少修正后的操作反作用力F不连续地增加,恢复成基准操作反作用力FB(步骤S169)。
操作者通过感知到操作反作用力F不连续地增加,能够知晓正在以实际操作角θ远离目标操作角θt的方式操作杆R、即正在执行与朝向目标的操作相反的操作这一情况。由此,操作者进行使操作杆R返回的操作,以使实际操作角θt接近目标操作角θt。
如此,根据本实施方式,通过对操作反作用力F进行调整,能够对操作者进行引导,以使其进行铲斗106的爪尖Pb的位置沿着目标轨迹TL移动那样的操作。
根据以上说明的实施方式,能够起到以下作用效果。
(1)控制器120在前部件的目标操作角θt与实际操作角θ之差比预先设定的范围大的情况(即修正系数K小于β的情况)下,执行使通过反作用力施加装置111r、112r向对驱动该前部件的执行机构103a、104a进行操作的操作杆111、112施加的操作反作用力增加的修正。控制器120在前部件的目标操作角θt与实际操作角θ之差处于预先设定的范围内的情况(即修正系数K是β以上且小于α的情况下,或是β以上且小于γ的情况)下,执行使通过反作用力施加装置111r、112r向对驱动该前部件的执行机构103a、104a进行操作的操作杆111、112施加的操作反作用力减少的修正。
因此,在操作者对操作杆111、112进行复合操作之际,能够以进行用于使铲斗106的爪尖Pb沿着目标轨迹TL移动的恰当操作的方式对操作进行引导。
(2)执行了使通过反作用力施加装置111r、112r施加的操作反作用力减少的修正后的操作反作用力的大小,是至少在操作杆111、112的非操作时使操作杆111、112返回中立位置NP的大小以上。由此,若操作者从操作杆111、112放开手,则操作杆111、112自然地返回中立位置NP,因此,操作性良好。另外,在紧急时通过从操作杆111、112放开手,能够防止作业继续。
(3)控制器120在执行了目标操作角θt与实际操作角θ之差变大的操作的情况下使操作反作用力增加。由此,操作者通过感知到操作反作用力F增加,能够知晓正在以实际操作角θ远离目标操作角θt的方式操作操作杆R这一情况。
(4)控制器120对实际操作角θ是否处于包括目标操作角θt在内的预先设定的操作范围内(θ1~θ2)进行判定。控制器120在判定为实际操作角θ处于包括目标操作角θt在内的预先设定的操作范围内(θ1~θ2)时,执行使通过反作用力施加装置111r、112r对操作杆111、112施加的操作反作用力减少的修正。
操作者通过感知到操作反作用力减少,能够知晓实际操作角θ接近了目标操作角θt这一情况。由此,操作者能够容易地进行沿着目标轨迹TL的恰当的作业。
(5)在目标轨迹TL与检测到的铲斗106的爪尖Pb的位置之差(例如垂线距离)D比预先设定的阈值Dt小的情况下,执行操作反作用力的修正,在目标轨迹TL与检测到的铲斗106的爪尖Pb的位置之差D比预先设定的阈值Dt大的情况下,不执行操作反作用力的修正。在想要有意地实施与沿着目标轨迹TL的动作不同的动作等的情况下,由于在爪尖Pb从目标轨迹TL大幅度偏离时不执行操作反作用力的修正,因此,用于执行上述不同的动作的操作性良好。
(6)对铲斗106的爪尖Pb的实际速度矢量VAc进行运算,将目标速度矢量VTc的范数决定为与实际速度矢量VAc的范数相同的值。也就是说,铲斗106的爪尖Pb的目标速度被决定为与实际速度的大小相同的值。由此,能够使爪尖Pb顺畅地动作。
(7)设为利用操作反作用力对操作者引导操作的构成,因此,与使用了显示装置的显示画面的图像引导、使用了扬声器的声音引导相比,能够使操作者更直观地理解恰当的操作。
此外,在本实施方式中,姿势运算部121相当于位置检测部,反作用力修正部129的一部分功能相当于目标到达判定部。
以下所述的变形也在本发明的范围内,也可将变形例的一个、或者多个与上述的实施方式组合。
(变形例1)
操作反作用力的修正的方法并不限定于上述的实施方式。
(变形例1-1)
图11的(a)是与图10的(a)同样的图,是表示操作反作用力的修正方法的变形例的图。在图11的(a)中,以双点划线表示上述的实施方式中的操作反作用力的特性。在上述的实施方式中是如下特性:在第1修正控制中,若实际操作角θ与目标操作角θt相比变小、并达到操作角θ1,则操作反作用力增加至基准操作反作用力FB。
与此相对,在本变形例中,若实际操作角θ与目标操作角θt相比变小、并达到操作角θ1,则产生从基准操作反作用力FB进一步增加修正量ΔF而得到的操作反作用力。达到了操作角θ1时的操作反作用力的增加量比上述的实施方式大,因此,操作者能够更清楚地识别实际操作角θ越过目标操作角θt而减小这一情况。
(变形例1-2)
图11的(b)是与图10的(b)同样的图,是表示操作反作用力的修正方法的变形例的图。在图11的(b)中,以双点划线表示上述的实施方式中的操作反作用力的特性。在上述的实施方式中是如下特性:在第2修正控制中,若实际操作角θ与目标操作角θt相比变大、并达到操作角θ2,则产生从基准操作反作用力FB进一步增加修正量ΔF而得到的操作反作用力。
与此相对,在本变形例中,若实际操作角θ与目标操作角θt相比变大、且达到操作角θ2,则使操作反作用力F增加至最大值Fmax。由于达到了操作角θ2时的操作反作用力的增加量比上述的实施方式大,因此操作者能够更清楚地识别实际操作角θ超过目标操作角θt而增加这一情况。
(变形例1-3)
在上述的实施方式中是如下特性:在第2修正控制中,随着实际操作角θ从操作角θ0朝向目标操作角θt增加,操作反作用力F线性增加。与此相对,在本变形例中,如图11的(b)所示,设为如下特性:若实际操作角θ从操作角θ0增加、并超过操作角θ1而变大,则操作反作用力不连续地减少。在本变形例中,在操作角θ0~θ1处,产生从基准操作反作用力FB减少修正量ΔF/2而得到的操作反作用力F,在操作角θ1~θ2处,产生从基准操作反作用力FB减少修正量ΔF而得到的操作反作用力F。如此,根据本变形例,即使在使实际操作角θ增加的操作中,当接近目标操作角θt时也使操作反作用力不连续地减少。因此,操作者通过感知到操作反作用力F不连续地减少,能够知晓实际操作角θ接近了目标操作角θt这一情况。
(变形例1-4)
在上述的实施方式中,对使操作反作用力F不连续地变化的例子进行了说明,但本发明并不限定于此。例如,如图12的(a)和图12的(b)所示,也可以根据实际操作角θ的增加和减小而使操作反作用力F连续地变化。在图12所示的例子中,修正量ΔF根据实际操作角θ而变化。在该情况下,以操作者知晓操作反作用力F的变化的方式设定操作反作用力F的变化量相对于实际操作角θ的变化量的比例(斜率)即可。
(变形例2)
在上述的实施方式中,说明了为求出各前部件的位置而设置有检测各前部件的转动角度的角度传感器110a、110b、110c的例子,但本发明并不限定于此。也可以是,设置对液压缸的行程(stroke)进行检测的行程传感器来替代角度传感器110a、110b、110c,根据行程的信息求出各前部件的位置。
(变形例3)
在上述的实施方式中,说明了在当前时刻的爪尖Pb处于目标轨迹TL上的情况下、目标速度运算部124对目标速度矢量VTc进行运算的例子,但本发明并不限定于此。也可以是,在当前时刻的爪尖Pb处于离开了目标轨迹TL的位置的情况下,目标速度运算部124对爪尖Pb顺畅地朝向目标轨迹TL移动那样的过渡用目标轨迹TLt进行运算,基于该转变用目标轨迹TLt运算目标速度矢量VTc。
(变形例4)
实际速度矢量VAc、斗杆速度矢量VAa以及动臂速度矢量VAb的运算方法并不限定于上述的实施方式。也可以是,例如基于左操作杆111的实际操作角θa来对斗杆速度矢量VAa进行运算,基于右操作杆112的实际操作角θb来对动臂速度矢量VAb进行运算,将两者合成来对实际速度矢量VAc进行运算。
(变形例5)
在上述的实施方式中,说明了反作用力施加装置111r、112r由多个电磁马达构成的例子,但本发明并不限定于此。也可以由螺旋弹簧和使螺旋弹簧的全长变更的活塞构成反作用力施加装置。也可以利用液压、空压等压力来产生反作用力。还可以由例如反作用力缸、对反作用力缸的驱动进行控制的电磁比例阀构成反作用力施加装置。
(变形例6)
在上述的实施方式中,说明了左操作杆111和右操作杆112是电气式的操作杆的例子,但本发明并不限定于此。也可以将本发明适用于液压先导式的操作杆。
(变形例7)
在上述的实施方式中,说明了通过动臂104和斗杆105的复合动作来进行斜面的平整作业的情况的例子,但本发明并不限定于此。也可以对水平牵引等作业适用本发明。也能够对在动臂104和斗杆105的基础上还增加铲斗106的动作而成的复合动作适用本发明。在该情况下,根据右操作杆112的左右方向的倾斜角来决定操作反作用力。
(变形例8)
并不限于成为||VAa||>||VTa||、||VAb||>||VTb||的情况(参照图6)、成为||VAa||<||VTa||、||VAb||<||VTb||的情况。本发明也可适用于成为||VAa||>||VTa||、||VAb||<||VTb||的情况、成为||VAa||<||VTa||、||VAb||>||VTb||的情况。
(变形例9)
在上述的实施方式中,以铲斗106的爪尖Pb的位置沿着目标轨迹TL动作的作业为例进行了说明,但本发明并不限定于此。作为前作业装置的用于决定目标轨迹的预先设定的部位,也可以替代爪尖Pb而采用例如铲斗106的转动中心的位置。在该情况下,针对铲斗106的转动中心的位置沿着目标轨迹TL动作的作业,也能够适用本发明。
(变形例10)
在上述的实施方式中,说明了前作业装置具备动臂104、斗杆105以及铲斗106的例子,但本发明并不限定于此。也可以将本发明适用于具备所谓的组合式前作业装置的工程机械,该工程机械具备:基端动臂,其能够转动地安装于旋转体102;前端动臂,其能够转动地安装于基端动臂;斗杆105,其能够转动地安装于前端动臂;以及铲斗106。能够将本发明适用于至少两个以上的前部件沿着目标轨迹TL复合地***作的各种前作业装置。
(变形例11)
在上述的实施方式中,以履带式的反铲挖掘机为例进行了说明,但本发明并不限定于此。能够将本发明适用于例如装载挖掘机、轮式液压挖掘机等各种工程机械,这些工程机械具备前作业装置,该前作业装置具有包括沿着目标轨迹TL移动的至少两个以上的前部件在内的多个前部件,且至少两个以上的前部件复合地动作。
在上述内容中,对各种实施方式和变形例进行了说明,但本发明并不限定于这些内容。在本发明的技术构思的范围内所能想到的其他形态也包含于本发明的范围内。
如下优先权基础申请的公开内容作为引用文被编入。
日本专利申请2015年第178516号(2015年9月10日申请)
附图标记说明
100液压挖掘机、101行驶体、102旋转体、103前作业装置、103a执行机构、104动臂、104a动臂缸、105斗杆、105a斗杆缸、106铲斗、106a铲斗缸、107驾驶室、108控制阀、109配重、110a动臂角度传感器、110b斗杆角度传感器、110c铲斗角度传感器、111左操作杆、111d操作量传感器、111r反作用力施加装置、112右操作杆、112d操作量传感器、112r反作用力施加装置、120控制器、120d操作量检测部、121姿势运算部、122目标轨迹决定部、123实际速度运算部、124目标速度运算部、125矢量分解部、126目标操作量运算部、127基准反作用力运算部、128判定部、129反作用力修正部
D垂线距离、F操作反作用力、BP旋转中心点、Dt阈值、FB基准操作反作用力、Ka修正系数、Kb修正系数、NP中立位置、Pb爪尖、TL目标轨迹、TLL目标轨迹下限、TLU目标轨迹上限、VAa斗杆速度矢量、VAb动臂速度矢量、VAc实际速度矢量、VTa斗杆速度矢量、VTb动臂速度矢量、VTc目标速度矢量。
Claims (6)
1.一种工程机械,其具备:前作业装置,其具有至少包括第1前部件和第2前部件的多个前部件;多个执行机构,其驱动所述多个前部件;以及操作部,其对所述多个执行机构进行操作,该工程机械的特征在于,
具备反作用力施加装置以及控制装置,
所述反作用力施加装置基于实际操作量对所述操作部施加操作反作用力,
所述控制装置具有:
操作量检测部,其对所述操作部的实际操作量进行检测,以便生成针对所述反作用力施加装置的控制信号;
轨迹决定部,其决定所述前作业装置的预先设定的部位的目标轨迹;
位置检测部,其对通过所述多个前部件驱动而移动的所述前作业装置的预先设定的部位的位置进行检测;
目标速度决定部,其以沿着所述目标轨迹的方式决定所述前作业装置的预先设定的部位的目标速度;
目标操作量决定部,其基于所述目标速度来决定至少所述第1前部件和所述第2前部件各自的目标操作量;以及
反作用力修正控制部,其在所述前部件的目标操作量与实际操作量之差比预先设定的范围大的情况下,执行使通过所述反作用力施加装置向对驱动该前部件的执行机构进行操作的操作部施加的操作反作用力增加的修正,在所述前部件的目标操作量与实际操作量之差处于所述范围内的情况下,执行使通过所述反作用力施加装置向对驱动该前部件的执行机构进行操作的操作部施加的操作反作用力减少的修正。
2.根据权利要求1所述的工程机械,其特征在于,
通过所述反作用力修正控制部执行了使由所述反作用力施加装置施加的操作反作用力减少的修正后的操作反作用力的大小,是至少在所述操作部的非操作时使所述操作部返回中立位置的大小以上。
3.根据权利要求1所述的工程机械,其特征在于,
所述反作用力修正控制部在执行了所述目标操作量与所述实际操作量之差变大的操作的情况下使所述操作反作用力增加。
4.根据权利要求1所述的工程机械,其特征在于,
该工程机械具备目标到达判定部,该目标到达判定部对所述实际操作量是否处于包括所述目标操作量在内的预先设定的操作范围内进行判定,
所述反作用力修正控制部在由所述目标到达判定部判定为所述实际操作量处于包括所述目标操作量在内的预先设定的操作范围内时,执行使通过所述反作用力施加装置对所述操作部施加的操作反作用力减少的修正。
5.根据权利要求1所述的工程机械,其特征在于,
在由所述轨迹决定部决定的所述目标轨迹与由所述位置检测部检测到的所述前作业装置的预先设定的部位的位置之差比预先设定的阈值小的情况下,执行基于所述反作用力修正控制部进行的所述操作反作用力的修正,
在由所述轨迹决定部决定的所述目标轨迹与由所述位置检测部检测到的所述前作业装置的预先设定的部位的位置之差比预先设定的阈值大的情况下,不执行由所述反作用力修正控制部进行的所述操作反作用力的修正。
6.根据权利要求1所述的工程机械,其特征在于,
该工程机械具备对所述前作业装置的预先设定的部位的实际速度进行运算的实际速度运算部,
所述目标速度决定部将所述目标速度的大小决定为与所述实际速度的大小相同的值。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015178516A JP6373812B2 (ja) | 2015-09-10 | 2015-09-10 | 建設機械 |
JP2015-178516 | 2015-09-10 | ||
PCT/JP2016/058082 WO2017043112A1 (ja) | 2015-09-10 | 2016-03-15 | 建設機械 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107709672A true CN107709672A (zh) | 2018-02-16 |
CN107709672B CN107709672B (zh) | 2020-03-31 |
Family
ID=58239524
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201680037755.6A Active CN107709672B (zh) | 2015-09-10 | 2016-03-15 | 工程机械 |
Country Status (6)
Country | Link |
---|---|
US (1) | US10533303B2 (zh) |
EP (1) | EP3348715B1 (zh) |
JP (1) | JP6373812B2 (zh) |
KR (1) | KR101986446B1 (zh) |
CN (1) | CN107709672B (zh) |
WO (1) | WO2017043112A1 (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6552996B2 (ja) * | 2016-06-07 | 2019-07-31 | 日立建機株式会社 | 作業機械 |
JP6889579B2 (ja) * | 2017-03-15 | 2021-06-18 | 日立建機株式会社 | 作業機械 |
JP6581136B2 (ja) * | 2017-03-21 | 2019-09-25 | 日立建機株式会社 | 作業機械 |
JP7119457B2 (ja) * | 2018-03-19 | 2022-08-17 | コベルコ建機株式会社 | 建設機械 |
JP7141894B2 (ja) * | 2018-09-05 | 2022-09-26 | 日立建機株式会社 | 作業機械 |
JP7043470B2 (ja) * | 2019-09-26 | 2022-03-29 | 日立建機株式会社 | 作業機械 |
JP7313633B2 (ja) * | 2020-01-31 | 2023-07-25 | 国立大学法人広島大学 | 位置制御装置及び位置制御方法 |
WO2022097499A1 (ja) * | 2020-11-09 | 2022-05-12 | 国立大学法人広島大学 | 作業機械の自動運転装置 |
WO2024043303A1 (ja) * | 2022-08-26 | 2024-02-29 | コベルコ建機株式会社 | 制御装置及び制御方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0988112A (ja) * | 1995-09-27 | 1997-03-31 | Hitachi Constr Mach Co Ltd | 建設機械の軌跡制御装置 |
CN1165896A (zh) * | 1996-04-26 | 1997-11-26 | 日立建机株式会社 | 建筑机械的轨迹控制装置 |
JPH10317417A (ja) * | 1997-05-19 | 1998-12-02 | Hitachi Constr Mach Co Ltd | 多関節作業機械の姿勢制御装置 |
JP2005320846A (ja) * | 2004-04-05 | 2005-11-17 | Hitachi Constr Mach Co Ltd | 建設機械の操作装置 |
JP2010066962A (ja) * | 2008-09-10 | 2010-03-25 | Hitachi Constr Mach Co Ltd | 操作装置 |
CN102518166A (zh) * | 2011-12-09 | 2012-06-27 | 中联重科股份有限公司 | 一种工程机械的操控***及操控方法 |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4776751A (en) * | 1987-08-19 | 1988-10-11 | Deere & Company | Crowd control system for a loader |
US5950141A (en) * | 1996-02-07 | 1999-09-07 | Komatsu Ltd. | Dozing system for bulldozer |
JPH10147953A (ja) * | 1996-11-18 | 1998-06-02 | Komatsu Ltd | ブルドーザのドージング装置 |
DE69821754T2 (de) * | 1997-06-20 | 2005-01-05 | Hitachi Construction Machinery Co., Ltd. | Vorrichtung zur Regulation der Aushebetiefe einer Baumaschine |
JPH11210015A (ja) * | 1998-01-27 | 1999-08-03 | Hitachi Constr Mach Co Ltd | 建設機械の軌跡制御装置及びその操作装置 |
JP2006144349A (ja) * | 2004-11-18 | 2006-06-08 | Hitachi Constr Mach Co Ltd | 建設機械の安全装置 |
JP4444884B2 (ja) * | 2005-06-28 | 2010-03-31 | 日立建機株式会社 | 建設機械および建設機械に用いられる制御装置 |
JP2007177437A (ja) * | 2005-12-27 | 2007-07-12 | Shin Caterpillar Mitsubishi Ltd | オープンループ式制御機械の力行・回生判別装置 |
JP4628306B2 (ja) * | 2006-05-10 | 2011-02-09 | 日立建機株式会社 | 建設機械 |
US8190334B2 (en) * | 2007-02-21 | 2012-05-29 | Kobelco Construction Machinery Co., Ltd. | Rotation control device and working machine therewith |
US7975410B2 (en) * | 2008-05-30 | 2011-07-12 | Caterpillar Inc. | Adaptive excavation control system having adjustable swing stops |
KR101934017B1 (ko) * | 2011-06-10 | 2018-12-31 | 히다치 겡키 가부시키 가이샤 | 작업 기계 |
JP5969380B2 (ja) * | 2012-12-21 | 2016-08-17 | 住友建機株式会社 | ショベル及びショベル制御方法 |
WO2017047695A1 (ja) * | 2015-09-16 | 2017-03-23 | 住友重機械工業株式会社 | ショベル |
-
2015
- 2015-09-10 JP JP2015178516A patent/JP6373812B2/ja active Active
-
2016
- 2016-03-15 CN CN201680037755.6A patent/CN107709672B/zh active Active
- 2016-03-15 US US15/749,828 patent/US10533303B2/en active Active
- 2016-03-15 WO PCT/JP2016/058082 patent/WO2017043112A1/ja active Application Filing
- 2016-03-15 EP EP16843978.4A patent/EP3348715B1/en active Active
- 2016-03-15 KR KR1020177037400A patent/KR101986446B1/ko active IP Right Grant
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0988112A (ja) * | 1995-09-27 | 1997-03-31 | Hitachi Constr Mach Co Ltd | 建設機械の軌跡制御装置 |
CN1165896A (zh) * | 1996-04-26 | 1997-11-26 | 日立建机株式会社 | 建筑机械的轨迹控制装置 |
JPH10317417A (ja) * | 1997-05-19 | 1998-12-02 | Hitachi Constr Mach Co Ltd | 多関節作業機械の姿勢制御装置 |
JP2005320846A (ja) * | 2004-04-05 | 2005-11-17 | Hitachi Constr Mach Co Ltd | 建設機械の操作装置 |
JP2010066962A (ja) * | 2008-09-10 | 2010-03-25 | Hitachi Constr Mach Co Ltd | 操作装置 |
CN102518166A (zh) * | 2011-12-09 | 2012-06-27 | 中联重科股份有限公司 | 一种工程机械的操控***及操控方法 |
Also Published As
Publication number | Publication date |
---|---|
JP2017053160A (ja) | 2017-03-16 |
US20180223500A1 (en) | 2018-08-09 |
KR20180014032A (ko) | 2018-02-07 |
JP6373812B2 (ja) | 2018-08-15 |
CN107709672B (zh) | 2020-03-31 |
WO2017043112A1 (ja) | 2017-03-16 |
KR101986446B1 (ko) | 2019-06-05 |
EP3348715A4 (en) | 2019-05-01 |
US10533303B2 (en) | 2020-01-14 |
EP3348715B1 (en) | 2020-05-06 |
EP3348715A1 (en) | 2018-07-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107709672A (zh) | 工程机械 | |
CN104011300B (zh) | 回转控制装置及方法 | |
KR100281009B1 (ko) | 2피스부움식 유압셔블의 간섭 방지장치 | |
EP0650544A1 (en) | Coordinated control for a work implement | |
CN108138460A (zh) | 工程机械 | |
EP3597830B1 (en) | Work machinery | |
CN108603360A (zh) | 挖土机 | |
JP6106129B2 (ja) | 建設機械の掘削制御装置 | |
JP4444884B2 (ja) | 建設機械および建設機械に用いられる制御装置 | |
CN112943751B (zh) | 辅助作业控制方法、装置、电子设备和存储介质 | |
CN104641046A (zh) | 液压挖掘机 | |
CN108368690A (zh) | 施工机械中的致动器驱动控制*** | |
US20200224383A1 (en) | Work machine | |
CN108368689A (zh) | 液压工程机械的控制装置 | |
JP2002167794A (ja) | 油圧ショベルのフロント制御装置 | |
JP6692568B2 (ja) | 建設機械 | |
CN107429713B (zh) | 作业机械的液压控制装置 | |
JP7395521B2 (ja) | ショベル、ショベルのシステム | |
CN109642406A (zh) | 作业车辆及作业车辆的控制方法 | |
JPH11350537A (ja) | 油圧作業機械の制御装置 | |
EP3492664A1 (en) | Construction machine | |
WO2023100689A1 (ja) | 建設機械の駆動装置、これを備えた建設機械及び建設機械システム | |
JP2000355957A (ja) | 油圧ショベルの領域制限掘削制御装置 | |
JP2015148928A (ja) | 建設機械 | |
JP3701455B2 (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 |