CN104769189A - 作业车辆 - Google Patents
作业车辆 Download PDFInfo
- Publication number
- CN104769189A CN104769189A CN201480001722.7A CN201480001722A CN104769189A CN 104769189 A CN104769189 A CN 104769189A CN 201480001722 A CN201480001722 A CN 201480001722A CN 104769189 A CN104769189 A CN 104769189A
- Authority
- CN
- China
- Prior art keywords
- scraper bowl
- swing arm
- velocity
- spear
- maximum speed
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
- E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/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
- 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/22—Hydraulic or pneumatic drives
- E02F9/2203—Arrangements for controlling the attitude of actuators, e.g. speed, floating function
- E02F9/2207—Arrangements for controlling the attitude of actuators, e.g. speed, floating function for reducing or compensating oscillations
-
- 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)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Paleontology (AREA)
- Operation Control Of Excavators (AREA)
Abstract
作业车辆具备动臂、斗杆、铲斗、斗杆操作构件、限制速度算出部、速度判定部、调整部和动臂速度确定部。限制速度算出部基于与铲斗的铲尖和设计地形之间的距离的相关关系,算出用于限制铲斗的铲尖速度的限制速度。速度判定部在斗杆操作构件的操作量小于规定量的情况下,判定动臂的上升速度是否成为减速。调整部在通过速度判定部判定为动臂的上升速度成为减速的情况下,与未判定为减速的情况相比,使向限制速度的速度变化延迟。在判定为动臂的上升速度成为减速的情况下,动臂速度确定部基于由调整部进行延迟后的限制速度,来确定动臂的目标速度,在未判定为动臂的上升速度成为减速的情况下,基于通过限制速度算出部算出的限制速度,来确定动臂的目标速度。
Description
技术领域
本发明涉及作业车辆。
背景技术
像液压挖掘机这样的作业车辆具备包括动臂、斗杆和铲斗的工作装置。在作业车辆的控制中,已知有基于挖掘对象的目标形状即目标设计地形来使铲斗移动的自动控制。
在专利文献1中提出有对如下的仿形作业进行自动控制的方式,所述仿形作业是指通过使铲斗的铲尖沿着基准面移动,由此将与铲斗的铲尖抵接的沙土耙平,制作与平坦的基准面对应的面。
在先技术文献
专利文献
专利文献1:日本特开平9-328774号公报
发明内容
发明要解决的课题
在上述那样的仿形作业中,考虑有例如这样的方法:使动臂的动作自动化,由此在对斗杆操作杆进行了操作时,以避免铲斗侵入作为目标的设计地形(目标设计地形)的方式进行控制。
在这样的控制方法中,在斗杆操作杆进行的斗杆操作为微操作的情况下,由自动控制产生的动臂的动作比由斗杆产生的铲斗的动作大。当动臂的上下移动增大时,铲斗的铲尖不稳定而发生摆动。
本发明为了解决上述课题而提出,其目的在于提供一种能够抑制摆动的作业车辆。
其他课题及新的特征可以通过本说明书的记载及附图而得以明确。
用于解决课题的方案
本发明的一方案的作业车辆具备动臂、斗杆、铲斗、斗杆操作构件、限制速度算出部、速度判定部、调整部和动臂速度确定部。限制速度算出部基于与铲斗的铲尖和设计地形之间的距离的相关关系,算出用于限制铲斗的铲尖速度的限制速度。速度判定部在斗杆操作构件的操作量小于规定量的情况下,判定动臂的上升速度是否成为减速。调整部在通过速度判定部判定为动臂的上升速度成为减速的情况下,与未判定为减速的情况相比,使向限制速度的速度变化延迟。动臂速度确定部在判定为动臂的上升速度成为减速的情况下,基于由调整部进行延迟后的限制速度,来确定动臂的目标速度,在未判定为动臂的上升速度成为减速的情况下,基于通过限制速度算出部算出的限制速度,来确定动臂的目标速度。
根据本发明的作业车辆,动臂速度确定部在判定为动臂的上升速度成为减速的情况下,基于由调整部进行延迟后的限制速度,来确定动臂的目标速度,在未判定为动臂的上升速度成为减速的情况下,基于通过限制速度算出部算出的限制速度,来确定动臂的目标速度,由此,能够抑制动臂的上下移动,使铲斗的铲尖稳定而抑制摆动。
优选的是,调整部在通过速度判定部判定为动臂的上升速度成为减速的情况下,在铲斗的铲尖位于设计地形的下方时,使向限制速度的速度变化延迟。
根据上述,仅在铲斗的铲尖位于下方的情况下,使向限制速度的速度变化延迟,因此,在铲斗的铲尖位于上方的情况下,不使向限制速度的速度变化延迟,由此能够执行高速地追随设计地形的控制。
优选的是,调整部具有一阶滞后滤波器,该一阶滞后滤波器被输入由限制速度算出部算出的限制速度。
根据上述,使用一阶滞后滤波器能够容易地使向限制速度的速度变化延迟。
优选的是,与铲斗的铲尖位于设计地形的上方的情况相比,在铲斗的铲尖位于设计地形的下方的情况下,一阶滞后滤波器的滤波频率低。
根据上述,通过使铲斗的铲尖位于设计地形的下方的情况下的滤波频率比铲斗的铲尖位于设计地形的上方的情况下的滤波频率低,由此,在铲斗的铲尖位于下方的情况下,能够使限制速度的速度变化延迟。
优选的是,作业车辆还具备获取铲斗的类别的类别获取部。调整部在通过速度判定部判定为动臂的上升速度成为减速的情况下,按照铲斗的类别而使向限制速度的速度变化延迟。
根据上述,由于按照铲斗的类别而使向限制速度的速度变化延迟,因此能够设定为适当的动臂的目标速度。
优选的是,调整部在通过速度判定部判定为动臂的上升速度成为减速的情况下,就铲斗的类别而言,与铲斗小的相比,在铲斗大的情况下,使向限制速度的速度变化延迟。
根据上述,与铲斗小的情况相比,在铲斗大的情况下,使向限制速度的速度变化延迟,由此,能够设定为考虑了惯性力的适当的动臂的目标速度。
优选的是,调整部在从操作斗杆操作构件起到经过规定期间的期间内,在通过速度判定部判定为动臂的上升速度成为减速的情况下,使向限制速度的速度变化延迟,在从操作斗杆操作构件起经过了规定期间之后,在通过速度判定部判定为动臂的上升速度成为减速的情况下,不使向限制速度的速度变化延迟。
根据上述,调整部在经过规定期间的期间内,在判定为动臂的上升速度成为减速的情况下,使向限制速度的速度变化延迟,在经过了规定期间之后,在判定为动臂的上升速度成为减速的情况下,不使向限制速度的速度变化延迟,由此能够进行有效的控制。
发明效果
关于作业车辆,能够抑制摆动。
附图说明
图1是实施方式中的作业车辆100的外观图。
图2是示意性地说明实施方式中的作业车辆100的图。
图3是表示实施方式中的控制***200的结构的功能框图。
图4是表示实施方式中的液压***的结构的图。
图5是示意性地表示实施方式中的进行仿形控制(限制挖掘控制)的情况下的工作装置2的动作的图。
图6是表示实施方式中的执行仿形控制的控制***200的结构的功能框图。
图7是说明实施方式中的获取铲斗8的铲尖8a与目标设计地形U之间的距离d的图。
图8是说明实施方式中的推定速度确定部52的运算处理的功能框图。
图9是说明实施方式中的垂直速度分量Vcy_am、Vcy_bkt的算出方式的图。
图10是说明实施方式中的仿形控制下的工作装置2整体的限制速度图表的一例的图。
图11是说明实施方式中的算出动臂目标速度Vc_bm_lmt的方式的图。
图12是表示实施方式中的工作装置控制部57的结构的功能框图。
图13是说明实施方式中的作业车辆100的仿形控制(限制挖掘控制)的流程图。
图14是说明铲斗不稳定而发生摆动的情况的图。
图15是说明实施方式中的第二操作杆25L的操作量与PPC压力的关系的图。
图16是说明实施方式中的目标速度确定部54的处理程序段的概要的图。
图17是说明输出调整部54D的输出的延迟的图。
图18是说明实施方式的变形例1中的目标速度确定部54P的处理程序段的概要的图。
图19是说明实施方式的变形例2中的目标速度确定部54Q的处理程序段的概要的图。
具体实施方式
以下,参照附图,对本发明涉及的实施方式进行说明。需要说明的是,本发明并不限定于此。以下所说明的各实施方式的要件可以适当组合。另外,也存在不使用一部分的结构要素的情况。
<作业车辆的整体结构>
图1是实施方式的作业车辆100的外观图。
如图1所示,作为作业车辆100,在本例中,主要例举液压挖掘机来进行说明。
作业车辆100具有车辆主体1和利用液压进行工作的工作装置2。需要说明的是,如后所述,在作业车辆100上搭载有执行挖掘控制的控制***200(图3)。
车辆主体1具有回转体3和行驶装置5。行驶装置5具有一对履带5Cr。作业车辆100通过履带5Cr的旋转而能够行驶。需要说明的是,行驶装置5也可以具有车轮(轮胎)。
回转体3配置在行驶装置5之上,且由行驶装置5支承。回转体3能够以回转轴AX为中心而相对于行驶装置5进行回转。
回转体3具有驾驶室4。在该驾驶室4中设有供操作员就座的驾驶座4S。操作员能够在驾驶室4中对作业车辆100进行操作。
在本例中,以就座于驾驶座4S的操作员为基准来说明各部分的位置关系。前后方向是指就座于驾驶座4S的操作员的前后方向。左右方向是指就座于驾驶座4S的操作员的左右方向。将与就座于驾驶座4S的操作员正对的方向设为前方,将与前方相对的方向设为后方。将就座于驾驶座4S的操作员与正面正对时的右侧、左侧分别设为右方、左方。
回转体3具有收容发动机的发动机室9和设置在回转体3的后部的配重。在回转体3中,在发动机室9的前方设有扶手19。在发动机室9内配置有未图示的发动机及液压泵等。
工作装置2支承于回转体3。工作装置2具有动臂6、斗杆7、铲斗8、动臂油缸10、斗杆油缸11及铲斗油缸12。动臂6与回转体3连接。斗杆7与动臂6连接。铲斗8与斗杆7连接。
动臂油缸10对动臂6进行驱动。斗杆油缸11对斗杆7进行驱动。铲斗油缸12对铲斗8进行驱动。动臂油缸10、斗杆油缸11及铲斗油缸12分别是由工作油来驱动的液压缸。
动臂6的基端部经由动臂销13与回转体3连接。斗杆7的基端部经由斗杆销14与动臂6的前端部连接。铲斗8经由铲斗销15与斗杆7的前端部连接。
动臂6能够以动臂销13为中心进行旋转。斗杆7能够以斗杆销14为中心进行旋转。铲斗8能够以铲斗销15为中心进行旋转。
斗杆7及铲斗8分别是在动臂6的前端侧能够移动的可动构件。
图2(A)及图2(B)是示意性地说明实施方式中的作业车辆100的图。图2(A)示出作业车辆100的侧视图。图2(B)示出作业车辆100的后视图。
如图2(A)及图2(B)所示,动臂6的长度L1为动臂销13与斗杆销14之间的距离。斗杆7的长度L2为斗杆销14与铲斗销15之间的距离。铲斗8的长度L3为铲斗销15与铲斗8的铲尖8a之间的距离。铲斗8具有多个斗齿,在本例中,将铲斗8的前端部称作铲尖8a。
需要说明的是,铲斗8也可以不具有斗齿。铲斗8的前端部也可以由直线形状的钢板来形成。
作业车辆100具有动臂油缸行程传感器16、斗杆油缸行程传感器17和铲斗油缸行程传感器18。动臂油缸行程传感器16配置在动臂油缸10。斗杆油缸行程传感器17配置在斗杆油缸11。铲斗油缸行程传感器18配置在铲斗油缸12。需要说明的是,动臂油缸行程传感器16、斗杆油缸行程传感器17及铲斗油缸行程传感器18也统称为油缸行程传感器。
基于动臂油缸行程传感器16的检测结果,求出动臂油缸10的行程长度。基于斗杆油缸行程传感器17的检测结果,求出斗杆油缸11的行程长度。基于铲斗油缸行程传感器18的检测结果,求出铲斗油缸12的行程长度。
需要说明的是,在本例中,将动臂油缸10、斗杆油缸11及铲斗油缸12的行程长度也分别称作动臂油缸长度、斗杆油缸长度及铲斗油缸长度。另外,在本例中,将动臂油缸长度、斗杆油缸长度及铲斗油缸长度也统称为油缸长度数据L。需要说明的是,也可以采用利用角度传感器来检测行程长度的方式。
作业车辆100具备能够检测作业车辆100的位置的位置检测装置20。
位置检测装置20具有天线21、全局坐标运算部23和IMU(InertialMeasurement Unit)24。
天线21例如是GNSS(Global Navigation Satellite Systems:全球卫星导航***)用的天线。天线21例如是RTK-GNSS(Real TimeKinematic-Global Navigation Satellite Systems)用天线。
天线21设置于回转体3。在本例中,天线21设置于回转体3的扶手19。需要说明的是,天线21也可以设置在发动机室9的后方。例如,可以在回转体3的配重上设置天线21。天线21将与接收到的电波(GNSS电波)对应的信号向全局坐标运算部23输出。
全局坐标运算部23检测全局坐标系中的天线21的设置位置P1。全局坐标系是以设置于作业区域的基准位置Pr为原点的三维坐标系(Xg、Yg、Zg)。在本例中,基准位置Pr是设定在作业区域中的基准桩的前端的位置。另外,局部坐标系是指以作业车辆100为基准的、用(X、Y、Z)表示的三维坐标系。局部坐标系的基准位置是表示位于回转体3的回转轴(回转中心)AX上的基准位置P2的数据。
在本例中,天线21具有以在车宽方向上彼此离开的方式设置于回转体3的第一天线21A及第二天线21B。
全局坐标运算部23检测第一天线21A的设置位置P1 a及第二天线21B的设置位置P1b。全局坐标运算部23获取用全局坐标表示的基准位置数据P。在本例中,基准位置数据P是表示位于回转体3的回转轴(回转中心)AX上的基准位置P2的数据。需要说明的是,基准位置数据P也可以是表示设置位置P1的数据。
在本例中,全局坐标运算部23基于两个设置位置P1a及设置位置P1b来生成回转体方位数据Q。回转体方位数据Q基于由设置位置P1a和设置位置P1b确定的直线相对于全局坐标的基准方位(例如北)所成的角来确定。回转体方位数据Q表示回转体3(工作装置2)所朝向的方位。全局坐标运算部23向后述的显示控制器28输出基准位置数据P及回转体方位数据Q。
IMU24设置于回转体3。在本例中,IMU24配置于驾驶室4的下部。在回转体3中,在驾驶室4的下部配置高刚性的框架。IMU24配置在该框架上。需要说明的是,IMU24也可以配置在回转体3的回转轴AX(基准位置P2)的侧方(右侧或左侧)。IMU24检测车辆主体1的向左右方向倾斜的倾斜角θ4和车辆主体1的向前后方向倾斜的倾斜角θ5。
<控制***的结构>
接着,说明实施方式中的控制***200的概要。
图3是表示实施方式中的控制***200的结构的功能框图。
如图3所示,控制***200对使用工作装置2的挖掘处理进行控制。在本例中,挖掘处理的控制具有仿形控制。
仿形控制也被称作限制挖掘控制,仿形控制是指对如下的仿形作业进行自动控制,所述仿形作业是指:通过铲斗的铲尖沿着设计地形进行移动,由此将与铲斗的铲尖抵接的沙土耙平,制作与平坦的设计地形对应的面。
仿形控制在存在由操作员进行的斗杆操作、且铲斗的铲尖与设计地形之间的距离以及铲尖的速度处于基准内的情况下执行。操作员在仿形控制中通常始终向降低动臂的方向操作动臂且操作斗杆。
控制***200具有动臂油缸行程传感器16、斗杆油缸行程传感器17、铲斗油缸行程传感器18、天线21、全局坐标运算部23、IMU24、操作装置25、工作装置控制器26、压力传感器66及压力传感器67、控制阀27、方向控制阀64、显示控制器28、显示部29、传感器控制器30和人机接口部32。
操作装置25配置在驾驶室4。由操作员对操作装置25进行操作。操作装置25接受驱动工作装置2的操作员操作。在本例中,操作装置25为先导液压方式的操作装置。
通过方向控制阀64来调整相对于液压缸供给的工作油的供给量。方向控制阀64利用向第一液压室及第二液压室供给的油来工作。需要说明的是,在本例中,将为了使液压缸(动臂油缸10、斗杆油缸11及铲斗油缸12)工作而向这些液压缸供给的油也统称为工作油。另外,将为了使方向控制阀64工作而向该方向控制阀64供给的油称作先导油。另外,先导油的压力也称作先导液压。
工作油及先导油可以从同一液压泵送出。例如,可以是,从液压泵送出的工作油的一部分由减压阀减压,将该减压后的工作油作为先导油来使用。另外,也可以是,送出工作油的液压泵(主液压泵)与送出先导油的液压泵(先导液压泵)为不同的液压泵。
操作装置25具有第一操作杆25R和第二操作杆25L。第一操作杆25R配置在例如驾驶座4S的右侧。第二操作杆25L配置在例如驾驶座4S的左侧。就第一操作杆25R及第二操作杆25L而言,前后左右的动作对应于两轴的动作。
通过第一操作杆25R来操作动臂6及铲斗8。
第一操作杆25R的前后方向的操作对应于动臂6的操作,根据前后方向的操作来执行动臂6的下降动作及上升动作。将在为了操作动臂6而进行杆操作从而向先导油路450中供给有先导油的情况下、在压力传感器66上产生的检测压力设为MB。
第一操作杆25R的左右方向的操作对应于铲斗8的操作,根据左右方向的操作来执行铲斗8的挖掘动作及释放动作。将在为了操作铲斗8而进行杆操作从而向先导油路450中供给有先导油的情况下、在压力传感器66上产生的检测压力设为MT。
通过第二操作杆25L来操作斗杆7及回转体3。
第二操作杆25L的前后方向的操作对应于斗杆7的操作,根据前后方向的操作来执行斗杆7的上升动作及下降动作。将在为了操作斗杆7而进行杆操作从而向先导油路450中供给有先导油的情况下、在压力传感器66上产生的检测压力设为MA。
第二操作杆25L的左右方向的操作对应于回转体3的回转,根据左右方向的操作来执行回转体3的右回转动作及左回转动作。
在本例中,就动臂6的向上下方向的动作而言,上升的动作也称作上升动作,下降的动作也称作下降动作。另外,斗杆7的向上下方向的动作也分别称作倾卸动作、挖掘动作。铲斗8的向上下方向的动作也分别称作倾卸动作、挖掘动作。
从主液压泵送出并由减压阀减压后的先导油向操作装置25供给。根据操作装置25的操作量来调整先导液压。
在先导油路450中配置有压力传感器66及压力传感器67。压力传感器66及压力传感器67检测先导液压。压力传感器66及压力传感器67的检测结果向工作装置控制器26输出。
第一操作杆25R为了动臂6的驱动而被向前后方向操作。根据前后方向上的第一操作杆25R的操作量(动臂操作量),由方向控制阀64来调整向用于驱动动臂6的动臂油缸10供给的工作油的流动方向及流量。
第一操作杆25R(操作构件)为了铲斗8的驱动而被向左右方向操作。根据左右方向上的第一操作杆25R的操作量(铲斗操作量),由方向控制阀64来调整向用于驱动铲斗8的铲斗油缸12供给的工作油的流动方向及流量。
第二操作杆25L(操作构件)为了斗杆7的驱动而被向前后方向操作。根据前后方向上的第二操作杆25L的操作量(斗杆操作量),由方向控制阀64来调整向用于驱动斗杆7的斗杆油缸11供给的工作油的流动方向及流量。
第二操作杆25L为了回转体3的驱动而被向左右方向操作。根据左右方向上的第二操作杆25L的操作量,由方向控制阀64来调整向用于驱动回转体3的液压促动器供给的工作油的流动方向及流量。
需要说明的是,也可以是,第一操作杆25R的左右方向的操作对应于动臂6的操作,前后方向的操作对应于铲斗8的操作。需要说明的是,也可以是,第二操作杆25L的左右方向的操作对应于斗杆7的操作,前后方向的操作对应于回转体3的操作。
控制阀27用于调整相对于液压缸(动臂油缸10、斗杆油缸11及铲斗油缸12)供给的工作油的供给量。控制阀27基于来自工作装置控制器26的控制信号来工作。
人机接口部32具有输入部321和显示部(监视器)322。
在本例中,输入部321具有配置在显示部322的周围的操作按钮。需要说明的是,输入部321可以具有触控面板。将人机接口部32也称作多监视器。
显示部322将燃料剩余量及冷却水温度等作为基本信息来显示。
输入部321由操作员来操作。通过输入部321的操作而生成的指令信号向工作装置控制器26输出。
传感器控制器30基于动臂油缸行程传感器16的检测结果来算出动臂油缸长度。动臂油缸行程传感器16将与旋转动作相伴的脉冲向传感器控制器30输出。传感器控制器30基于从动臂油缸行程传感器16输出的脉冲来算出动臂油缸长度。
同样,传感器控制器30基于斗杆油缸行程传感器17的检测结果来算出斗杆油缸长度。传感器控制器30基于铲斗油缸行程传感器18的检测结果来算出铲斗油缸长度。
传感器控制器30根据基于动臂油缸行程传感器16的检测结果而获取的动臂油缸长度,来算出动臂6相对于回转体3的垂直方向的倾斜角θ1。
传感器控制器30根据基于斗杆油缸行程传感器17的检测结果而获取的斗杆油缸长度,来算出斗杆7相对于动臂6的倾斜角θ2。
传感器控制器30根据基于铲斗油缸行程传感器18的检测结果而获取的铲斗油缸长度,来算出铲斗8的铲尖8a相对于斗杆7的倾斜角θ3。
基于作为上述算出结果的倾斜角θ1、θ2、θ3、基准位置数据P、回转体方位数据Q及油缸长度数据L,能够确定作业车辆100的动臂6、斗杆7及铲斗8的位置,能够生成表示铲斗8的三维位置的铲斗位置数据。
需要说明的是,动臂6的倾斜角θ1、斗杆7的倾斜角θ2及铲斗8的倾斜角θ3也可以由油缸行程传感器来检测。可以用回转式编码器那样的角度检测器来检测动臂6的倾斜角θ1。角度检测器通过检测动臂6相对于回转体3的弯曲角度来检测倾斜角θ1。同样,也可以利用安装于斗杆7的角度检测器来检测斗杆7的倾斜角θ2。也可以利用安装于铲斗8的角度检测器来检测铲斗8的倾斜角θ3。
<液压回路的结构>
图4是表示实施方式中的液压***的结构的图。
如图4所示,液压***300具备动臂油缸10、斗杆油缸11及铲斗油缸12(多个液压缸60)、使回转体3回转的回转马达63。需要说明的是,在此,将动臂油缸10也记载为液压缸10(60)。其它的液压缸也同样。
液压缸60利用从未图示的主液压泵供给来的工作油而进行工作。回转马达63为液压马达,利用从主液压泵供给来的工作油而进行工作。
在本例中,相对于各液压缸60设置对工作油流动的方向及流量进行控制的方向控制阀64。从主液压泵供给来的工作油经由方向控制阀64向各液压缸60供给。另外,相对于回转马达63设置方向控制阀64。
各液压缸60具有盖侧(底侧)油室40A和杆侧(头侧)油室40B。
方向控制阀64为使杆状的滑柱移动来切换工作油流动的方向的滑柱方式。通过滑柱沿轴向移动,由此来切换工作油相对于盖侧油室40A的供给和工作油相对于杆侧油室40B的供给。另外,通过滑柱沿轴向移动,由此来调整工作油相对于液压缸60的供给量(每单位时间的供给量)。通过调整工作油相对于液压缸60的供给量,由此来调整缸速度。通过调整缸速度,由此来控制动臂6、斗杆7及铲斗8的速度。在本例中,方向控制阀64作为能够通过滑柱的移动来调整工作油相对于驱动工作装置2的液压缸60的供给量的调整装置而发挥功能。
在各方向控制阀64上设有检测滑柱的移动距离(滑柱行程)的滑柱行程传感器65。滑柱行程传感器65的检测信号向工作装置控制器26输出。
各方向控制阀64的驱动由操作装置25来调整。在本例中,操作装置25为先导液压方式的操作装置。
从主液压泵送出并由减压阀减压后的先导油向操作装置25供给。
操作装置25具有先导液压调整阀。基于操作装置25的操作量来调整先导液压。利用先导液压来驱动方向控制阀64。通过利用操作装置25来调整先导液压,由此来调整轴向上的滑柱的移动量及移动速度。另外,通过操作装置25来切换工作油相对于盖侧油室40A的供给和工作油相对于杆侧油室40B的供给。
操作装置25和各方向控制阀64经由先导油路450而连接。在本例中,在先导油路450中配置有控制阀27、压力传感器66及压力传感器67。
在各控制阀27的两侧设置有检测先导液压的压力传感器66及压力传感器67。在本例中,压力传感器66配置于操作装置25与控制阀27之间的油路451。压力传感器67配置于控制阀27与方向控制阀64之间的油路452。压力传感器66检测由控制阀27调整前的先导液压。压力传感器67检测由控制阀27调整后的先导液压。压力传感器66及压力传感器67的检测结果向工作装置控制器26输出。
控制阀27基于来自工作装置控制器26的控制信号(EPC电流),来调整先导液压。控制阀27为电磁比例控制阀,被基于来自工作装置控制器26的控制信号控制。控制阀27具有控制阀27B和控制阀27A。控制阀27B调整向方向控制阀64的第二受压室供给的先导油的先导液压,从而能够调整经由方向控制阀64向盖侧油室40A供给的工作油的供给量。控制阀27A调整向方向控制阀64的第一受压室供给的先导油的先导液压,从而能够调整经由方向控制阀64向杆侧油室40B供给的工作油的供给量。
需要说明的是,在本例中,先导油路450中的、操作装置25与控制阀27之间的先导油路450被称作油路(上游油路)451。另外,控制阀27与方向控制阀64之间的先导油路450被称作油路(下游油路)452。
先导油经由油路452向各方向控制阀64供给。
油路452具有与第一受压室连接的油路452A和与第二受压室连接的油路452B。
当先导油经由油路452B向方向控制阀64的第二受压室供给时,根据其先导液压而滑柱进行移动。经由方向控制阀64向盖侧油室40A供给工作油。工作油相对于盖侧油室40A的供给量通过与操作装置25的操作量相应的滑柱的移动量来调整。
当先导油经由油路452A向方向控制阀64的第一受压室供给时,根据其先导液压而滑柱进行移动。经由方向控制阀64向杆侧油室40B供给工作油。工作油相对于杆侧油室40B的供给量通过基于操作装置25的操作量所产生的滑柱的移动量来调整。
因而,通过将由操作装置25调整了先导液压后的先导油向方向控制阀64供给,由此来调整轴向上的滑柱的位置。
油路451具有将油路452A与操作装置25连接的油路451A和将油路452B与操作装置25连接的油路451B。
[关于操作装置25的操作和液压***的动作]
如上所述,在操作装置25的操作下,动臂6执行下降动作及上升动作这两种动作。
通过以执行动臂6的上升动作的方式对操作装置25进行操作,由此经由油路451B及油路452B向与动臂油缸10连接的方向控制阀64供给先导油。
由此,来自主液压泵的工作油向动臂油缸10供给,执行动臂6的上升动作。
通过以执行动臂6的下降动作的方式对操作装置25进行操作,由此经由油路451A及油路452A向与动臂油缸10连接的方向控制阀64供给先导油。
由此,来自主液压泵的工作油向动臂油缸10供给,执行动臂6的下降动作。
在本例中,通过动臂油缸10伸长,由此动臂6进行上升动作,通过动臂油缸10收缩,由此动臂6进行下降动作。通过向动臂油缸10的盖侧油室40A供给工作油,由此动臂油缸10伸长,动臂6进行上升动作。通过向动臂油缸10的杆侧油室40B供给工作油,由此动臂油缸10收缩,动臂6进行下降动作。
另外,在操作装置25的操作下,斗杆7执行下降动作及上升动作这两种动作。
通过以执行斗杆7的下降动作的方式对操作装置25进行操作,由此经由油路451B及油路452B向与斗杆油缸11连接的方向控制阀64供给先导油。
由此,来自主液压泵的工作油向斗杆油缸11供给,执行斗杆7的下降动作。
通过以执行斗杆7的上升动作的方式对操作装置25进行操作,由此经由油路451A及油路452A向与斗杆油缸11连接的方向控制阀64供给先导油。
由此,来自主液压泵的工作油向斗杆油缸11供给,执行斗杆7的上升动作。
在本例中,通过斗杆油缸11伸长,由此斗杆7进行下降动作(挖掘动作),通过斗杆油缸11收缩,由此斗杆7进行上升动作(倾卸动作)。通过向斗杆油缸11的盖侧油室40A供给工作油,由此斗杆油缸11伸长,斗杆7进行下降动作。通过向斗杆油缸11的杆侧油室40B供给工作油,由此斗杆油缸11收缩,斗杆7进行上升动作。
另外,在操作装置25的操作下,铲斗8执行下降动作及上升动作这两种动作。
通过以执行铲斗8的下降动作的方式对操作装置25进行操作,由此经由油路451B及油路452B向与铲斗油缸12连接的方向控制阀64供给先导油。
由此,来自主液压泵的工作油向铲斗油缸12供给,执行铲斗8的下降动作。
通过以执行铲斗8的上升动作的方式对操作装置25进行操作,由此经由油路451A及油路452A向与铲斗油缸12连接的方向控制阀64供给先导油。方向控制阀64基于先导液压而动作。
由此,来自主液压泵的工作油向铲斗油缸12供给,执行铲斗8的上升动作。
在本例中,通过铲斗油缸12伸长,由此铲斗8进行下降动作(挖掘动作),通过铲斗油缸12收缩,由此铲斗8进行上升动作(倾卸动作)。通过向铲斗油缸12的盖侧油室40A供给工作油,由此铲斗油缸12伸长,铲斗8进行下降动作。通过向铲斗油缸12的杆侧油室40B供给工作油,由此铲斗油缸12收缩,铲斗8进行上升动作。
另外,在操作装置25的操作下,回转体3执行右回转动作及左回转动作这两种动作。
通过以执行回转体3的右回转动作的方式对操作装置25进行操作,由此将工作油向回转马达63供给。通过以执行回转体3的左回转动作的方式对操作装置25进行操作,由此将工作油向回转马达63供给。
[关于通常控制及仿形控制(限制挖掘控制)和液压***的动作]
说明不执行仿形控制(限制挖掘控制)的、通常控制。
在通常控制的情况下,工作装置2按照操作装置25的操作量而动作。
具体而言,工作装置控制器26将控制阀27打开。通过打开控制阀27,由此油路451的先导液压和油路452的先导液压变得相等。在控制阀27打开的状态下,先导液压(PPC压力)基于操作装置25的操作量而被调整。由此,调整方向控制阀64,而能够执行上述所说明的动臂6、斗杆7、铲斗8的上升动作及下降动作。
另一方面,说明仿形控制(限制挖掘控制)。
在仿形控制(限制挖掘控制)的情况下,工作装置2由工作装置控制器26基于操作装置25的操作来控制。
具体而言,工作装置控制器26向控制阀27输出控制信号。油路451在例如先导液压调整阀的作用下具有规定的压力。
控制阀27基于工作装置控制器26的控制信号而进行工作。油路451的工作油经由控制阀27向油路452供给。因而,油路452的工作油的压力能够由控制阀27来调整(减压)。
油路452的工作油的压力作用于方向控制阀64。由此,方向控制阀64基于由控制阀27控制后的先导液压而进行工作。
例如,工作装置控制器26向控制阀27A及控制阀27B中的至少一方输出控制信号,从而能够调整相对于与斗杆油缸11连接的方向控制阀64的先导液压。通过将由控制阀27A调整了压力后的工作油向方向控制阀64供给,由此滑柱在轴向上向一侧移动。通过将由控制阀27B调整了压力后的工作油向方向控制阀64供给,由此滑柱在轴向上向另一侧移动。由此,能够调整轴向上的滑柱的位置。
另外,同样,工作装置控制器26向控制阀27A及控制阀27B中的至少一方输出控制信号,从而能够调整相对于与铲斗油缸12连接的方向控制阀64的先导液压。
另外,同样,工作装置控制器26向控制阀27A及控制阀27B中的至少一方输出控制信号,从而能够调整相对于与动臂油缸10连接的方向控制阀64的先导液压。
而且,工作装置控制器26向控制阀27C输出控制信号,来调整相对于与动臂油缸10连接的方向控制阀64的先导液压。
由此,工作装置控制器26以使铲斗8的铲尖8a不侵入目标设计地形U的方式来控制(介入控制)动臂6的动作。
在本例中,将为了抑制铲尖8a相对于目标设计地形U的侵入而向与动臂油缸10连接的控制阀27输出控制信号来控制动臂6的位置的控制称作介入控制。
具体而言,工作装置控制器26基于表示挖掘对象的目标形状即设计地形的目标设计地形U及表示铲斗8的铲尖8a的位置的铲斗位置数据S,根据目标设计地形U与铲斗8之间的距离d,以使铲斗8接近目标设计地形U的速度减小的方式来控制动臂6的速度。
液压***300作为对动臂6的上升动作进行介入控制的机构而具有油路501、502、控制阀27C、梭阀51和压力传感器68。
油路501与控制阀27C连接,该油路501用于供给向与动臂油缸10连接的方向控制阀64供给的先导油。
油路501具有供通过控制阀27C之前的先导油流动的油路501和供通过控制阀27C之后的先导油流动的油路502。油路502与控制阀27C和梭阀51连接,经由梭阀51与和方向控制阀64连接的油路452B连接。
压力传感器68检测油路501的先导油的先导液压。
控制阀27C被基于为了执行介入控制而从工作装置控制器26输出的控制信号控制。
梭阀51具有两个入口端口和一个出口端口。一方的入口端口与油路502连接。另一方的入口端口经由油路452B与控制阀27B连接。出口端口经由油路452B与方向控制阀64连接。梭阀51将油路502及与控制阀27B连接的油路452B中的先导液压高的油路与油路452B连接。
梭阀51为高压优先形的梭阀。梭阀51对与入口端口的一方连接的油路502的先导液压和与入口端口的另一方连接的控制阀27B侧的油路452B的先导液压进行比较,选择高压侧的压力。梭阀51将油路502的先导液压及控制阀27B侧的油路452B的先导液压中的高压侧的流路与出口端口连通,而将在该高压侧的流路中流动的先导油向方向控制阀64供给。
在本例中,在不执行介入控制的情况下,工作装置控制器26将控制阀27B全开,并且以关闭油路501的方式向控制阀27C输出控制信号,以使得基于通过操作装置25的操作而调整后的先导液压来驱动方向控制阀64。
另外,在执行介入控制的情况下,工作装置控制器26向各控制阀27输出控制信号,以使得基于通过控制阀27C调整后的先导液压来驱动方向控制阀64。
例如,在执行限制动臂6的移动的介入控制的情况下,工作装置控制器26以使由控制阀27C调整后的先导液压比由操作装置25调整的先导液压高的方式,对控制阀27C进行控制。由此,来自控制阀27C的先导油经由梭阀51向方向控制阀64供给。
<仿形控制>
图5是示意性地表示实施方式中的进行仿形控制(限制挖掘控制)的情况下的工作装置2的动作的图。
如图5所示,在仿形控制(限制挖掘控制)中,以使铲斗8不侵入设计地形的方式,执行包含动臂6的上升动作在内的介入控制。具体而言,在本例中,示出了在由操作装置25操作的斗杆7的挖掘操作所进行的挖掘中,液压***300以使斗杆7下降且使动臂6上升的方式进行控制的情况。
图6是表示实施方式中的执行仿形控制的控制***200的结构的功能框图。
如图6所示,示出控制***200所具有的工作装置控制器26及显示控制器28的功能框。
在此,对主要基于仿形控制(限制挖掘控制)所进行的动臂6的介入控制进行主要说明。如上述所说明的那样,介入控制是为了避免铲斗8的铲尖8a侵入目标设计地形U而对动臂6的动作进行控制的控制。
具体而言,工作装置控制器26基于表示挖掘对象的目标形状即设计地形的目标设计地形U以及表示铲斗8的铲尖8a的位置的铲斗位置数据S,来算出目标设计地形U与铲斗8之间的距离d。并且,根据距离d,以使铲斗8接近目标设计地形U的速度减小的方式,输出基于动臂6的介入控制所产生的向控制阀27的控制指令CBI。
首先,工作装置控制器26算出基于由操作装置25的操作所产生的操作指令的、斗杆7、铲斗8的动作下的铲斗的铲尖8a的推定速度。然后,基于算出结果,以使铲斗8的铲尖8a不侵入目标设计地形U的方式来算出控制动臂6的速度的动臂目标速度。然后,以使动臂6以动臂目标速度进行动作的方式输出向控制阀27的控制指令CBI。
以下,使用图6对功能框具体地进行说明。
如图6所示,显示控制器28具有目标施工信息存储部28A、铲斗位置数据生成部28B和目标设计地形数据生成部28C。
显示控制器28接受来自传感器控制器30的输入。
传感器控制器30根据各油缸行程传感器16、17、18的检测结果来获取各油缸长度数据L及倾斜角θ1、θ2、θ3。另外,传感器控制器30获取从IMU24输出的倾斜角θ4的数据及倾斜角θ5的数据。传感器控制器30将油缸长度数据L、倾斜角θ1、θ2、θ3的数据、倾斜角θ4的数据以及倾斜角θ5的数据向显示控制器28输出。
如上所述,在本例中,油缸行程传感器16、17、18的检测结果及IMU24的检测结果向传感器控制器30输出,传感器控制器30进行规定的运算处理。
在本例中,传感器控制器30的功能可以由工作装置控制器26代替。例如,也可以是,油缸行程传感器(16、17、18)的检测结果向工作装置控制器26输出,工作装置控制器26基于油缸行程传感器(16、17、18)的检测结果来算出油缸长度(动臂油缸长度、斗杆油缸长度及铲斗油缸长度)。IMU24的检测结果也可以向工作装置控制器26输出。
全局坐标运算部23获取基准位置数据P及回转体方位数据Q并向显示控制器28输出。
目标施工信息存储部28A存储表示作业区域的目标形状即立体设计地形的目标施工信息(立体设计地形数据)T。目标施工信息T具有为了生成表示挖掘对象的目标形状即设计地形的目标设计地形(设计地形数据)U所需的坐标数据及角度数据。目标施工信息T也可以经由例如无线通信装置向显示控制器28供给。
铲斗位置数据生成部28B基于倾斜角θ1、θ2、θ3、θ4、θ5、基准位置数据P、回转体方位数据Q及油缸长度数据L,而生成表示铲斗8的三维位置的铲斗位置数据S。需要说明的是,铲尖8a的位置信息也可以从存储器等连接式存储装置传送。
在本例中,铲斗位置数据S是表示铲尖8a的三维位置的数据。
目标设计地形数据生成部28C使用自铲斗位置数据生成部28B获取的铲斗位置数据S和存储于目标施工信息存储部28A的后述的目标施工信息T,来生成表示挖掘对象的目标形状的目标设计地形U。
另外,目标设计地形数据生成部28C将与生成的目标设计地形U相关的数据向显示部29输出。由此,显示部29显示目标设计地形。
显示部29例如为监视器,显示作业车辆100的各种信息。在本例中,显示部29具有作为信息化施工用的引导监视器的HMI(Human MachineInterface)监视器。
目标设计地形数据生成部28C向工作装置控制器26输出与目标设计地形U有关的数据。另外,铲斗位置数据生成部28B将生成的铲斗位置数据S向工作装置控制器26输出。
工作装置控制器26具有推定速度确定部52、距离获取部53、目标速度确定部54、工作装置控制部57和储存部58。
工作装置控制器26从操作装置25的操作指令(压力MA、MT)及显示控制器28获取铲斗位置数据S及目标设计地形U,并输出向控制阀27的控制指令CBI。另外,工作装置控制器26根据需要而从传感器控制器30及全局坐标运算部23获取运算处理所需要的各种参数。
推定速度确定部52算出与用于驱动斗杆7、铲斗8的、操作装置25的杆操作对应的斗杆推定速度Vc_am、铲斗推定速度Vc_bkt。
在此,斗杆推定速度Vc_am是仅斗杆油缸11被驱动的情况下的铲斗8的铲尖8a的速度。铲斗推定速度Vc_bkt是仅铲斗油缸12被驱动的情况下的铲斗8的铲尖8a的速度。
推定速度确定部52算出与斗杆操作指令(压力MA)对应的斗杆推定速度Vc_am。另外,同样,推定速度确定部52算出与铲斗操作指令(压力MT)对应的铲斗推定速度Vc_bkt。由此,能够算出与斗杆7及铲斗7的各操作指令对应的铲斗8的铲尖8a的推定速度。
储存部58存储推定速度确定部52、目标速度确定部54及工作装置控制部57进行运算处理所用的各种图表等数据。
距离获取部53从目标设计地形数据生成部28C获取目标设计地形U的数据。距离获取部53基于自铲斗位置数据生成部28B获取的表示铲斗8的铲尖8a的位置的铲斗位置数据S及目标设计地形U,来算出与目标设计地形U垂直的方向上的铲斗8的铲尖8a与目标设计地形U之间的距离d。
目标速度确定部54按照限制速度图表,以使铲斗8接近目标设计地形U的速度减小的方式来确定动臂6的目标速度Vc_bm_lmt。
具体而言,目标速度确定部54使用表示目标设计地形U与铲斗8之间的距离d和铲尖的限制速度之间的关系的限制速度图表,基于当前的距离d来算出铲尖的限制速度。并且,通过运算铲尖的限制速度与斗杆推定速度Vc_am及铲斗推定速度Vc_bkt的差量,由此来确定动臂6的目标速度Vc_bm_lmt。
需要说明的是,限制速度图表预先储存(存储)于储存部58。
工作装置控制部57按照动臂目标速度Vc_bm_lmt来生成向动臂油缸10的控制指令CBI,并将其向与动臂油缸10连接的控制阀27输出。
由此,对与动臂油缸10连接的控制阀27进行控制,来执行基于仿形控制(限制挖掘控制)的动臂6的介入控制。
[铲斗8的铲尖8a与目标设计地形U之间的距离d的算出]
图7是说明实施方式中的获取铲斗8的铲尖8a与目标设计地形U之间的距离d的图。
如图7所示,距离获取部53基于铲尖8a的位置信息(铲斗位置数据S),来算出铲斗8的铲尖8a与目标设计地形U的表面之间的最短的距离d。
在本例中,基于铲斗8的铲尖8a与目标设计地形U的表面之间的最短的距离d,来执行仿形控制(限制挖掘控制)。
[目标速度的算出方式]
图8是说明实施方式中的推定速度确定部52的运算处理的功能框图。
在图8中,推定速度确定部52算出与斗杆操作指令(压力MA)对应的斗杆推定速度Vc_am及与铲斗操作指令(压力MT)对应的铲斗推定速度Vc_bkt。如上所述,斗杆推定速度Vc_am是仅斗杆油缸11被驱动的情况下的铲斗8的铲尖8a的速度。铲斗推定速度Vc_bkt是仅铲斗油缸12被驱动的情况下的铲斗8的铲尖8a的速度。
推定速度确定部52具有滑柱行程运算部52A、缸速度运算部52B和推定速度确定部52C。
滑柱行程运算部52A基于存储于储存部58的按照操作指令(压力)的滑柱行程图表,来算出液压缸60的滑柱80的滑柱行程量。需要说明的是,用于使滑柱80移动的先导油的压力也被称作PPC压力。
滑柱80的移动量通过由操作装置25或控制阀27控制的油路452的压力(先导液压)来调整。油路452的先导液压是用于使滑柱移动的油路452的先导油的压力,由操作装置25或控制阀27来调整。因而,滑柱的移动量与PPC压力相关。
缸速度运算部52B基于按照算出的滑柱行程量的缸速度图表,来算出液压缸60的缸速度。
液压缸60的缸速度基于从主液压泵经由方向控制阀64供给的每单位时间的工作油的供给量而被调整。方向控制阀64具有能够移动的滑柱80。基于滑柱80的移动量,来调整相对于液压缸60的每单位时间的工作油的供给量。因而,缸速度与滑柱的移动量(滑柱行程)相关。
推定速度确定部52C基于按照算出的液压缸60的缸速度的推定速度图表,来算出推定速度。
工作装置2(动臂6、斗杆7、铲斗8)按照液压缸60的缸速度而动作,因此缸速度与推定速度相关。
通过上述处理,推定速度确定部52算出与斗杆操作指令(压力MA)对应的斗杆推定速度Vc_am及与铲斗操作指令(压力MT)对应的铲斗推定速度Vc_bkt。需要说明的是,滑柱行程图表、缸速度图表、推定速度图表相对于动臂6、斗杆7、铲斗8分别设置,基于实验或模拟来求出,并预先储存于储存部58中。
由此,能够算出与各操作指令对应的铲斗8的铲尖8a的推定速度。
[动臂目标速度的算出方式]
在算出动臂目标速度时,需要算出斗杆7及铲斗8各自的推定速度Vc_am、Vc_bkt的与目标设计地形U的表面垂直的方向上的速度分量(垂直速度分量)Vcy_am、Vcy_bkt。因此,首先,对算出上述垂直速度分量Vcy_am、Vcy_bkt的方式进行说明。
图9(A)~图9(C)是说明实施方式中的上述垂直速度分量Vcy_am、Vcy_bkt的算出方式的图。
如图9(A)所示,目标速度确定部54将斗杆推定速度Vc_am转换成与目标设计地形U的表面垂直的方向上的速度分量(垂直速度分量)Vcy_am和与目标设计地形U的表面平行的方向上的速度分量(水平速度分量)Vcx_am。
在这点上,目标速度确定部54根据从传感器控制器30获取的倾斜角及目标设计地形U等,来求出局部坐标系的垂直轴(回转体3的回转轴AX)相对于全局坐标系的垂直轴的倾斜度和目标设计地形U的表面的垂直方向相对于全局坐标系的垂直轴的倾斜度。目标速度确定部54根据上述的倾斜度求出表示局部坐标系的垂直轴与目标设计地形U的表面的垂直方向的倾斜度的角度β1。
关于铲斗推定速度Vc_bkt也同样。
并且,如图9(B)所示,目标速度确定部54根据局部坐标系的垂直轴与斗杆推定速度Vc_am的方向所成的角度β2,利用三角函数将斗杆推定速度Vc_am转换成局部坐标系的垂直轴方向上的速度分量VL1_am和水平轴方向上的速度分量VL2_am。
并且,如图9(C)所示,目标速度确定部54根据局部坐标系的垂直轴与目标设计地形U的表面的垂直方向的倾斜度β1,利用三角函数将局部坐标系的垂直轴方向上的速度分量VL1_am和水平轴方向上的速度分量VL2_am转换成相对于目标设计地形U的垂直速度分量Vcy_am及水平速度分量Vcx_am。同样,目标速度确定部54将铲斗推定速度Vc_bkt转换成局部坐标系的垂直轴方向上的垂直速度分量Vcy_bkt及水平速度分量Vcx_bkt。
这样,算出上述垂直速度分量Vcy_am、Vcy_bkt。
而且,在算出动臂目标速度时,需要工作装置2整体的限制速度,因此,接下来对工作装置2整体的限制速度图表进行说明。
图10是说明实施方式中的仿形控制下的工作装置2整体的限制速度图表的一例的图。
如图10所示,在此,纵轴表示限制速度Vcy_lmt,横轴表示铲尖与设计地形之间的距离d。
在本例中,铲斗8的铲尖8a位于目标设计地形U的表面的外方(作业车辆100的工作装置2侧)的情况下的距离d为正的值,铲尖8a位于目标设计地形U的表面的内方(比目标设计地形U靠挖掘对象的内部侧)的情况下的距离d为负的值。铲尖8a位于目标设计地形U的表面的上方的情况下的距离d为正的值,铲尖8a位于目标设计地形U的表面的下方的情况下的距离d为负的值。
另外,铲尖8a位于不侵入目标设计地形U的位置的情况下的距离d为正的值,铲尖8a位于侵入目标设计地形U的位置的情况下的距离d为负的值。
另外,铲尖8a位于目标设计地形U上的情况(铲尖8a与目标设计地形U接触的情况)下的距离d为0。
在本例中,将铲尖8a从目标设计地形U的内方朝向外方的情况下的速度设为正的值,将铲尖8a从目标设计地形U的外方朝向内方的情况下的速度设为负的值。将铲尖8a朝向目标设计地形U的上方的情况下的速度设为正的值,将铲尖8a朝向目标设计地形U的下方的情况下的速度设为负的值。
在限制速度信息中,距离d为d1与d2之间的情况下的限制速度Vcy_lmt的倾斜度比距离d为d1以上或d2以下的情况下的倾斜度小。d1大于0。d2小于0。
为了在目标设计地形U的表面附近的操作中更为详细地设定限制速度,使距离d为d1与d2之间的情况下的倾斜度比距离d为d1以上或d2以下的情况下的倾斜度小。
在距离d为d1以上的情况下,限制速度Vcy_lmt为负的值,距离d越大,限制速度Vcy_lmt的绝对值越大。
在距离d为d1以上的情况下,在目标设计地形U的上方,铲尖8a越远离目标设计地形U的表面,朝向目标设计地形U的下方的速度越大,限制速度Vcy_lmt的绝对值越大。
在距离d为0以下的情况下,限制速度Vcy_lmt为正的值,距离d越小,限制速度Vcy_lmt的绝对值越大。
在铲斗8的铲尖8a与目标设计地形U相距的距离d为0以下的情况下,在目标设计地形U的下方,铲尖8a越远离目标设计地形U,朝向目标设计地形U的上方的速度越大,限制速度Vcy_lmt的绝对值越大。
在距离d为规定值dth1时,限制速度Vcy_lmt成为Vmin。规定值dth1为正的值,大于d1。
在距离d为规定值dth1以上时,不进行工作装置2的动作的介入控制。因而,在铲尖8a在目标设计地形U的上方与目标设计地形U分离较远的情况下,不进行工作装置2的动作的介入控制。
在距离d小于规定值dth1的情况下,进行工作装置2的动作的介入控制。具体而言,在距离d小于规定值dth1的情况下,进行动臂6的动作的介入控制。
接着,对使用如上所述求出的上述垂直速度分量Vcy_bm、Vcy_am、Vcy_bkt和工作装置2整体的限制速度图表算出动臂目标速度Vc_bm_lmt的方式进行说明。
图11(A)~图11(D)是说明实施方式中的算出动臂目标速度Vc_bm_lmt的方式的图。
如图11(A)所示,目标速度确定部54按照上述限制速度图表来算出工作装置2整体的限制速度Vcy_lmt。工作装置2整体的限制速度Vcy_lmt为在铲斗8的铲尖8a接近目标设计地形U的方向上能够允许的铲尖8a的移动速度。
在图11(B)中示出斗杆推定速度Vc_am的垂直速度分量Vcy_am和铲斗推定速度Vc_bkt的垂直速度分量Vcy_bkt。
如图9中说明的那样,目标速度确定部54能够基于斗杆推定速度Vc_am、铲斗推定速度Vc_bkt,来算出斗杆推定速度Vc_am的垂直速度分量Vcy_am和铲斗推定速度Vc_bkt的垂直速度分量Vcy_bkt。
在图11(C)中示出了算出动臂6的限制垂直速度分量Vcy_bm_lmt的情况。具体而言,通过从工作装置2整体的限制速度Vcy_lmt中减去斗杆推定速度Vc_am的垂直速度分量Vcy_am和铲斗推定速度Vc_bkt的垂直速度分量Vcy_bkt,由此算出动臂6的限制垂直速度分量Vcy_bm_lmt。
在图11(D)中示出了基于动臂6的限制垂直速度分量Vcy_bm_lmt来算出动臂目标速度Vc_bm_lmt的情况。
在工作装置2整体的限制速度Vcy_lmt小于斗杆推定速度的垂直速度分量Vcy_am与铲斗推定速度的垂直速度分量Vcy_bkt之和的情况下,动臂6的限制垂直速度分量Vcy_bm_lmt成为动臂上升的正的值。
由于动臂目标速度Vc_bm_lmt成为正的值,因此,即使操作装置25被向使动臂6下降的方向操作,工作装置控制器26也进行介入控制,使动臂6上升。因此,能够迅速地抑制目标设计地形U的侵入的扩大。
在工作装置2整体的限制速度Vcy_lmt大于斗杆推定速度的垂直速度分量Vcy_am与铲斗推定速度的垂直速度分量Vcy_bkt之和的情况下,动臂6的限制垂直速度分量Vcy_bm_lmt成为动臂下降的负的值。
由于动臂目标速度Vc_bm_lmt成为负的值,因此动臂6下降。
[控制指令CBI的生成]
图12是表示实施方式中的工作装置控制部57的结构的功能框图。
如图12所示,工作装置控制部57具有缸速度算出部262A、EPC运算部262B和EPC指令部262C。
工作装置控制部57在进行介入控制的情况下向控制阀27输出控制指令CBI,以使得动臂6被以动臂目标速度Vc_bm_lmt驱动。
缸速度算出部262A算出按照动臂目标速度Vc_bm_lmt的液压缸60的缸速度。具体而言,基于预先存储于储存部58的表示仅由动臂6的动作产生的铲斗8的铲尖8a的速度与液压缸60的速度的关系的推定速度图表,来算出按照动臂目标速度Vc_bm_lmt的液压缸60的缸速度。
EPC运算部262B基于算出的缸速度,来对EPC电流值进行运算处理。具体而言,基于预先存储于储存部58的相关数据来进行运算处理。
EPC指令部262C将由EPC运算部262B算出的EPC电流值向控制阀27输出。
储存部58储存表示液压缸60的缸速度与滑柱80的移动量的关系的相关数据、表示滑柱80的移动量与由控制阀27控制的PPC压力的关系的相关数据、表示PPC压力与从EPC运算部262B输出的控制信号(EPC电流)的关系的相关数据。需要说明的是,缸速度图表、相关数据基于实验或模拟来求出,并预先储存于储存部58。
如上所述,液压缸60的缸速度基于从主液压泵经由方向控制阀64供给的每单位时间的工作油的供给量而被调整。方向控制阀64具有能够移动的滑柱80。基于滑柱80的移动量,来调整相对于液压缸60的每单位时间的工作油的供给量。因而,缸速度与滑柱的移动量(滑柱行程)相关。
滑柱80的移动量通过由操作装置25或控制阀27控制的油路452的压力(先导液压)而被调整。油路452的先导液压是用于使滑柱移动的油路452的先导油的压力,由操作装置25或控制阀27来调整。需要说明的是,将用于使滑柱80移动的先导油的压力也称作PPC压力。因而,滑柱的移动量与PPC压力相关。
控制阀27基于从工作装置控制器26的EPC运算部262B输出的控制信号(EPC电流)而进行工作。因而,PPC压力与EPC电流相关。
工作装置控制部57算出与由目标速度确定部54算出的动臂目标速度Vc_bm_lmt对应的EPC电流值,并将EPC电流作为控制指令CBI从EPC指令部262C向控制阀27输出。
由此,工作装置控制器26能够通过介入控制以使铲斗8的铲尖8a不侵入目标设计地形U的方式对动臂6进行控制。
另外,根据需要,工作装置控制器26对斗杆7及铲斗8进行控制。工作装置控制器26通过向控制阀27发送斗杆控制指令,由此来控制斗杆油缸11。斗杆控制指令具有与斗杆指令速度相应的电流值。工作装置控制器26通过向控制阀27发送铲斗控制指令,由此来控制铲斗油缸12。铲斗控制指令具有与铲斗指令速度相应的电流值。
关于这种情况下的运算,也能够如上所述那样,按照与根据动臂目标速度Vc_bm_lmt算出EPC电流同样的方式,将具有对控制阀27进行控制的电流值的斗杆控制指令及铲斗控制指令向控制阀27输出。
图13是说明实施方式中的作业车辆100的仿形控制(限制挖掘控制)的流程图。
如图13所示,首先,设定设计地形(步骤SA1)。具体而言,通过显示控制器28的目标设计地形数据生成部28C来设定目标设计地形U。
接着,获取铲尖与设计地形之间的距离d(步骤SA2)。具体而言,距离获取部53基于按照来自铲斗位置数据生成部28B的铲斗位置数据S的铲尖8a的位置信息和目标设计地形U,来算出铲斗8的铲尖8a与目标设计地形U的表面之间的最短的距离d。
接着,确定推定速度(步骤SA3)。具体而言,工作装置控制器26的推定速度确定部52确定斗杆推定速度Vc_am及铲斗推定速度Vc_bkt。斗杆推定速度Vc_am为仅斗杆油缸11被驱动的情况下的铲尖8a的速度。铲斗推定速度Vc_bkt为仅铲斗油缸12被驱动的情况下的铲尖8a的速度。
斗杆推定速度Vc_am、铲斗推定速度Vc_bkt按照存储于储存部58的各种图表并基于操作装置25的操作指令(压力MA、MT)而算出。
接着,将目标速度转换成垂直速度分量(步骤SA4)。具体而言,目标速度确定部54如图9中说明的那样将斗杆推定速度Vc_am、铲斗推定速度Vc_bkt转换成相对于目标设计地形U的垂直速度分量Vcy_am、Vcy_bkt。
接着,算出工作装置2整体的限制速度Vcy_lmt(步骤SA5)。具体而言,目标速度确定部54基于距离d,按照限制速度图表来算出限制速度Vcy_lmt。
接着,确定动臂的目标速度分量Vcy_bm_lmt(步骤SA6)。具体而言,目标速度确定部54如图11中说明的那样根据工作装置2整体的限制速度Vcy_lmt、斗杆推定速度Vc_am和铲斗推定速度Vc_bkt,来算出动臂6的目标速度的垂直速度分量(目标垂直速度分量)Vcy_bm_lmt。
接着,将动臂的目标垂直速度分量Vcy_bm_lmt转换成目标速度Vc_bm_lmt(步骤SA7)。具体而言,目标速度确定部54如图11中说明的那样将动臂6的目标垂直速度分量Vcy_bm_lmt转换成动臂6的目标速度(动臂目标速度)Vc_bm_lmt。
接着,工作装置控制部57算出与动臂目标速度Vc_bm_lmt对应的EPC电流值,将EPC电流作为控制指令CBI从EPC指令部262C向控制阀27输出(步骤SA10)。由此,工作装置控制器26能够以使铲斗8的铲尖8a不侵入目标设计地形U的方式对动臂6进行控制。
然后,结束处理(结束)。
这样,在本例中,工作装置控制器26基于表示挖掘对象的目标形状即设计地形的目标设计地形U和表示铲斗8的铲尖8a的位置的铲斗位置数据S,根据目标设计地形U与铲斗8的铲尖8a之间的距离d,以使铲斗8接近目标设计地形U的相对速度减小的方式对动臂6的速度进行控制。
工作装置控制器26基于表示挖掘对象的目标形状即设计地形的目标设计地形U和表示铲斗8的铲尖8a的位置的铲斗位置数据S,根据目标设计地形U与铲斗8的铲尖8a之间的距离d来确定限制速度,以使工作装置2接近目标设计地形U的方向上的速度成为限制速度以下的方式对工作装置2进行控制。由此,执行仿形控制(挖掘限制控制),执行动臂油缸的速度调整。通过该方式,能够控制铲尖8a相对于目标设计地形U的位置,抑制铲尖8a相对于目标设计地形U的侵入,从而执行制作与设计地形相符的面的仿形作业。
[限制速度的调整]
如上所述,对操作装置25的第二操作杆25L进行操作来操作斗杆7,由此能够执行通过铲斗8的铲尖8a制作与设计地形对应的面的仿形作业。
具体而言,通过动臂6的介入控制,以避免铲斗8侵入设计地形的方式进行控制。在这一点上,按照限制速度图表,根据目标设计地形U与铲斗8的铲尖8a之间的距离d,算出动臂目标速度来控制动臂6的速度。
另一方面,在第二操作杆25L的斗杆操作为微操作的情况下,由介入控制产生的动臂6的动作比由斗杆操作产生的铲斗8的铲尖8a的动作大。
因此,如图14所示,当动臂6的动作比斗杆7大时,反复进行动臂目标速度的增速、减速而上下的动作增大,因此,铲斗8的铲尖8a不稳定而发生摆动。
在图14中,示出铲斗8的铲尖8a位于设计地形以下的情况,在基于铲尖8a与设计地形之间的距离d而增速的动臂目标速度的作用下,铲尖8a向设计地形上升。并且,然后,基于距离d而动臂目标速度减速,其结果是,由于基于斗杆7产生的铲斗8的挖入而铲尖8a下降。将该由于基于斗杆7产生的铲斗8的挖入而铲尖8a下降的区间也称为动臂上升减速区域。
而后,再次在基于距离d而增速的动臂目标速度的作用下,铲尖8a向设计地形上升。并且,然后,基于距离d而动臂目标速度减速,其结果是,由于基于斗杆7产生的铲斗8的挖入而铲尖8a下降。
反复进行该处理的结果是发生铲尖8a的摆动。
在实施方式中,说明在第二操作杆25L的斗杆操作为微操作的情况下调整动臂目标速度的方式。
图15是说明实施方式中的第二操作杆25L的操作量与PPC压力的关系的图。
如图15所示,示出随着第二操作杆25L的操作量增大而PPC压力上升的情况。在操作量为0附近设置界限(margin),PPC压力从某一规定的操作量起线性地上升。
并且,在本例中,将第二操作杆25L的操作量到规定值X为止的范围称为微操作区域。第二操作杆25L的操作量为规定值X时的PPC压力是Y。而且,将比微操作区域大的规定值X以上的区域也称为通常操作区域。
图16是说明实施方式中的目标速度确定部54的处理程序段的概要的图。
如图16所示,目标速度确定部54包括限制速度算出部54A、速度判定部54B、运算部54C、输出调整部54D和斗杆操作判定部54E。
限制速度算出部54A执行使用了图10说明的限制速度图表的运算处理。
具体而言,限制速度算出部54A按照限制速度图表,算出与通过距离获取部53获取的铲斗8的铲尖8a与目标设计地形U之间的距离d对应的工作装置2整体的限制速度Vcy_lmt。
斗杆操作判定部54E判断第二操作杆25L的操作量是否小于规定值X。并且,将判断结果向速度判定部54B输出。
具体而言,如图15中说明的那样,斗杆操作判定部54E基于操作装置25的操作指令(压力MA),判断第二操作杆25L的操作量是否小于规定值X。
在判断为第二操作杆25L的操作量小于规定值X的情况下,速度判定部54B判定动臂6的速度是否成为减速。
具体而言,速度判定部54B基于从运算部54C输出的动臂目标速度Vc_bm_lmt的变化来判定是否成为减速。
速度判定部54B在判定为动臂6的速度成为减速的情况下,将通过限制速度算出部54算出的限制速度Vcy_lmt向输出调整部54D输出。速度判定部54B在判定为动臂6的速度未成为减速的情况下,跳过输出调整部54D,将通过限制速度算出部54算出的限制速度Vcy_lmt向运算部54C输出。
速度判定部54B在判断为第二操作杆25L的操作量未小于规定值X的情况下(为规定值X以上的情况下),跳过输出调整部54D,将通过限制速度算出部54算出的限制速度Vcy_lmt向运算部54C输出。输出调整部54D使向通过限制速度算出部54算出的限制速度Vcy_lmt的变化延迟。具体而言,输出调整部54D具有一阶滞后滤波器,该一阶滞后滤波器具有规定的滤波特性。
本例中的一阶滞后滤波器的规定的滤波特性按照铲斗8的铲尖8a与设计地形之间的距离d来变更滤波频率f。滤波频率f设定一阶滞后滤波器的响应速度,滤波频率越高,响应速度越快,滤波频率越低,响应速度越慢。
在此,纵轴是滤波频率f,横轴表示铲斗8的铲尖8a与设计地形之间的距离d。
在本例中,铲斗8的铲尖8a位于设计地形的上方(作业车辆100的工作装置2侧)的情况下的距离d为正值,铲尖8a位于设计地形的下方的情况下的距离d为负值。
在铲斗8的铲尖8a位于设计地形的下方的情况下(距离d<0),滤波频率f设定为规定值z以下。通过将滤波频率f设定为规定值z以下,与位于设计地形的上方的情况相比,向一阶滞后滤波器输入的限制速度Vcy_lmt的响应速度延迟。
另一方面,在铲斗8的铲尖8a位于设计地形的上方的情况下(距离d>0),设定为比规定值z大的值。通过将滤波频率f设定为比规定值z大的值,与位于设计地形的下方的情况相比,向一阶滞后滤波器输入的限制速度Vcy_lmt的响应速度加快,从而抑制延迟。
运算部54C基于限制速度Vcy_lmt、根据斗杆推定速度Vc_am而得到的斗杆推定速度Vc_am的垂直速度分量Vcy_am、根据铲斗推定速度Vc_bkt而得到的铲斗推定速度Vc_bkt的垂直速度分量Vcy_bkt,算出动臂目标速度Vc_bm_lmt。
具体而言,按照图11中说明的方式,算出动臂目标速度Vc_bm_lmt。
并且,工作装置控制部57按照通过目标速度确定部54确定的动臂目标速度Vc_bm_lmt,将控制指令CBI向控制阀27输出。
实施方式的工作装置控制器26的目标速度确定部54在操作了第二操作杆25L的操作量(斗杆操作量)小于规定量X的情况下,在判定为动臂目标速度减速的情况下,与判定为动臂目标速度未减速的情况相比,使向限制速度Vcy_lmt的变化延迟,从而算出动臂目标速度。
具体而言,在输出调整部54D中,在判定为动臂目标速度减速时,与判定为未减速时相比,基于滤波频率f而使向限制速度Vcy_lmt的变化延迟。
需要说明的是,限制速度算出部54A、速度判定部54B、输出调整部54D分别是本发明的“限制速度算出部”、“速度判定部”、“调整部”的一例。而且,运算部54C是本发明的“动臂速度确定部”的一例。
需要说明的是,虽然说明了本例中的速度判定部54B基于从运算部54C输出的动臂目标速度Vc_bm_lmt的变化来判定是否成为减速的情况,但并不特别限定,也可以采用其他的方式。例如,也可以为在基于从EPC指令部262C输出的EPC电流值的变化而判定为减速的情况下将限制速度Vcy_lmt向输出调整部54D输出的方式。而且,并不局限于EPC电流值,也可以基于液压缸的速度变化或滑柱行程量的变化来判定为减速。
图17是说明输出调整部54D的一阶滞后滤波器的特性的图。
如图17所示,在本例中,示出在时刻tA以阶跃响应到达目标值的情况和在时刻tB到达目标值的情况。
因此,通过经由一阶滞后滤波器而使向输入的限制速度Vcy_lmt的到达延迟。
由此,在输出调整部54D中,仅在动臂目标速度减速的情况下,向限制速度Vcy_lmt的变化延迟,因此,能抑制由介入控制引起的动臂6的向动臂目标速度的急剧减速的变化。
通过抑制动臂目标速度的急剧减速而实现动臂的上升速度的变化的圆滑化,由此,图14中说明的动臂上升减速区域的距离缩短。由此,能抑制动臂6的上下的动作,因此能够使铲斗8的铲尖8a稳定而抑制摆动。
滤波频率f在铲斗8的铲尖8a位于设计地形的上方的情况下(距离d>0),设定为比规定值z大的值,因此,响应速度加快,能抑制延迟。由此,在铲斗8的铲尖8a位于设计地形的上方的情况下,能够执行高速地追随设计地形的高精度的仿形控制。
另外,目标速度确定部54的速度判定部54B在操作了第二操作杆25L的操作量(斗杆操作量)为规定量X以上的情况下,跳过输出调整部54D而向运算部54C输出。因此,限制速度Vcy_lmt未被调整。
这种情况下,由于斗杆操作产生的铲斗8的铲尖8a的动作大,因此介入控制产生的动臂6的动臂目标速度未成为主导,因此上下的动作不大。因此,不调整而设定动臂目标速度,由此能够执行铲斗8的铲尖8a追随设计地形的高精度的仿形控制。
<变形例1>
在实施方式的变形例1中,将目标速度确定部54变更为目标速度确定部54P。
图18是说明实施方式的变形例1中的目标速度确定部54P的处理程序段的概要的图。
目标速度确定部54P使目标速度确定部54还具有计时器功能。在操作第二操作杆25L后的规定时间,执行输出调整部54D的调整处理。通过该方式,能够仅在基于第二操作杆25L产生的铲斗8的刚开始动作之后执行调整处理。如上所述,在基于第二操作杆25L产生的铲斗8的刚开始动作之后,存在铲斗8的铲尖8a不稳定的可能性。因此,仅在刚开始动作之后的期间内执行输出调整部54D的调整处理,在铲斗8的铲尖8a稳定的经过规定期间后,不进行输出调整部54D的调整处理而进行通常控制。
如图18所示,目标速度确定部54P与目标速度确定部54相比,不同点是还设有计时器54F。关于其他的点,由于相同,因此不重复其详细说明。
计时器54F基于操作了第二操作杆25L的操作时间的输入而切换运算的处理。
具体而言,计时器54F在操作了第二操作杆25L的操作时间小于规定时间的情况下,执行输出调整部54D的调整处理,在操作时间为规定时间以上的情况下,跳过输出调整部54D而向运算部54C输出限制速度。
因此,输出调整部54D在操作了第二操作杆25L的操作量(斗杆操作量)小于规定量X且判定为动臂目标速度减速的情况下,并且在操作时间小于规定时间的情况下,使向限制速度Vcy_lmt的变化延迟。输出调整部54D在操作时间为规定时间以上的情况下,或判定为动臂目标速度未减速的情况下,或操作了第二操作杆25L的操作量(斗杆操作量)为规定量X以上的情况下,不调整限制速度Vcy_lmt。
在实施方式的变形例1中,仅在操作了第二操作杆25L的操作时间小于规定时间的情况下,执行输出调整部54B的调整处理。
通过该方式,能够仅在操作了第二操作杆25L的斗杆操作的刚开始动作之后的规定时间执行输出调整部54B的调整处理,在铲斗8的铲尖8a稳定的经过规定期间后,不进行输出调整部54B的调整处理而进行通常控制。
由此,能够仅在操作了第二操作杆25L的斗杆操作的刚开始动作之后的规定时间抑制由于介入控制产生的动臂6的动臂目标速度的急剧减速。通过抑制动臂目标速度的急剧减速而实现动臂的上升速度的变化的圆滑化,由此能够抑制动臂6的上下的动作,因此能够使铲斗8的铲尖8a稳定而抑制摆动。
而且,在铲斗8的铲尖8a稳定的经过规定时间后,按照通常控制来设定动臂目标速度,由此能够进行有效的控制,能够执行使铲斗8的铲尖8a追随设计地形的高精度的仿形控制。
需要说明的是,在本例中,说明了在速度判定部54B之后设置计时器54F的结构,但并不特别局限于此,也可以在计时器54F之后设置速度判定部54B。
<变形例2>
在实施方式的变形例2中,将目标速度确定部54变更为目标速度确定部54Q。
目标速度确定部54Q按照铲斗8的类别来调整滤波频率。
图19是说明实施方式的变形例2中的目标速度确定部54Q的处理程序段的概要的图。
如图19所示,目标速度确定部54Q与目标速度确定部54相比,不同点是将输出调整部54B置换为输出调整部54H且还设有铲斗类别获取部54G。关于其他的点,由于相同,因此不重复其详细说明。
铲斗类别获取部54G基于输入数据来判断铲斗8的类别。在本例中,判断铲斗8为“大”、“小”这两种的类别。
铲斗8“大”表示铲斗重量重。铲斗8“小”表示铲斗重量轻。
就向铲斗类别获取部54F输入的输入数据而言,作为一例,是基于在向作业车辆100装配铲斗8时操作员经由人机接口部32的输入部321设定的铲斗8的类别数据的数据。
例如,在显示部322显示的铲斗重量设定的画面中,操作员能够设定铲斗8的重量。
另外,铲斗8的重量也可以不是由操作员手动地选择,而基于在液压缸60(动臂油缸10、斗杆油缸11及铲斗油缸12)的内部产生的压力自动地检测。这种情况下,例如在作业车辆100为特定的姿势且铲斗8浮在空中的状态下检测在液压缸60的内部产生的压力。基于检测到的液压缸60内部的压力,也能够确定装配于斗杆7的铲斗8的重量。作为输入数据,铲斗类别获取部54F接受该检测到的液压缸60内部的压力的数据,可以基于该数据进行判断。
输出调整部54H基于按照由铲斗类别获取部54G获取的铲斗类别的调整图表,来调整限制速度Vcy_lmt。
具体而言,输出调整部54H包含具有规定的滤波特性的一阶滞后滤波器。
本例的一阶滞后滤波器的规定的滤波特性具有特性线T1、T2。
而且,在铲斗8的铲尖8a位于设计地形的下方的情况下(距离d<0),滤波频率f设定为规定值z以下。通过将滤波频率f设定为规定值z以下,从而向一阶滞后滤波器输入的限制速度Vcy_lmt的输出延迟。
特性线T1、T2与铲斗8为“大”、“小”的情况分别对应地设置。在此,就特性线T1、T2而言,在铲斗8的铲尖8a位于设计地形的下方的情况下(距离d<0),按照特性线T1的频率f的值小于按照特性线T2的频率f的值。
输出调整部54H按照由铲斗类别获取部54G获取的铲斗类别来选择特性线T1、T2中的任一方。并且,输出调整部54DH按照基于所选择的特性线的频率f,使向限制速度Vcy_lmt的变化延迟。
具体而言,在铲斗8的铲尖8a位于设计地形的下方的情况下(距离d<0),按照铲斗8为“大”的情况下的特性线T1的频率f小于按照铲斗8为“小”的情况下的特性线T2的频率f。
因此,与铲斗8为“小”的情况相比,在铲斗8为“大”的情况下,能够使动臂6的向动臂目标速度的变化延迟。
在铲斗8的类别为“大”的情况下,与铲斗8的类别为“小”的情况相比,按照动臂目标速度的铲斗8的惯性力增大,因此,为了使铲斗8的铲尖8a稳定,优选使向动臂目标速度的减速的变化延迟。另一方面,在铲斗8的类别为“小”的情况下,由于铲斗8的惯性力减小,因此向动臂目标速度的急剧减速的变化可以不用那样延迟。
通过按照实施方式的变形例2的方式,能够根据铲斗8的类别来适当地调整动臂目标速度,使由介入控制产生的动臂6的向动臂目标速度的急剧减速的变化延迟。通过使向动臂目标速度的急剧减速的变化延迟,能抑制动臂6的上下的动作,因此能够使铲斗8的铲尖8a稳定而抑制摆动。
需要说明的是,在本例中,作为铲斗8的类别,说明了“大”、“小”这两种的情况,但是并不特别局限于“大”、“小”,而且也可以按照多个种类的铲斗8的类别而设置系数K的调整图表来进行调整。
需要说明的是,铲斗类别获取部54G是本发明的“类别获取部”的一例。
而且,也可以与变形例1组合而形成为还设有计时器54F的结构。在该结构的情况下,能够仅在操作了第二操作杆25L的斗杆操作的刚开始动作之后的规定时间执行输出调整部54H的调整处理,在铲斗8的铲尖8a稳定的经过规定期间后,不进行输出调整部54H的调整处理而进行通常控制。
需要说明的是,在本例中,对使用表示缸速度与滑柱行程的关系的缸速度图表来算出缸速度的方式进行了说明,但也可以在储存部58中储存表示缸速度与PPC压力(先导压力)的关系的缸速度图表,使用其相关数据来算出缸速度。
需要说明的是,在本例中,也可以将控制阀27全开,利用压力传感器66及压力传感器67来检测压力,并基于其检测值来进行压力传感器66及压力传感器67的校准。在将控制阀27全开的情况下,压力传感器66和压力传感器67输出相同的检测值。在将控制阀27全开的情况下,在压力传感器66和压力传感器67输出了不同的检测值的情况下,可以求出表示压力传感器66的检测值与压力传感器67的检测值的关系的相关数据。
以上,对本发明的一实施方式进行了说明,但本发明并不局限于上述实施方式,可以在不脱离发明的主旨的范围内进行各种变更。
例如,在上述的例子中,操作装置25设为先导液压方式。操作装置25也可以为电杆方式。例如,可以设置检测操作装置25的操作杆的操作量并将与该操作量相应的电压值向工作装置控制器26输出的电位计等的操作杆检测部。工作装置控制器26可以基于该操作杆检测部的检测结果,向控制阀27输出控制信号来调整先导液压。本控制由工作装置控制器进行,但也可以由传感器控制器30等其它的控制器进行。
在上述的实施方式中,作为作业车辆的一例,列举了液压挖掘机,但不局限于液压挖掘机,本发明也可以应用于其它种类的作业车辆。
全局坐标系中的液压挖掘机的位置的获取并不局限于GNSS,也可以通过其它的测位手段来进行。因而,铲尖8a与设计地形之间的距离d的获取并不局限于GNSS,也可以通过其他的测位手段来进行。
以上,对本发明的实施方式进行了说明,应当认为本次公开的实施方式在所有方面均是例示,而并非是限制性的内容。本发明的范围由权利要求书表示,意在包含与权利要求书等同意义以及范围内的所有变更。
符号说明
1 车辆主体、2 工作装置、3 回转体、4 驾驶室、4S 驾驶席、5 行驶装置、5Cr 履带、6 动臂、7 斗杆、8 铲斗、8a 铲尖、9发动机室、10 动臂油缸、11 斗杆油缸、12 铲斗油缸、13 动臂销、14 斗杆销、15 铲斗销、16 动臂油缸行程传感器、17 斗杆油缸行程传感器、18 铲斗油缸行程传感器、19 扶手、20 位置检测装置、21天线、21A 第一天线、21B 第二天线、23 全局坐标运算部、25 操作装置、25L 第二操作杆、25R 第一操作杆、26 工作装置控制器、27、27A、27B、27C 控制阀、28 显示控制器、28A 目标施工信息存储部、28B 铲斗位置数据生成部、28C 目标设计地形数据生成部、29、322 显示部、30 传感器控制器、32 人机接口部、51 梭阀、52 推定速度确定部、52A 滑柱行程运算部、52B 缸速度运算部、52C 目标速度运算部、53 距离获取部、54 目标速度确定部、54A 限制速度算出部、54B 速度判定部、54C 运算部、54D 输出调整部、54E 斗杆操作判定部、54F 计时器、54G 铲斗类别获取部、57 工作装置控制部、58 储存部、60 液压缸、63 回转马达、64 方向控制阀、65 滑柱行程传感器、66、67、68 压力传感器、100 作业车辆、200 控制***、262A 缸速度算出部、262B EPC运算部、262C EPC指令部、300 液压***、321 输入部、450 先导油路。
Claims (7)
1.一种作业车辆,其具备:
动臂;
斗杆;
铲斗;
斗杆操作构件;
限制速度算出部,其基于与所述铲斗的铲尖和设计地形之间的距离的相关关系,算出用于限制所述铲斗的铲尖速度的限制速度;
速度判定部,其在所述斗杆操作构件的操作量小于规定量的情况下,判定所述动臂的上升速度是否成为减速;
调整部,其在通过所述速度判定部判定为所述动臂的上升速度成为减速的情况下,与未判定为减速的情况相比,使向所述限制速度的速度变化延迟:
动臂速度确定部,其在判定为所述动臂的上升速度成为减速的情况下,基于由所述调整部进行延迟后的限制速度,来确定所述动臂的目标速度,在未判定为所述动臂的上升速度成为减速的情况下,基于通过所述限制速度算出部算出的限制速度,来确定所述动臂的目标速度。
2.根据权利要求1所述的作业车辆,其中,
所述调整部在通过所述速度判定部判定为所述动臂的上升速度成为减速的情况下,在所述铲斗的铲尖位于所述设计地形的下方时,使向所述限制速度的速度变化延迟。
3.根据权利要求1所述的作业车辆,其中,
所述调整部具有一阶滞后滤波器,该一阶滞后滤波器被输入由所述限制速度算出部算出的限制速度。
4.根据权利要求3所述的作业车辆,其中,
与所述铲斗的铲尖位于所述设计地形的上方的情况相比,在所述铲斗的铲尖位于所述设计地形的下方的情况下,所述一阶滞后滤波器的滤波频率低。
5.根据权利要求1~4中任一项所述的作业车辆,其中,
所述作业车辆还具备获取所述铲斗的类别的类别获取部,
所述调整部在通过所述速度判定部判定为所述动臂的上升速度成为减速的情况下,按照所述铲斗的类别而使向所述限制速度的速度变化延迟。
6.根据权利要求5所述的作业车辆,其中,
所述调整部在通过所述速度判定部判定为所述动臂的上升速度成为减速的情况下,就所述铲斗的类别而言,与所述铲斗小的情况相比,在所述铲斗大的情况下,使向所述限制速度的速度变化延迟。
7.根据权利要求1~6中任一项所述的作业车辆,其中,
所述调整部在从操作所述斗杆操作构件起到经过规定期间的期间内,在通过所述速度判定部判定为所述动臂的上升速度成为减速的情况下,使向所述限制速度的速度变化延迟,
所述调整部在从操作所述斗杆操作构件起经过了规定期间之后,在通过所述速度判定部判定为所述动臂的上升速度成为减速的情况下,不使向所述限制速度的速度变化延迟。
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2014/074008 WO2015025987A1 (ja) | 2014-09-10 | 2014-09-10 | 作業車両 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104769189A true CN104769189A (zh) | 2015-07-08 |
CN104769189B CN104769189B (zh) | 2016-12-28 |
Family
ID=52483755
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201480001722.7A Active CN104769189B (zh) | 2014-09-10 | 2014-09-10 | 作业车辆 |
Country Status (6)
Country | Link |
---|---|
US (1) | US9371626B2 (zh) |
JP (1) | JP5732598B1 (zh) |
KR (1) | KR101687499B1 (zh) |
CN (1) | CN104769189B (zh) |
DE (1) | DE112014000147B4 (zh) |
WO (1) | WO2015025987A1 (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105518222A (zh) * | 2015-09-25 | 2016-04-20 | 株式会社小松制作所 | 作业机械的控制装置、作业机械以及作业机械的控制方法 |
CN105992850A (zh) * | 2016-03-17 | 2016-10-05 | 株式会社小松制作所 | 作业车辆的控制***、控制方法以及作业车辆 |
CN107306500A (zh) * | 2016-02-29 | 2017-10-31 | 株式会社小松制作所 | 作业机械的控制装置、作业机械以及作业机械的控制方法 |
CN110007620A (zh) * | 2018-01-05 | 2019-07-12 | 菜鸟智能物流控股有限公司 | 一种设备控制方法及装置 |
CN111771028A (zh) * | 2018-08-30 | 2020-10-13 | 日立建机株式会社 | 作业机械 |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
AU2012202213B2 (en) * | 2011-04-14 | 2014-11-27 | Joy Global Surface Mining Inc | Swing automation for rope shovel |
CN105899737B (zh) * | 2013-12-26 | 2018-06-01 | 斗山英维高株式会社 | 工程机械的主控阀的控制方法及控制装置 |
US20160201298A1 (en) * | 2015-01-08 | 2016-07-14 | Caterpillar Inc. | Systems and Methods for Constrained Dozing |
JP6707344B2 (ja) * | 2015-12-25 | 2020-06-10 | 株式会社小松製作所 | 作業車両および作業車両の制御方法 |
JP6732539B2 (ja) * | 2016-05-26 | 2020-07-29 | 日立建機株式会社 | 作業機械 |
US9976285B2 (en) * | 2016-07-27 | 2018-05-22 | Caterpillar Trimble Control Technologies Llc | Excavating implement heading control |
US11111646B2 (en) * | 2017-02-24 | 2021-09-07 | Cnh Industrial America Llc | System and method for controlling an arm of a work vehicle |
JP6872945B2 (ja) | 2017-03-27 | 2021-05-19 | 日立建機株式会社 | 建設機械 |
JP6901406B2 (ja) * | 2017-07-14 | 2021-07-14 | 株式会社小松製作所 | 作業機械および作業機械の制御方法 |
EP3882400A4 (en) * | 2018-11-14 | 2022-01-12 | Sumitomo Heavy Industries, Ltd. | SHOVEL AND DEVICE FOR CONTROLLING A SHOVEL |
JP6894464B2 (ja) * | 2019-04-22 | 2021-06-30 | 株式会社小松製作所 | 作業機械、作業機械の制御方法、施工管理装置および施工管理装置の制御方法 |
US11236492B1 (en) * | 2020-08-25 | 2022-02-01 | Built Robotics Inc. | Graphical user interface for real-time management of an earth shaping vehicle |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1835079A1 (en) * | 2006-03-17 | 2007-09-19 | Qinghua He | Electromechanically controlled excavator and method for controlling the electromechanically controlled excavator. |
JP2013217138A (ja) * | 2012-04-11 | 2013-10-24 | Komatsu Ltd | 油圧ショベルの掘削制御システム |
CN103374937A (zh) * | 2012-04-19 | 2013-10-30 | 华南理工大学 | 一种液压挖掘机回转力矩限制装置 |
WO2014061790A1 (ja) * | 2012-10-19 | 2014-04-24 | 株式会社小松製作所 | 油圧ショベルの掘削制御システム |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3112814B2 (ja) | 1995-08-11 | 2000-11-27 | 日立建機株式会社 | 建設機械の領域制限掘削制御装置 |
JPH09328774A (ja) | 1996-06-07 | 1997-12-22 | Hitachi Constr Mach Co Ltd | 油圧建設機械の自動軌跡制御装置 |
US6169948B1 (en) | 1996-06-26 | 2001-01-02 | Hitachi Construction Machinery Co., Ltd. | Front control system, area setting method and control panel for construction machine |
JP3306301B2 (ja) | 1996-06-26 | 2002-07-24 | 日立建機株式会社 | 建設機械のフロント制御装置 |
JPH1089110A (ja) | 1996-09-11 | 1998-04-07 | Yanmar Diesel Engine Co Ltd | 作業機の制御機構及び方法 |
KR100621976B1 (ko) * | 2002-04-24 | 2006-09-13 | 볼보 컨스트럭션 이키프먼트 홀딩 스웨덴 에이비 | 포지티브 제어방식의 붐 다운기능을 갖는 건설중장비 |
DE10256923B4 (de) * | 2002-12-05 | 2013-10-24 | Liebherr-France S.A. | Verfahren und Vorrichtung zur Bewegungsdämpfung von Hydraulikzylindern mobiler Arbeitsmaschinen |
US7441404B2 (en) | 2004-11-30 | 2008-10-28 | Caterpillar Inc. | Configurable hydraulic control system |
US8095281B2 (en) | 2008-12-11 | 2012-01-10 | Caterpillar Inc. | System for controlling a hydraulic system |
JP5548307B2 (ja) * | 2011-03-24 | 2014-07-16 | 株式会社小松製作所 | 掘削制御システム |
DE112012001013B4 (de) * | 2011-03-24 | 2019-01-03 | Komatsu Ltd. | Aushubsteuersystem und Baumaschine |
DE112012000540B4 (de) * | 2011-03-24 | 2019-01-31 | Komatsu Ltd. | Steuersystem für eine Arbeitseinheit, Baumaschine und Steuerverfahren für eine Arbeitseinheit |
US8577564B2 (en) * | 2011-12-22 | 2013-11-05 | Caterpillar Inc. | System and method for controlling movement along a three dimensional path |
-
2014
- 2014-09-10 DE DE112014000147.3T patent/DE112014000147B4/de active Active
- 2014-09-10 KR KR1020157000961A patent/KR101687499B1/ko active IP Right Grant
- 2014-09-10 WO PCT/JP2014/074008 patent/WO2015025987A1/ja active Application Filing
- 2014-09-10 JP JP2014546644A patent/JP5732598B1/ja active Active
- 2014-09-10 US US14/419,507 patent/US9371626B2/en active Active
- 2014-09-10 CN CN201480001722.7A patent/CN104769189B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1835079A1 (en) * | 2006-03-17 | 2007-09-19 | Qinghua He | Electromechanically controlled excavator and method for controlling the electromechanically controlled excavator. |
JP2013217138A (ja) * | 2012-04-11 | 2013-10-24 | Komatsu Ltd | 油圧ショベルの掘削制御システム |
CN103374937A (zh) * | 2012-04-19 | 2013-10-30 | 华南理工大学 | 一种液压挖掘机回转力矩限制装置 |
WO2014061790A1 (ja) * | 2012-10-19 | 2014-04-24 | 株式会社小松製作所 | 油圧ショベルの掘削制御システム |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105518222A (zh) * | 2015-09-25 | 2016-04-20 | 株式会社小松制作所 | 作业机械的控制装置、作业机械以及作业机械的控制方法 |
US9834905B2 (en) | 2015-09-25 | 2017-12-05 | Komatsu Ltd. | Work machine control device, work machine, and work machine control method |
CN105518222B (zh) * | 2015-09-25 | 2018-02-02 | 株式会社小松制作所 | 作业机械的控制装置、作业机械以及作业机械的控制方法 |
CN107306500A (zh) * | 2016-02-29 | 2017-10-31 | 株式会社小松制作所 | 作业机械的控制装置、作业机械以及作业机械的控制方法 |
CN107306500B (zh) * | 2016-02-29 | 2020-07-10 | 株式会社小松制作所 | 作业机械的控制装置、作业机械以及作业机械的控制方法 |
CN105992850A (zh) * | 2016-03-17 | 2016-10-05 | 株式会社小松制作所 | 作业车辆的控制***、控制方法以及作业车辆 |
CN105992850B (zh) * | 2016-03-17 | 2019-05-03 | 株式会社小松制作所 | 作业车辆的控制***、控制方法以及作业车辆 |
CN110007620A (zh) * | 2018-01-05 | 2019-07-12 | 菜鸟智能物流控股有限公司 | 一种设备控制方法及装置 |
CN110007620B (zh) * | 2018-01-05 | 2022-04-05 | 菜鸟智能物流控股有限公司 | 一种设备控制方法及装置 |
US11422533B2 (en) | 2018-01-05 | 2022-08-23 | Cainiao Smart Logistics Holding Limited | Equipment control method and device |
CN111771028A (zh) * | 2018-08-30 | 2020-10-13 | 日立建机株式会社 | 作业机械 |
CN111771028B (zh) * | 2018-08-30 | 2022-07-15 | 日立建机株式会社 | 作业机械 |
Also Published As
Publication number | Publication date |
---|---|
KR20160045038A (ko) | 2016-04-26 |
KR101687499B1 (ko) | 2016-12-19 |
JPWO2015025987A1 (ja) | 2017-03-02 |
DE112014000147B4 (de) | 2021-07-29 |
US9371626B2 (en) | 2016-06-21 |
CN104769189B (zh) | 2016-12-28 |
US20160069040A1 (en) | 2016-03-10 |
DE112014000147T5 (de) | 2015-07-16 |
JP5732598B1 (ja) | 2015-06-10 |
WO2015025987A1 (ja) | 2015-02-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104769189A (zh) | 作业车辆 | |
CN104541001B (zh) | 作业车辆 | |
CN104619922A (zh) | 作业车辆 | |
CN104619921A (zh) | 作业车辆及作业车辆的控制方法 | |
KR101658325B1 (ko) | 작업 차량 | |
CN105008623B (zh) | 建筑机械的控制***、建筑机械及建筑机械的控制方法 | |
CN103890273B (zh) | 建筑机械的控制***及控制方法 | |
CN105102726B (zh) | 建筑机械的控制***、建筑机械及建筑机械的控制方法 | |
US20170121930A1 (en) | Construction machine control system, construction machine, and method of controlling construction machine | |
CN104641046B (zh) | 液压挖掘机 | |
KR20190112057A (ko) | 건설 기계 | |
CN111771027A (zh) | 作业机械 | |
KR102065478B1 (ko) | 건설 기계 및 제어 방법 | |
US11821163B2 (en) | Shovel | |
KR101584946B1 (ko) | 작업 차량 | |
JP5756576B2 (ja) | 油圧ショベル |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
EXSB | Decision made by sipo to initiate substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |