CN104246081B - 挖土机的控制方法及控制装置 - Google Patents
挖土机的控制方法及控制装置 Download PDFInfo
- Publication number
- CN104246081B CN104246081B CN201380021230.XA CN201380021230A CN104246081B CN 104246081 B CN104246081 B CN 104246081B CN 201380021230 A CN201380021230 A CN 201380021230A CN 104246081 B CN104246081 B CN 104246081B
- Authority
- CN
- China
- Prior art keywords
- control
- swing arm
- slope
- dipper
- control stick
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Classifications
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
- 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/436—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like for keeping the dipper in the horizontal position, e.g. self-levelling
-
- 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/2004—Control mechanisms, e.g. control levers
- E02F9/2012—Setting the functions of the control levers, e.g. changing assigned functions among operations levers, setting functions dependent on the operator or seat orientation
-
- 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/2058—Electric or electro-mechanical or mechanical control devices of vehicle sub-units
- E02F9/2062—Control of propulsion units
- E02F9/2075—Control of propulsion units of the hybrid type
-
- 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/2285—Pilot-operated systems
-
- 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
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)
- Component Parts Of Construction Machinery (AREA)
Abstract
本发明提供一种挖土机的控制方法及控制装置。本发明的实施例所涉及的挖土机的控制方法,通过向前后方向操作操纵杆(26B),维持铲斗(6)的高度的同时执行铲斗(6)的X方向移动控制(平面位置控制),或者通过向前后方向操作操纵杆(26A),维持铲斗(6)的平面位置的同时执行铲斗(6)的Z方向移动控制即高度控制。
Description
技术领域
本发明涉及一种挖土机的控制方法及控制装置,更详细而言,涉及一种进行地面平整作业、斜坡整形作业等时的挖土机的控制方法及控制装置。
背景技术
以往,已知有可轻松进行地面平整作业的液压挖土机的挖掘轨迹控制装置(例如,参考专利文献1)。
该挖掘轨迹控制装置中,设定沿液压挖土机的前置附属装置的延伸方向水平延伸的作业允许区域,当斗杆前端销的轴心位置位于作业允许区域内时,允许斗杆及动臂的动作。另一方面,该挖掘轨迹控制装置中,在作业允许区域周围设定作业抑制区域,当斗杆前端销的轴心位置侵入作业抑制区域内时,禁止拉起斗杆、提升动臂及下降动臂中的任何动作。
由此,该挖掘轨迹控制装置使操作者可轻松进行沿着前置附属装置的延伸方向的直线式作业或地面平整作业。
现有技术文献
专利文献
专利文献1:日本特开平8-277543号公报
发明概要
发明要解决的技术课题
然而,在搭载专利文献1中记载的挖掘轨迹控制装置的液压挖土机中,操作者在移动斗杆及动臂时使用与各自相对应的单个操作杆。因此,操作者在直线式作业或地面平整作业中移动铲斗时需同时操作2个操作杆。因此,对于液压挖土机的操作不熟练的操作者而言,直线式作业或地面平整作业依然是较困难的作业,并不能说对于这种操作者的支援是充分的。
本发明是鉴于上述课题而完成的,其目的在于提供一种使得能够更轻松地操作前置附属装置的挖土机的控制方法及控制装置。
用于解决技术课题的手段
为了实现上述目的,本发明的实施例所涉及的挖土机的控制方法中,通过一个操纵杆的操作,维持端部附属装置的高度的同时执行该端部附属装置的平面位置控制,或者维持所述端部附属装置的平面位置的同时执行所述端部附属装置的高度控制。
并且,本发明的实施例所涉及的挖土机的控制装置中,通过一个操纵杆的操作,维持端部附属装置的高度的同时执行该端部附属装置的平面位置控制,或者维持所述端部附属装置的平面位置的同时执行所述端部附属装置的高度控制。
发明效果
根据上述方法,本发明能够提供一种使得能够更轻松地操作前置附属装置的挖土机的控制方法及控制装置。
附图说明
图1是表示执行本发明的实施例所涉及控制方法的液压挖土机的侧视图。
图2是表示液压式挖土机的驱动系统的结构例的框图。
图3是本发明的实施例所涉及的控制方法中使用的三维直角坐标系的说明图。
图4是对XZ平面中的前置附属装置的动作进行说明的图。
图5是驾驶室内的驾驶席的俯视立体图。
图6是表示自动平整模式中进行了操纵杆操作时的处理流程的流程图。
图7是表示X方向移动控制的流程的框图(之一)。
图8是表示X方向移动控制的流程的框图(之二)。
图9是表示Z方向移动控制的流程的框图(之一)。
图10是表示Z方向移动控制的流程的框图(之二)。
图11是表示执行本发明的实施例所涉及的控制方法的混合式挖土机的驱动系统的结构例的框图。
图12是表示混合式挖土机的蓄电系统的结构例的框图。
图13是表示执行本发明的实施例所涉及的控制方法的混合式挖土机的驱动系统的其他结构例的框图。
图14是斜坡整形模式中使用的坐标系的说明图(之一)。
图15是斜坡整形模式中使用的坐标系的说明图(之二)。
图16是对斜坡整形模式中的前置附属装置的动作进行说明的图。
具体实施方式
图1是表示执行本发明的实施例所涉及的控制方法的液压式挖土机的侧视图。
在液压式挖土机的下部行走体1上经由回转机构2搭载有上部回转体3。上部回转体3上安装有作为操作体的动臂4。在动臂4的前端安装有作为操作体的斗杆5,在斗杆5的前端安装有作为操作体的端部附属装置即铲斗6。动臂4、斗杆5及铲斗6构成前置附属装置,分别由动臂缸7、斗杆缸8及铲斗缸9液压驱动。上部回转体3上设置驾驶室10,且搭载有引擎等动力源。
图2是表示图1的液压式挖土机的驱动系统的结构例的框图。图2中,分别以双重线表示机械动力系统,以粗实线表示高压液压管路,以虚线表示先导管路,以细实线表示电力驱动/控制系统。
在作为机械式驱动部的引擎11的输出轴上,作为液压泵连接有主泵14及先导泵15。主泵14上经由高压液压管路16连接有控制阀17。并且,主泵14为通过调节器14A控制泵的每一次旋转的吐出流量的可变容量型液压泵。
控制阀17为进行液压式挖土机中的液压系统的控制的液压控制装置。下部行走体1用液压马达1A(右用)及1B(左用)、动臂缸7、斗杆缸8及铲斗缸9经由高压液压管路连接于控制阀17。并且,先导泵15上经由先导管路25连接有操作装置26。
操作装置26包括操纵杆26A、操纵杆26B及踏板26C。操纵杆26A、操纵杆26B及踏板26C经由液压管路27及28分别连接于控制阀17及压力传感器29。压力传感器29连接于进行电力系统的驱动控制的控制器30。
另外,本实施例中用于检测各操作体的姿势的姿势传感器安装于各操作体。具体而言,用于检测动臂4的倾斜角度的动臂角度传感器4S安装于动臂4的支承轴上。并且,用于检测斗杆5的开闭角度的斗杆角度传感器5S安装于斗杆5的支承轴上,用于检测铲斗6的开闭角度的铲斗角度传感器6S安装于铲斗6的支承轴上。动臂角度传感器4S将检测出的动臂角度提供至控制器30。并且,斗杆角度传感器5S将检测出的斗杆角度提供至控制器30,铲斗角度传感器6S将检测出的铲斗角度提供至控制器30。
控制器30为作为进行液压式挖土机的驱动控制的主控制部的挖土机控制装置。控制器30由包含CPU(Central Processing Unit)及内部存储器的运算处理装置构成,是通过CPU执行存储于内部存储器的驱动控制用程序来实现的装置。
接着,参考图3对本发明的实施例所涉及的控制方法中使用的三维直角坐标系进行说明。另外,图3的F3A为液压式挖土机的侧视图,图3的F3B为液压式挖土机的俯视图。
如F3A及F3B所示,三维直角坐标系的Z轴相当于液压式挖土机的回转轴PC,三维直角坐标系的原点O相当于回转轴PC与液压式挖土机的设置面的交点。
并且,与Z轴正交的X轴沿前置附属装置的延伸方向延伸,同样与Z轴正交的Y轴沿与前置附属装置的延伸方向垂直的方向延伸。即,X轴及Y轴与液压式挖土机的回转一同绕Z轴旋转。另外,液压式挖土机的回转角度θ在如F3B所示的俯视观察时相对于X轴将逆时针反向作为正向。
并且,如F3A所示,动臂4相对于上部回转体3的安装位置以作为动臂旋转轴的动臂销的位置即动臂销位置P1表示。同样地,斗杆5相对于动臂4的安装位置以作为斗杆旋转轴的斗杆销的位置即斗杆销位置P2表示。并且,铲斗6相对于斗杆5的安装位置以作为铲斗旋转轴的铲斗销的位置即铲斗销位置P3表示。而且,铲斗6的前端位置以铲斗前端位置P4表示。
并且,连结动臂销位置P1与斗杆销位置P2的线段SG1的长度作为动臂长度以规定值L1表示,连结斗杆销位置P2与铲斗销位置P3的线段SG2的长度作为斗杆长度以规定值L2表示,连结铲斗销位置P3与铲斗前端位置P4的线段SG3的长度作为铲斗长度以规定值L3表示。
并且,形成于线段SG1与水平面之间的角度以地面角β1表示,形成于线段SG2与水平面之间的角度以地面角β2表示,形成于线段SG3与水平面之间的角度以地面角β3表示。另外,以下,还将地面角β1、β2、β3分别称为动臂旋转角度、斗杆旋转角度、铲斗旋转角度。
其中,若将动臂销位置P1的三维坐标设为(X、Y、Z)=(H0X、0、H0Z),将铲斗前端位置P4的三维坐标设为(X、Y、Z)=(Xe、Ye、Ze),则Xe、Ze分别以公式(1)及公式(2)表示。另外,Xe及Ye表示端部附属装置的平面位置,Ze表示端部附属装置的高度。
Xe=H0X+L1cosβ1+L2cosβ2+L3cosβ3……(1)
Ze=H0Z+L1sinβ1+L2sinβ2+L3sinβ3……(2)
另外,Ye成为0。这是因为铲斗前端位置P4存在于XZ平面上。
并且,由于动臂销位置P1的坐标值为固定值,因此只要确定地面角β1、β2及β3,则可单值确定铲斗前端位置P4的坐标值。同样地,只要确定地面角β1,则可单值确定斗杆销位置P2的坐标值,只要确定地面角β1及β2,则可单值确定铲斗销位置P3的坐标的值。
接着,参考图4对动臂角度传感器4S、斗杆角度传感器5S及铲斗角度传感器6S各自的输出与动臂旋转角度β1、斗杆旋转角度β2及铲斗旋转角度β3之间的关系进行说明。另外,图4是对XZ平面中的前置附属装置的动作进行说明的图。
如图4所示,动臂角度传感器4S设置于动臂销位置P1,斗杆角度传感器5S设置于斗杆销位置P2,铲斗角度传感器6S设置于铲斗销位置P3。
并且,动臂角度传感器4S检测并输出形成于线段SG1与垂直线之间的角度α1。斗杆角度传感器5S检测并输出形成于线段SG1的延长线与线段SG2之间的角度α2。铲斗角度传感器6S检测并输出形成于线段SG2的延长线与线段SG3之间的角度α3。另外,图4中,角度α1相对于线段SG1将逆时针方向作为正向。同样地,角度α2相对于线段SG2将逆时针方向作为正向,角度α3相对于线段SG3将逆时针方向作为正向。并且,图4中,动臂旋转角度β1、斗杆旋转角度β2、铲斗旋转角度β3相对于与X轴平行线将逆时针方向作为正向。
从以上的关系,动臂旋转角度β1、斗杆旋转角度β2、铲斗旋转角度β3利用角度α1、α2、α3分别以公式(3)、公式(4)、公式(5)表示。
β1=90-α1……(3)
β2=β1-α2=90-α1-α2……(4)
β3=β2-α3=90-α1-α2-α3……(5)
另外,如上述,β1、β2、β3作为动臂4、斗杆5、铲斗6相对于水平面的倾斜来表示。
由此,若使用公式(1)~公式(5),只要确定角度α1、α2、α3,则可单值确定动臂旋转角度β1、斗杆旋转角度β2、铲斗旋转角度β3,且可单值确定铲斗前端位置P4的坐标值。同样地,只要确定角度α1,则可单值确定动臂旋转角度β1及斗杆销位置P2的坐标值,只要确定角度α1、α2,则可单值确定斗杆旋转角度β2及铲斗销位置P3的坐标值。
另外,动臂角度传感器4S、斗杆角度传感器5S、铲斗角度传感器6S可直接检测动臂旋转角度β1、斗杆旋转角度β2、铲斗旋转角度β3。此时,能够省略公式(3)~公式(5)的运算。
接着,参考图5对本发明的实施例所涉及的挖土机的控制方法中使用的操作装置26进行说明。另外,图5是驾驶室10内的驾驶席的俯视立体图,表示在驾驶席的左侧前方配置有操纵杆26A并在驾驶席的右侧前方配置有操纵杆26B的状态。并且,图5的F5A表示通常模式时的操纵杆设定,图5的F5B表示自动平整模式时的操纵杆设定。
具体而言,F5A的通常模式中,若向前方倾倒操纵杆26A则斗杆5打开,若向后方倾倒操纵杆26A则斗杆5关闭。并且,若向左侧倾倒操纵杆26A则上部回转体3在俯视观察时向逆时针方向左回转,若向右侧倾倒操纵杆26A则上部回转体3在俯视观察时向顺时针方向右回转。并且,若向前方倾倒操纵杆26B则动臂4下降,若向后方倾倒操纵杆26B则动臂4上升。并且,若向左侧倾倒操纵杆26B则铲斗6关闭,若向右侧倾倒操纵杆26B则铲斗6打开。
另一方面,F5B的自动平整模式中,若向前方倾倒操纵杆26A,则动臂4及斗杆5中的至少一个进行动作,以便使铲斗前端位置P4的X坐标及Y坐标的值不变的同时使Z坐标的值减少。另外,也可以是铲斗6移动。并且,若向后方倾倒操纵杆26A,则动臂4及铲斗5中的至少一个移动,以便使铲斗前端位置P4的X坐标及Y坐标的值不变的同时使Z坐标的值增大。另外,也可以是铲斗6移动。以下,将操纵杆26A向前后方向的操作,即将根据作为端部附属装置的铲斗6的Z方向操作而执行的控制作为“Z方向移动控制”或“高度控制”。另外,操纵杆26A向左右方向的操作与通常模式时相同。
并且,在F5B的自动平整模式中,若向前方倾倒操纵杆26B,则动臂4及斗杆5中的至少一个进行动作,以便使铲斗前端位置P4的Y坐标及Z坐标的值不变的同时使X坐标的值增大。另外,也可以是铲斗6移动。并且,若向后方倾倒操纵杆26B,则动臂4及斗杆5中的至少一个进行动作,以便使铲斗前端位置P4的Y坐标及Z坐标的值不变的同时使X坐标的值减少。另外,也可以是铲斗6移动。以下,将操纵杆26B向前后方向的操作,即将根据作为端部附属装置的铲斗6的X方向操作执行的控制作为“X方向移动控制”或“平面位置控制”。
并且,在F5B的自动平整模式中,若向左侧倾倒操纵杆26B,则铲斗旋转角度β3增大,若向右侧倾倒操纵杆26B,则铲斗旋转角度β3减少。即,若向左侧倾倒操纵杆26B,则铲斗6关闭,若向右侧倾倒操纵杆26B,则铲斗6打开。如此,通过操纵杆26B向左右方向的操作而带来的铲斗6的动作与通常模式时相同。然而,不同点在于,在通常模式中通过向铲斗缸9供给与操纵杆操作量对应的流量的工作油来移动铲斗6,而在自动平整模式中通过确定与操纵杆操作量对应的铲斗旋转角度β3的目标值来移动铲斗6。另外,自动平整模式中的控制的详细内容将进行后述。
如6是表示自动平整模式中进行操纵杆操作时的处理流程的流程图。
首先,控制器30判断在设置于驾驶室10内的驾驶席附近的模式切换开关中是否已选择自动平整模式(步骤S1)。
判断为已选择自动平整模式时(步骤S1的是),控制器30检测操纵杆操作量(步骤S2)。
具体而言,控制器30例如根据压力传感器29的输出检测操纵杆26A、26B的操作量。
之后,控制器30判断是否已进行X方向操作(步骤S3)。具体而言,控制器30判断是否已进行操纵杆26B向前后方向的操作。
当判断为已进行X方向操作时(步骤S3的是),控制器30执行X方向移动控制(平面位置控制)(步骤S4)。
判断为未进行X方向操作时(步骤S3的否),控制器30判断是否已进行Z方向操作(步骤S5)。具体而言,控制器30判断是否已进行操纵杆26A向前后方向的操作。
判断为已进行Z方向操作时(步骤S5的是),控制器30执行Z方向移动控制(高度控制)(步骤S6)。
判断为未进行Z方向操作时(步骤S5的否),控制器30判断是否已进行θ方向操作(步骤S7)。具体而言,控制器30判断是否已进行操纵杆26A向左右方向的操作。
判断为已进行θ方向操作时(步骤S7的是),控制器30执行回转动作(步骤S8)。
判断为未进行θ方向操作时(步骤S7的否),控制器30判断是否已进行β3方向操作(步骤S9)。具体而言,控制器30判断是否已进行操纵杆26B向左右方向的操作。
判断为已进行β3方向操作时(步骤S9的是),控制器30执行铲斗开闭动作(步骤S10)。
另外,图6所示的控制流程为执行X方向操作、Z方向操作、θ方向操作及β3方向操作中的一个的单独操作的情况,但也可同样适用于同时执行4个操作中的多个操作的复合操作的情况。例如,可同时执行X方向移动控制、Z方向移动控制、回转动作及铲斗开闭动作中的多个控制。
接着,参考图7及图8,对X方向移动控制(平面位置控制)的详细内容进行说明。另外,图7及图8是表示X方向移动控制的流程的框图。
若以操纵杆26B进行X方向操作,则如图7所示,控制器30根据操纵杆26B的X方向操作,对铲斗前端位置P4的X轴方向上的位移进行开放式控制。具体而言,控制器30例如生成指令值Xer作为铲斗前端位置P4的移动后的X坐标的值。更具体而言,控制器30利用X方向指令值生成部CX生成与操纵杆26B的操纵杆操作量Lx相应的X方向指令值Xer。X方向指令值生成部CX例如使用预先登记的图表等,从操纵杆操作量Lx导出X方向指令值Xer。并且,X方向指令值生成部CX例如以如下方式生成值Xer,即操纵杆26B的操作量越大,铲斗前端位置P4的移动前的X坐标的值Xe与移动后的X坐标的值Xer之差ΔXe变得越大。另外,控制器30还可以以如下方式生成值Xer,即与操纵杆26B的操作量无关地使ΔXe成为恒定。并且,铲斗前端位置P4的Y坐标及Z坐标的值在移动前后不变。
之后,控制器30根据所生成的指令值Xer生成动臂旋转角度β1、斗杆旋转角度β2及铲斗旋转角度β3各自的指令值β1r、β2r、β3r。
具体而言,控制器30利用上述公式(1)及公式(2)生成指令值β1r、β2r、β3r。如公式(1)及公式(2)所示,铲斗前端位置P4的X坐标及Z坐标的值Xe、Ze为动臂旋转角度β1、斗杆旋转角度β2及铲斗旋转角度β3的函数。并且,对铲斗前端位置P4的移动后的Z坐标的值Zer直接使用当前值。因此,若将铲斗旋转角度β3的指令值β3r直接设为当前值,则对公式(1)的Xe代入所生成的指令值Xer,对β3直接代入当前值。并且,对公式(2)的Ze直接代入当前值,对β3也直接代入当前值。其结果,通过解包含2个未知数β1、β2的公式(1)及公式(2)的联立方程式,导出动臂旋转角度β1及斗杆旋转角度β2的值。控制器30将这些导出的值作为指令值β1r、β2r。
之后,如图8所示,控制器30以动臂旋转角度β1、斗杆旋转角度β2及铲斗旋转角度β3各自的值成为所生成的指令值β1r、β2r、β3r的方式使动臂4、斗杆5及铲斗6工作。另外,控制器30可利用公式(3)~公式(5)导出与指令值β1r、β2r、β3r对应的指令值α1r、α2r、α3r。并且,控制器30可以以动臂角度传感器4S、斗杆角度传感器5S、铲斗角度传感器6S的输出即角度α1、α2、α3成为所导出的指令值α1r、α2r、α3r的方式使动臂4、斗杆5及铲斗6工作。
具体而言,控制器30生成和动臂旋转角度β1的当前值与指令值β1r之差Δβ1对应的动臂缸先导压指令。并且,对动臂电磁比例阀输出与动臂缸先导压指令对应的控制电流。动臂电磁比例阀在自动平整模式中,对动臂控制阀输出与和动臂缸先导压指令对应的控制电流相应的先导压。另外,动臂电磁比例阀在通常模式中,对动臂控制阀输出与操纵杆26B向前后方向的操作量相应的先导压。
之后,接收了来自动臂电磁比例阀的先导压的动臂控制阀以与先导压对应的流动方向及流量向动臂缸7供给由主泵14吐出的工作油。动臂缸7通过经由动臂控制阀供给的工作油伸缩。动臂角度传感器4S检测通过伸缩的动臂缸7动作的动臂4的角度α1。
之后,控制器30将动臂角度传感器4S检测出的角度α1代入到公式(3)来计算动臂旋转角度β1。并且,反馈计算出的值作为生成动臂缸先导压指令时使用的动臂旋转角度β1的当前值。
另外,上述说明与基于指令值β1r的动臂4的动作有关,但是能够同样适用于基于指令值β2r的斗杆5的动作及基于指令值β3r的铲斗6的动作。因此,对基于指令值β2r的斗杆5的动作及基于指令值β3r的铲斗6的动作的流程,省略其说明。
并且,如图7所示,控制器30使用泵吐出量导出部CP1、CP2、CP3从指令值β1r、β2r、β3r导出泵吐出量。本实施例中,泵吐出量导出部CP1、CP2、CP3利用预先登记的图表等,从指令值β1r、β2r、β3r导出泵吐出量。对由泵吐出量导出部CP1、CP2、CP3导出的泵吐出量进行总计,并作为总计泵吐出量输入至泵流量运算部。泵流量运算部根据所输入的总计泵吐出量控制主泵14的吐出量。本实施例中,泵流量运算部通过根据总计泵吐出量变更主泵14的斜板偏转角来控制主泵14的吐出量。
其结果,控制部30能够通过执行动臂控制阀、斗杆控制阀、铲斗控制阀的开口控制及主泵14的吐出量的控制,对动臂缸7、斗杆缸8及铲斗缸9分配适当量的工作油。
如此,控制器30将指令值Xer的生成、指令值β1r、β2r及β3r的生成、主泵14的吐出量的控制以及基于角度传感器4S、5S、6S的输出的操作体4、5、6的反馈控制作为1个控制循环,并通过反复该控制循环来进行铲斗前端位置P4的X方向移动控制。
并且,上述说明中,作为铲斗旋转角度β3的指令值β3r,直接使用铲斗旋转角度β3的当前值。然而,可将根据斗杆旋转角度β2的值单值确定的值,例如在斗杆旋转角度β2的值加上固定值的值用作铲斗旋转角度β3的指令值β3r。
并且,X方向移动控制中,使铲斗前端位置P4的Y坐标及Z坐标固定的同时对铲斗前端位置P4的X坐标的位移进行开放式控制。然而,也可使铲斗销位置P3的Y坐标及Z坐标固定的同时对铲斗销位置P3的X坐标的位移进行开放式控制。此时,省略指令值β3r的生成及铲斗6的控制。
接着,参考图9及图10,对Z方向移动控制(高度控制)的详细内容进行说明。另外,图9及图10是表示Z方向移动控制流程的框图。
若以操纵杆26A进行Z方向操作,则如图9所示,控制器30根据操纵杆26A的Z方向操作对铲斗前端位置P4在Z轴方向上的位移进行开放式控制。具体而言,控制器30例如生成指令值Zer作为铲斗前端位置P4的移动后的Z坐标的值。更具体而言,控制器30利用Z方向指令值生成部CZ生成与操纵杆26A的操作量Lz相应的Z方向指令值Zer。Z方向指令值生成部CZ例如利用预先登记的图表等,从操纵杆操作量Lz导出Z方向指令值Zer。并且,Z方向指令值生成部CZ例如以如下方式生成值Zer,即操纵杆26A的操作量越大,使铲斗前端位置P4的移动前的Z坐标的值Ze与移动后的Z坐标的值Zer之差ΔZe变得越大。另外,控制器30可以以如下方式生成值Zer,即与操纵杆26A的操作量无关地使ΔZe成为恒定。并且,铲斗前端位置P4的X坐标及Y坐标的值在移动前后不变。
之后,控制器30根据所生成的指令值Zer生成动臂旋转角度β1、斗杆旋转角度β2及铲斗旋转角度β3各自的指令值β1r、β2r、β3r。
具体而言,控制器30利用上述公式(1)及公式(2)生成指令值β1r、β2r、β3r。如公式(1)及公式(2)所示,铲斗前端位置P4的X坐标及Z坐标的值Xe、Ze为动臂旋转角度β1、斗杆旋转角度β2及铲斗旋转角度β3的函数。并且,对铲斗前端位置P4的移动后的X坐标的值Xer直接使用当前值。因此,若将铲斗旋转角度β3的指令值β3r直接设为当前值,则对公式(1)的Xe直接代入当前值,对β3也直接代入当前值。并且,对公式(2)的Ze代入所生成的指令值Zer,对β3直接代入当前值。其结果,通过解包含2个未知数β1、β2的公式(1)及公式(2)的联立方程式,导出动臂旋转角度β1及斗杆旋转角度β2的值。控制器30将这些导出的值作为指令值β1r、β2r。
之后,如图10所示,控制器30以动臂旋转角度β1、斗杆旋转角度β2及铲斗旋转角度β3各自的值成为所生成的指令值β1r、β2r、β3r的方式,使动臂4、斗杆5及铲斗6动作。另外,对于动臂4、斗杆5及铲斗6的动作及主泵14的吐出量的控制,能够直接适用在X方向移动控制中说明的内容,因此在此省略其说明。
如此,控制器30将指令值Zer的生成、指令值β1r、β2r及β3r的生成、主泵14的吐出量的控制以及基于角度传感器4S、5S、6S的输出的操作体4、5、6的反馈控制作为1个控制循环,并通过反复该控制循环来进行铲斗前端位置P4的Z方向移动控制。
并且,上述说明中,作为铲斗旋转角度β3的指令值β3r,直接使用铲斗旋转角度β3的当前值。然而,可将根据斗杆旋转角度β2的值单值确定的值,例如在斗杆旋转角度β2的值加上固定值的值用作铲斗旋转角度β3的指令值β3r。
并且,Z方向移动控制中,使铲斗前端位置P4的X坐标及Y坐标固定的同时对铲斗前端位置P4的Z坐标的位移进行开放式控制。然而,也可使铲斗销位置P3的X坐标及Y坐标固定的同时对铲斗销位置P3的Z坐标的位移进行开放式控制。此时,省略指令值β3r的生成及铲斗6的控制。
如以上说明,本发明的实施例所涉及的挖土机的控制方法将操纵杆的操作量用于铲斗前端位置P4的位置控制上,而不是动臂缸7、斗杆缸8及铲斗缸9各自的伸缩控制。因此,本控制方法能够通过一个操纵杆的操作实现维持铲斗旋转角度β3以及铲斗前端位置P4的X坐标及Y坐标的值的同时使Z坐标的值增减的动作。并且,能够通过一个操纵杆的操作实现维持铲斗旋转角度β3以及铲斗前端位置P4的Y坐标及Z坐标的值的同时使X坐标的值增减的动作
并且,本控制方法还能够将端部附属装置的平面位置与端部附属装置的高度作为铲斗销位置P3,并将操纵杆操作量用于铲斗销位置P3的位置控制。此时,本控制方法能够通过一个操纵杆的操作实现维持铲斗销位置P3的X坐标及Y坐标的值的同时使Z坐标的值增减的动作。并且,能够通过一个操纵杆的操作实现维持铲斗销位置P3的Y坐标及Z坐标的值的同时使X坐标的值增减的动作。此时,若将铲斗销位置P3的三维坐标设为(X、Y、Z)=(XP3+YP3+ZP3),则XP3、ZP3分别以公式(6)及公式(7)表示。
XP3=H0X+L1cosβ1+L2cosβ2……(6)
ZP3=H0Z+L1sinβ1+L2sinβ2……(7)
另外,YP3成为0。这是因为铲斗销位置P3存在于XZ平面上。
另外,此时,在X方向移动控制中不会从指令值Xer生成指令值β3r,在Z方向移动控制中不会从指令值Zer生成指令值β3r。
接着,参考图11对执行本发明的实施例所涉及的控制方法的混合式挖土机进行说明。另外,图11是表示混合式挖土机的驱动系统的结构例的框图。图11中,以双重线表示机械动力系统,以粗实线表示高压液压管路,以虚线表示先导管路,以细实线表示电力驱动/控制系统。并且,图11的驱动系统中,具备电动发电机12、变速器13、逆变器18及蓄电系统120,并代替回转用液压马达21B而具备由逆变器20、回转用电动机21、分解器22、机械制动器23及回转减速器24构成的负载驱动系统,在这两点上与图2的驱动系统不同。但是,其他点上与图2的驱动系统共同。因此,省略共同点的说明,对不同点进行详细说明。
图11中,作为机械式驱动部的引擎11及作为还进行发电的辅助驱动部的电动发电机12分别连接于变速器13的2个输入轴。变速器13的输出轴上连接有作为液压泵的主泵14及先导泵15。
电动发电机12上经由逆变器18连接有包含作为蓄电器的电容器的蓄电系统(蓄电装置)120。
蓄电系统120配置于逆变器18与逆变器20之间。由此,在电动发电机12及回转用电动机21中的至少一个进行动力运行时,蓄电系统120供给动力运行所需的电力,并且在至少一个进行发电运行时,蓄电系统120将通过发电运行产生的电力作为电能来蓄积。
图12是表示蓄电系统120的结构例的框图。蓄电系统120包含作为蓄电器的电容器19、升降压转换器100及DC母线110。作为第2蓄电器的DC母线110控制作为第1蓄电器的电容器19与电动发电机12与回转用电动机21之间的电力授受。电容器19上设置有用于检测电容器电压值的电容器电压检测部112及用于检测电容器电流值的电容器电流检测部113。通过电容器电压检测部112及电容器电流检测部113检测的电容器电压值及电容器电流值供给至控制器30。并且,上述中作为蓄电器的例子示出了电容器19,但是可代替电容器19使用锂离子电池等能够充电的二次电池、锂离子电容器或能够进行电力授受的其他形式的电源作为蓄电器。
升降压转换器100根据电动发电机12及回转用电动机21的运行状态进行切换升压动作与降压动作的控制,以使DC母线电压值落在一定范围内。DC母线110配设于逆变器18、20与升降压转换器100之间,进行电容器19、电动发电机12、回转用电动机21之间的电力授受。
回到图11,逆变器20设置于回转用电动机21与蓄电系统120之间,根据来自控制器30的指令,对回转用电动机21进行运行控制。由此,逆变器20在回转用电动机21进行动力运行时从蓄电系统120向回转用电动机21供给所需电力。并且,在回转用电动机21进行发电运行时,将通过回转用电动机21发电的电力蓄电于蓄电系统120的电容器19。
回转用电动机21为能够进行动力运行及发电运行两者的电动机即可,其为了驱动上部回转体3的回转机构2而设置。动力运行时,通过减速器24放大回转用电动机21的旋转驱动力,上部回转体3被加减速控制而进行旋转运动。并且,发电运行时,上部回转体3的惯性旋转通过减速器24增加转速并传递至回转用电动机21,从而能够产生再生电力。其中,回转用电动机21为根据PWM(Pulse Width Modulation)控制信号通过逆变器20交流驱动的电动机。回转用电动机21例如能够由磁铁埋入型IPM马达构成。由此,能够产生更大的感应电动势,因此能够增大再生时通过回转用电动机21发电的电力。
另外,蓄电系统120的电容器19的充放电控制根据电容器19的充电状态、电动发电机12的运行状态(动力运行或发电运行)、回转用电动机21的运行状态(动力运行或再生运行),通过控制器30进行。
分解器22为检测回转用电动机21的旋转轴21A的旋转位置及旋转角度的传感器。具体而言,分解器22通过检测回转用电动机21的旋转前的旋转轴21A的旋转位置与左旋转或右旋转后的旋转位置之差,从而检测旋转轴21A的旋转角度及旋转方向。通过检测回转用电动机21的旋转轴21A的旋转角度及旋转方向,导出回转机构2的旋转角度及旋转方向。
机械制动器23为产生机械制动力的制动装置,机械地停止回转用电动机21的旋转轴21A。该机械制动器23通过电磁式开关切换制动/解除。该切换通过控制器30进行。
回转变速器24为对回转用电动机21的旋转轴21A的旋转进行减速并机械地传递至回转机构2的变速器。由此,动力运行时,能够对回转用电动机21的旋转力进行增力,从而向上部回转体3传递更大的旋转力。与此相反,再生运行时,能够对在上部回转体3中产生的旋转进行加速并机械地传递至回转用电动机21。
回转机构2能够在解除回转用电动机21的机械制动器23的状态下回转,由此,上部回转体3向左方向或右方向回转。
控制器30进行电动发电机12的运行控制(电动辅助运行或发电运行的切换),并且进行通过驱动控制作为升降压控制部的升降压转换器100实现的电容器19的充放电控制。控制器30根据电容器19的充电状态、电动发电机12的运行状态(电动辅助运行或发电运行)及回转用电动机21的运行状态(动力运行或再生运行),进行升降压转换器100的升压动作与降压动作的切换控制,由此进行电容器19的充放电控制。并且,控制器30还进行充电至电容器19的量(充电电流或充电电力)的控制。
根据通过DC母线电压检测部111检测的DC母线电压值、通过电容器电压检测部112检测的电容器电压值及通过电容器电流检测部113检测的电容器电流值,进行该升降压转换器100的升压动作与降压动作的切换控制。
由作为辅助马达的电动发电机12发电的电力经由逆变器18供给至蓄电系统120的DC母线110,并经由升降压转换器100供给至电容器19。并且,回转用电动机21进行再生运行而生成的再生电力经由逆变器20供给至蓄电系统120的DC母线110,并经由升降压转换器100供给至电容器19。
接着,参考图13,对执行本发明的实施例所涉及的控制方法的混合式挖土机的其他例子进行说明。另外,图13是表示混合式挖土机的驱动系统的结构例的框图。图13中,以双重线表示机械动力系统,以粗实线表示高压液压管路,以虚线表示先导管路,以细实现表示电力驱动/控制系统。并且,图13的驱动系统中,代替引擎11及电动发电机12的2个输出轴经由变速器13连接于主泵14的结构(并联方式),采用经由逆变器18A电驱动的泵用电动机400的输出轴连接于主泵14的结构(串联方式),在这一点上与图11的驱动系统不同。但是,其他点上与图11的驱动系统共同。
本发明的实施例所涉及控制方法还能够适用于具有如以上的结构的混合式挖土机中。
接着,参考图14,对自动平整模式的一例即斜坡整形模式进行说明。另外,图14是斜坡整形模式中使用的坐标系的说明图,对应于图3的F3A。并且,斜坡整形模式时的操纵杆设定与图5的F5B所示的自动平整模式时的操纵杆设定相同。并且,图14中,使用包含与斜坡平行的U轴、与斜坡垂直的W轴的UVW三维直角坐标系,这一点与使用包含与水平面平行的X轴、与水平面垂直的Z轴的XYZ三维直角坐标系的图3的F3A不同,但是在其他点上共同。另外,斜坡角度γ1可在执行斜坡整形模式之前通过操作者经由斜坡角度输入部设定。并且,图14中,示出以向W轴方向上的负向即从挖土机观察时成为下坡的方式形成斜坡的情况。
其中,若将动臂销位置P1的三维坐标设为(U、V、W)=(H0U、0、H0W),将铲斗前端位置P4的三维坐标系设为(U、V、W)=(Ue、Ve、We),则Ue、We与上述公式(1)及公式(2)同样地,分别以公式(1)’及公式(2)’表示。另外,Ue及Ve表示端部附属装置在UV平面中的位置,We表示端部附属装置距UV平面的距离。
Ue=H0U+L1cosβ1’+L2cosβ2’+L3cosβ3’……(1)’
We=H0W+L1sinβ1’+L2sinβ2’+L3sinβ3’……(2)’
另外,Ve成为0。这是因为铲斗前端位置P4存在于UW平面上。并且,角度β1’为对地面角β1加上斜坡角度γ1的角度。同样地,β2’为对地面角β2加上斜坡角度γ1的角度,β3’为对地面角β3加上斜坡角度γ1的角度。
并且,若将铲斗销位置P3的三维坐标设为(U、V、W)=(UP3、VP3、WP3),则UP3、WP3与上述公式(6)及公式(7)同样地,分别以公式(6)’及公式(7)’表示。
UP3=H0U+L1cosβ1’+L2cosβ2’……(6)’
WP3=H0W+L1sinβ1’+L2sianβ2’……(7)’
斜坡整形模式中,若向前方倾倒操纵杆26B,则动臂4、斗杆5及铲斗6中的至少一个进行动作,以便使铲斗前端位置P4的V坐标的值Ve及W坐标的值We不变的同时使U坐标的值Ue增大。
并且,斜坡整形模式中,若向后方倾倒操纵杆26B,则动臂4、斗杆5及铲斗6中的至少一个进行动作,以便使铲斗前端位置P4的V坐标的值Ve及W坐标的值We不变的同时使U坐标的值Ue减少。
即,铲斗前端位置P4根据操纵杆26B向前后方向的操作(相当于图5的F5B的X方向操作,以下称为“U方向操作”)向U轴方向移动。并且,铲斗前端位置P4根据操纵杆26A向前后方向的操作(相当于图5的F5B的Z方向操作,以下称为“W方向操作”)向W轴方向移动。另外,还能够对UVW三维直角坐标系与XYZ三维直角坐标系进行组合来设定为如下,即控制器30根据操作者向前后方向对操纵杆26B进行的操作,使铲斗前端位置P4向U轴方向移动,并根据操作者向前后方向对操纵杆26A进行的操作,使铲斗前端位置P4向Z轴方向移动。
另外,将斜坡整形模式中根据这种操纵杆26A、26B向前后方向的操作,即作为端部附属装置的铲斗6的W方向操作、U方向操作执行的控制称为“斜坡位置控制”。并且,斜坡整形模式中根据操纵杆26A向左右方向的操作及操纵杆26B向左右方向的操作执行的控制与自动平整模式时相同。
通过如此,操作者能够利用作为自动平整模式中的X方向移动控制(平面位置控制)的一例的斜坡整形模式中的斜坡位置控制,轻松地实现铲斗6沿着所希望的斜坡的移动。
接着,参考图15及图16,对斜坡整形模式的另一例进行说明。另外,图15是斜坡整形模式中使用的坐标系的说明图,与图3的F3A对应。并且,图16是对XZ平面中的前置附属装置的动作进行说明的图,与图4对应。并且,进行斜坡整形模式时的操纵杆设定与图5的F5B所示的进行自动平整模式时的操纵杆设定相同。并且,图15、图16在图示了斜坡角度γ1与铲斗前端位置P4的变化这一点上与图3的F3A、图4不同,在其他点上共同。另外,斜坡角度γ1能够在执行斜坡整形模式之前通过操作者设定。并且,图15、图16中,示出以向Z轴方向上的负向即从挖土机观察时成为下坡的方式形成斜坡的情况。
斜坡整形模式中,若向前方倾倒操纵杆26B,则动臂4、斗杆5及铲斗6中的至少一个进行动作,以便使铲斗前端位置P4的Y坐标的值Ye不变且角度γ1的斜坡SF1与铲斗前端位置P4之间的距离不变的同时使X坐标的值Xe增大。即,铲斗前端位置P4在与斜坡SF1平行的平面SF2上沿与Y轴垂直的方向且远离挖土机的方向移动。此时,Z坐标的值Ze在从挖土机观察时为上坡的斜坡的情况下增大,在从挖土机观察时为下坡的斜坡的情况下减小。另外,图15表示从挖土机观察时为下坡的斜坡SF1。
并且,斜坡整形模式中,若向后方倾倒操纵杆26B,则动臂4、斗杆5及铲斗6中的至少一个进行动作,以便使铲斗前端位置P4的Y坐标的值Ye不变且斜坡SF1与铲斗前端位置P4之间的距离不变的同时使X坐标的值Xe减少。即,铲斗前端位置P4在与斜坡SF1平行的平面SF2上沿与Y轴垂直的方向且靠近挖土机的方向移动。此时,Z坐标的值Ze在从挖土机观察时为上坡的斜坡的情况下减小,在从挖土机观察时为下坡的斜坡的情况下增大。
其中,若将当前时刻的铲斗前端位置P4的三维坐标设为(X、Y、Z)=(Xe、Ye、Ze),将移动后的铲斗前端位置P4’的三维坐标设为(X、Y、Z)=(Xe’、Ye’、Ze’),将X轴方向的移动量设为ΔXe(=Xe’-Xe),则Z轴方向的移动量ΔZe(=Ze’-Ze)以公式(8)表示。
ΔZe=ΔXe×tanγ1……(8)
并且,斜坡整形模式中,可代替铲斗前端位置P4的位置控制,执行铲斗销位置P3的位置控制。此时,动臂4、斗杆5及铲斗6中的至少一个进行动作,以便使铲斗销位置P3的Y坐标的值YP3不变且角度γ1的斜坡SF1与铲斗销位置P3之间的距离不变的同时使X坐标的值XP3发生变化。即,铲斗销位置P3在与斜坡SF1平行的平面上沿与Y轴垂直的方向移动。
其中,若将当前时刻的铲斗销位置P3的三维坐标设为(X、Y、Z)=(XP3、YP3、ZP3),将移动后的铲斗销位置P3’的三维坐标设为(X、Y、Z)=(Xp3’、Yp3’、Zp3’),将X轴方向的移动量设为ΔXp3(=Xp3’-Xp3),则Z轴方向的移动量ΔZp3(=Zp3’-Zp3)以公式(9)表示。
ΔZp3=ΔXp3×tanγ1……(9)
另外,本实施例中,将斜坡整形模式中根据这种操纵杆26B向前后方向的操作,即作为端部附属装置的铲斗6的X方向操作执行的控制称为“斜坡位置控制”。并且,斜坡整形模式中根据操纵杆26A的操作及操纵杆26B向左右方向的操作执行的控制与自动平整模式时相同。
通过如此,操作者能够利用作为自动平整模式中的X方向移动控制(平面位置控制)的一例的斜坡整形模式中的斜坡位置控制,轻松地实现铲斗6沿所希望的斜坡的移动。
以上,对本发明的优选实施例进行了详细说明,但是本发明并不受限于上述实施例,在不脱离本发明范围内,可对上述实施例加以各种变形及置换。
例如,上述实施例中,作为端部附属装置使用了铲斗6,但是也可使用起重磁铁、破碎器等。
并且,本申请主张基于2012年6月8日申请的日本专利申请2012-131013号的优先权,并将该日本专利申请的所有内容通过参考援用于本申请中。
符号说明
1-下部行走体,1A、1B-行走用液压马达,2-回转机构,3-上部回转体,4-动臂,4S-动臂角度传感器,5-斗杆,5S-斗杆角度传感器,6-铲斗,6S-铲斗角度传感器,7-动臂缸,8-斗杆缸,9-铲斗缸,10-驾驶室,11-引擎,12-电动发电机,13-变速器,14-主泵,14A-调节器,15-先导泵,16-高压液压管路,17-控制阀,18-逆变器,19-电容器,20-逆变器,21-回转用电动机,21A-旋转轴,22-分解器,23-机械制动器,24-回转变速器,25-先导管路,26-操作装置,26A、26B-操纵杆,26C-踏板,27、28-液压管路,29-先导压传感器,30-控制器,100-升降压转换器,110-DC母线,111-DC母线电压检测部,112-电容器电压检测部,113-电容器电流检测部,120-蓄电系统,CP1、CP2、CP3-泵吐出量导出部,CX-X方向指令值生成部,CZ-Z方向指令值生成部。
Claims (10)
1.一种挖土机的控制方法,其中,
通过一个操纵杆的操作,执行端部附属装置的维持高度不变的平面位置控制,以及预先设定了从挖土机观察成为上坡或下坡的斜坡时维持所述端部附属装置的相对所述斜坡的高度不变的斜坡控制。
2.根据权利要求1所述的挖土机的控制方法,其中,
根据所述一个操纵杆的操作量,生成与动臂及斗杆的动作相关的指令值。
3.根据权利要求1所述的挖土机的控制方法,其中,
所述挖土机具备设置在驾驶席左右的所述一个操纵杆和另一个操纵杆,
通过将所述一个操纵杆向前后方向推到,执行所述端部附属装置的维持高度不变的平面位置控制,以及预先设定了从挖土机观察成为上坡或下坡的斜坡时维持所述端部附属装置的相对所述斜坡的高度不变的斜坡控制,
通过所述一个操纵杆的操作,执行所述端部附属装置相对于所述平面位置或所述斜坡的高度方向的移动。
4.根据权利要求3所述的挖土机的控制方法,其中,
通过将所述一个操纵杆和所述另一个操纵杆向与所述前后方向垂直的方向即左右方向推倒来独立地控制所述端部附属装置的角度控制和所述端部附属装置的回转位置控制。
5.根据权利要求2所述的挖土机的控制方法,其中,
所述挖土机具备安装在回转体上的动臂、安装在动臂上的斗杆以及安装在所述斗杆上的端部附属装置,并基于安装在所述动臂、所述斗杆上的姿势传感器的输出来对所述动臂和斗杆的每一个进行反馈控制。
6.一种挖土机,
具有分别设置在驾驶席的左右的一个操纵杆和另一个操纵杆,
为能够将所述一个操纵杆和所述另一个操纵杆分别向前后方向推倒的结构,
并通过所述一个操纵杆的前后方向的操作而执行端部附属装置的维持高度不变的平面位置控制,以及预先设定了从挖土机观察成为上坡或下坡的斜坡时维持所述端部附属装置的相对所述斜坡的高度不变的斜坡控制。
7.根据权利要求6所述的挖土机,其中,
根据所述一个操纵杆的操作,执行所述端部附属装置相对于所述平面位置或所述斜坡的高度方向的移动值。
8.根据权利要求6所述的挖土机,其中,
所述控制装置通过所述一个操纵杆的操作量,生成与动臂及斗杆的动作相关的指令值。
9.根据权利要求7所述的挖土机,其中,
所述控制装置通过将所述一个操纵杆、所述另一个操纵杆向与所述前后方向垂直的方向即左右方向推倒来独立地控制所述端部附属装置的角度控制和所述端部附属装置的回转位置控制。
10.根据权利要求8所述的挖土机的控制装置,其中,
所述端部附属装置具备安装在回转体上的动臂、安装在动臂上的斗杆以及安装在所述斗杆上的端部附属装置,所述控制装置基于安装在所述动臂、所述斗杆上的姿势传感器的输出对所述动臂、所述斗杆的每一个进行反馈控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810358530.1A CN108425389A (zh) | 2012-06-08 | 2013-06-04 | 挖土机的控制方法及控制装置 |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2012-131013 | 2012-06-08 | ||
JP2012131013 | 2012-06-08 | ||
PCT/JP2013/065509 WO2013183654A1 (ja) | 2012-06-08 | 2013-06-04 | ショベルの制御方法及び制御装置 |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810358530.1A Division CN108425389A (zh) | 2012-06-08 | 2013-06-04 | 挖土机的控制方法及控制装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104246081A CN104246081A (zh) | 2014-12-24 |
CN104246081B true CN104246081B (zh) | 2018-05-22 |
Family
ID=49712043
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201380021230.XA Active CN104246081B (zh) | 2012-06-08 | 2013-06-04 | 挖土机的控制方法及控制装置 |
CN201810358530.1A Pending CN108425389A (zh) | 2012-06-08 | 2013-06-04 | 挖土机的控制方法及控制装置 |
Family Applications After (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810358530.1A Pending CN108425389A (zh) | 2012-06-08 | 2013-06-04 | 挖土机的控制方法及控制装置 |
Country Status (6)
Country | Link |
---|---|
US (2) | US9915054B2 (zh) |
EP (1) | EP2860315A4 (zh) |
JP (4) | JP6088508B2 (zh) |
KR (2) | KR102137346B1 (zh) |
CN (2) | CN104246081B (zh) |
WO (1) | WO2013183654A1 (zh) |
Families Citing this family (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2860315A4 (en) * | 2012-06-08 | 2016-01-06 | Sumitomo Heavy Industries | CONTROL DEVICE AND EXCAVATOR CONTROL METHOD |
SE537716C2 (sv) * | 2013-06-25 | 2015-10-06 | Steelwrist Ab | System, metod och datorprogram för att kontrollera rörelse på en entreprenadmaskins arbetsredskap |
JP5856685B1 (ja) * | 2014-06-02 | 2016-02-10 | 株式会社小松製作所 | 建設機械の制御システム、建設機械、及び建設機械の制御方法 |
JP6591531B2 (ja) * | 2015-03-27 | 2019-10-16 | 住友建機株式会社 | ショベル |
EP3640401B1 (en) * | 2015-09-16 | 2023-04-26 | Sumitomo Heavy Industries, Ltd. | Excavator |
WO2017072877A1 (ja) | 2015-10-28 | 2017-05-04 | 株式会社小松製作所 | 作業機械の校正装置、作業機械及び作業機械の校正方法 |
KR102506386B1 (ko) * | 2015-11-18 | 2023-03-06 | 현대두산인프라코어 주식회사 | 건설기계의 제어 방법 |
CA2978389A1 (en) * | 2016-09-08 | 2018-03-08 | Harnischfeger Technologies, Inc. | System and method for semi-autonomous control of an industrial machine |
JP6450008B2 (ja) * | 2016-11-29 | 2019-01-09 | 株式会社小松製作所 | 作業機制御装置および作業機械 |
WO2017086488A1 (ja) * | 2016-11-29 | 2017-05-26 | 株式会社小松製作所 | 建設機械の制御装置及び建設機械の制御方法 |
JP6714534B2 (ja) * | 2017-03-29 | 2020-06-24 | 日立建機株式会社 | 建設機械 |
WO2019131721A1 (ja) | 2017-12-27 | 2019-07-04 | 株式会社クボタ | 作業機及び作業機の製造方法 |
JP6946173B2 (ja) * | 2017-12-27 | 2021-10-06 | 株式会社クボタ | 作業機 |
DE202018100592U1 (de) * | 2018-02-02 | 2019-05-03 | Liebherr-Hydraulikbagger Gmbh | Bedieneinrichtung für ein Arbeitsgerät und Arbeitsgerät mit entsprechender Bedieneinrichtung |
CN111868336B (zh) * | 2018-03-30 | 2022-08-16 | 住友重机械工业株式会社 | 施工机械、信息处理装置 |
JP7082011B2 (ja) * | 2018-08-23 | 2022-06-07 | 株式会社神戸製鋼所 | 掘削作業機械の油圧駆動装置 |
JP7096105B2 (ja) * | 2018-08-23 | 2022-07-05 | 株式会社神戸製鋼所 | 掘削作業機械の油圧駆動装置 |
JP7301875B2 (ja) * | 2018-11-14 | 2023-07-03 | 住友重機械工業株式会社 | ショベル、ショベルの制御装置 |
CN111335396B (zh) * | 2020-03-16 | 2021-09-17 | 盐城工业职业技术学院 | 一种基于回声状态网络的电传挖掘机位置闭环控制装置和方法 |
US20220025616A1 (en) * | 2020-07-22 | 2022-01-27 | Deere & Company | Mobile machine control system |
CN112095710A (zh) * | 2020-09-16 | 2020-12-18 | 上海三一重机股份有限公司 | 挖掘机位姿显示方法、装置及其所应用的挖掘机 |
JP7424960B2 (ja) | 2020-11-17 | 2024-01-30 | 株式会社小松製作所 | 情報取得システムおよび情報取得方法 |
DE102022105450A1 (de) | 2022-03-08 | 2023-09-14 | Wacker Neuson Linz Gmbh | Baumaschine oder Landmaschine |
CN114753433B (zh) * | 2022-05-30 | 2023-06-06 | 江苏朗禾控制系统有限公司 | 一种新型挖掘机单手柄控制系统的控制方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07305375A (ja) * | 1994-05-12 | 1995-11-21 | Hitachi Constr Mach Co Ltd | 土羽打ち作業装置 |
JPH09287165A (ja) * | 1996-04-23 | 1997-11-04 | Sumitomo Constr Mach Co Ltd | 油圧ショベルの自動直線掘削装置 |
CN1290317A (zh) * | 1998-12-04 | 2001-04-04 | 新卡特彼勒三菱株式会社 | 建筑机械 |
EP1835079A1 (en) * | 2006-03-17 | 2007-09-19 | Qinghua He | Electromechanically controlled excavator and method for controlling the electromechanically controlled excavator. |
CN201305864Y (zh) * | 2008-10-12 | 2009-09-09 | 姚实现 | 新型可调平式连杆机构、及应用其的工作装置和包括高空作业车、装载机等的作业机械 |
CN201581425U (zh) * | 2010-01-08 | 2010-09-15 | 徐工集团工程机械股份有限公司科技分公司 | 一种装载机铲斗放平自动控制装置 |
CN101946045A (zh) * | 2008-02-20 | 2011-01-12 | 株式会社小松制作所 | 建筑机械 |
Family Cites Families (56)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5530038A (en) * | 1978-08-23 | 1980-03-03 | Komatsu Ltd | Control device for a working machine |
JPS60152733A (ja) * | 1984-01-18 | 1985-08-12 | Kubota Ltd | バツクホウ作業車 |
JPH0637781B2 (ja) * | 1985-12-30 | 1994-05-18 | 株式会社加藤製作所 | パワ−シヨベルの制御装置 |
US4712376A (en) * | 1986-10-22 | 1987-12-15 | Caterpillar Inc. | Proportional valve control apparatus for fluid systems |
US5178510A (en) * | 1988-08-02 | 1993-01-12 | Kabushiki Kaisha Komatsu Seisakusho | Apparatus for controlling the hydraulic cylinder of a power shovel |
EP0380665B1 (en) * | 1988-08-02 | 1993-10-27 | Kabushiki Kaisha Komatsu Seisakusho | Method and apparatus for controlling working units of power shovel |
US5002454A (en) * | 1988-09-08 | 1991-03-26 | Caterpillar Inc. | Intuitive joystick control for a work implement |
US5160239A (en) * | 1988-09-08 | 1992-11-03 | Caterpillar Inc. | Coordinated control for a work implement |
US5470190A (en) * | 1990-02-21 | 1995-11-28 | Bamford Excavators, Limited | Loader vehicle |
JPH0630254U (ja) * | 1991-07-09 | 1994-04-19 | 雄介 丸山 | 連動式コントロール・レバー |
US5424623A (en) * | 1993-05-13 | 1995-06-13 | Caterpillar Inc. | Coordinated control for a work implement |
JP3364303B2 (ja) * | 1993-12-24 | 2003-01-08 | 株式会社小松製作所 | 作業機械の制御装置 |
US5620053A (en) * | 1994-01-28 | 1997-04-15 | Komatsu, Ltd. | Blade apparatus and its control method in bulldozer |
JP3537520B2 (ja) * | 1994-12-12 | 2004-06-14 | ヤンマー株式会社 | 掘削制御装置 |
JP3457762B2 (ja) | 1995-04-07 | 2003-10-20 | 日立建機株式会社 | 油圧ショベルの掘削軌跡制御装置 |
KR0168992B1 (ko) * | 1995-10-31 | 1999-02-18 | 유상부 | 굴삭기의 제어방법 |
US5957989A (en) * | 1996-01-22 | 1999-09-28 | Hitachi Construction Machinery Co. Ltd. | Interference preventing system for construction machine |
US5704429A (en) * | 1996-03-30 | 1998-01-06 | Samsung Heavy Industries Co., Ltd. | Control system of an excavator |
JP3441886B2 (ja) * | 1996-06-18 | 2003-09-02 | 日立建機株式会社 | 油圧建設機械の自動軌跡制御装置 |
JPH1037230A (ja) * | 1996-07-23 | 1998-02-10 | Hitachi Constr Mach Co Ltd | 油圧掘削機械の軌跡自動制御装置 |
JPH1088609A (ja) * | 1996-09-11 | 1998-04-07 | Yanmar Diesel Engine Co Ltd | 掘削作業機の制御機構 |
JP3462683B2 (ja) * | 1996-12-25 | 2003-11-05 | 株式会社クボタ | バックホウ |
JP3462686B2 (ja) * | 1997-01-22 | 2003-11-05 | 株式会社クボタ | バックホウ |
KR100353566B1 (ko) * | 1997-02-13 | 2003-01-06 | 히다치 겡키 가부시키 가이샤 | 유압셔블의경사면굴삭제어장치,목표경사면설정장치및경사면굴삭형성방법 |
JP3713358B2 (ja) * | 1997-04-21 | 2005-11-09 | 日立建機株式会社 | 建設機械のフロント制御装置 |
JPH1136361A (ja) * | 1997-07-18 | 1999-02-09 | Kubota Corp | バックホウ |
US6025686A (en) * | 1997-07-23 | 2000-02-15 | Harnischfeger Corporation | Method and system for controlling movement of a digging dipper |
JP3821260B2 (ja) * | 1998-03-05 | 2006-09-13 | 株式会社小松製作所 | 建設機械の作業機制御装置 |
JPH11336129A (ja) * | 1998-05-28 | 1999-12-07 | Hitachi Constr Mach Co Ltd | 建設機械の操作ペダル装置 |
JP2000064336A (ja) * | 1998-08-19 | 2000-02-29 | Sumitomo Constr Mach Co Ltd | クレーン仕様油圧ショベルの自動水平引装置 |
US6226902B1 (en) * | 1999-07-16 | 2001-05-08 | Case Corporation | Operator presence system with bypass logic |
US6435289B1 (en) * | 1999-09-22 | 2002-08-20 | Komatsu Ltd. | Apparatus for altering operation apparatus and actuator combinations, and operation lever apparatus |
JP3661596B2 (ja) * | 2001-02-23 | 2005-06-15 | コベルコ建機株式会社 | 建設機械の操作回路 |
JP2002250047A (ja) * | 2001-02-23 | 2002-09-06 | Hitachi Constr Mach Co Ltd | 油圧ショベルの配管支持構造 |
JP3657894B2 (ja) * | 2001-07-18 | 2005-06-08 | マルマテクニカ株式会社 | 油圧ショベルの手動操作 |
JP3779919B2 (ja) * | 2001-12-07 | 2006-05-31 | 日立建機株式会社 | 建設機械の操作装置 |
AU2003261824B2 (en) * | 2002-09-05 | 2007-05-17 | Hitachi Construction Machinery Co., Ltd. | Hydraulic driving system of construction machinery |
JP2004132194A (ja) * | 2002-10-08 | 2004-04-30 | Calsonic Kansei Corp | 車両のステアリング操作ユニット |
US8424302B2 (en) * | 2005-10-28 | 2013-04-23 | Komatsu Ltd. | Control device of engine, control device of engine and hydraulic pump, and control device of engine, hydraulic pump, and generator motor |
US9074352B2 (en) * | 2006-03-27 | 2015-07-07 | John R. Ramun | Universal control scheme for mobile hydraulic equipment and method for achieving the same |
FI123932B (fi) * | 2006-08-16 | 2013-12-31 | John Deere Forestry Oy | Puomirakenteen ja siihen nivelletysti kiinnitetyn työkalun ohjaus |
US7979181B2 (en) * | 2006-10-19 | 2011-07-12 | Caterpillar Inc. | Velocity based control process for a machine digging cycle |
KR101265342B1 (ko) * | 2006-12-22 | 2013-05-20 | 두산인프라코어 주식회사 | 굴삭기의 수평 다림질 및 법면 작업성 개선장치 |
GB0625764D0 (en) * | 2006-12-22 | 2007-02-07 | Bamford Excavators Ltd | Control apparatus for a machine |
US8621855B2 (en) * | 2007-06-08 | 2014-01-07 | Deere & Company | Electro-hydraulic auxiliary mode control |
US20100254793A1 (en) * | 2007-06-15 | 2010-10-07 | Boris Trifunovic | Electronic Anti-Spill |
US9109345B2 (en) * | 2009-03-06 | 2015-08-18 | Komatsu Ltd. | Construction machine, method for controlling construction machine, and program for causing computer to execute the method |
WO2010143628A1 (ja) * | 2009-06-09 | 2010-12-16 | 住友重機械工業株式会社 | ハイブリッド式ショベル及びその制御方法 |
US8401746B2 (en) * | 2009-12-18 | 2013-03-19 | Trimble Navigation Limited | Excavator control using ranging radios |
US8272468B2 (en) * | 2010-02-25 | 2012-09-25 | Yanmar Co., Ltd. | Work machine |
JP5584539B2 (ja) * | 2010-07-09 | 2014-09-03 | キャタピラー エス エー アール エル | 作業機械の作業範囲制御装置 |
US8380402B2 (en) * | 2010-09-14 | 2013-02-19 | Bucyrus Intl. Inc. | Control systems and methods for heavy equipment |
US8340875B1 (en) * | 2011-06-16 | 2012-12-25 | Caterpillar Inc. | Lift system implementing velocity-based feedforward control |
US20130180744A1 (en) * | 2012-01-12 | 2013-07-18 | Caterpillar, Inc. | Operator Interface for an Implement Control System |
EP2816159B1 (en) * | 2012-02-15 | 2018-01-10 | Hitachi Construction Machinery Co., Ltd. | Dual-arm work machine |
EP2860315A4 (en) | 2012-06-08 | 2016-01-06 | Sumitomo Heavy Industries | CONTROL DEVICE AND EXCAVATOR CONTROL METHOD |
-
2013
- 2013-06-04 EP EP13801283.6A patent/EP2860315A4/en active Pending
- 2013-06-04 KR KR1020197027803A patent/KR102137346B1/ko active IP Right Grant
- 2013-06-04 CN CN201380021230.XA patent/CN104246081B/zh active Active
- 2013-06-04 KR KR1020147029134A patent/KR102026348B1/ko active IP Right Grant
- 2013-06-04 JP JP2014520018A patent/JP6088508B2/ja active Active
- 2013-06-04 CN CN201810358530.1A patent/CN108425389A/zh active Pending
- 2013-06-04 WO PCT/JP2013/065509 patent/WO2013183654A1/ja active Application Filing
-
2014
- 2014-10-16 US US14/515,632 patent/US9915054B2/en active Active
-
2017
- 2017-02-03 JP JP2017018994A patent/JP6675995B2/ja active Active
-
2018
- 2018-02-27 US US15/905,968 patent/US11248361B2/en active Active
-
2019
- 2019-07-25 JP JP2019136868A patent/JP7009424B2/ja active Active
- 2019-11-27 JP JP2019214480A patent/JP7051785B2/ja active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07305375A (ja) * | 1994-05-12 | 1995-11-21 | Hitachi Constr Mach Co Ltd | 土羽打ち作業装置 |
JPH09287165A (ja) * | 1996-04-23 | 1997-11-04 | Sumitomo Constr Mach Co Ltd | 油圧ショベルの自動直線掘削装置 |
CN1290317A (zh) * | 1998-12-04 | 2001-04-04 | 新卡特彼勒三菱株式会社 | 建筑机械 |
EP1835079A1 (en) * | 2006-03-17 | 2007-09-19 | Qinghua He | Electromechanically controlled excavator and method for controlling the electromechanically controlled excavator. |
CN101946045A (zh) * | 2008-02-20 | 2011-01-12 | 株式会社小松制作所 | 建筑机械 |
CN201305864Y (zh) * | 2008-10-12 | 2009-09-09 | 姚实现 | 新型可调平式连杆机构、及应用其的工作装置和包括高空作业车、装载机等的作业机械 |
CN201581425U (zh) * | 2010-01-08 | 2010-09-15 | 徐工集团工程机械股份有限公司科技分公司 | 一种装载机铲斗放平自动控制装置 |
Also Published As
Publication number | Publication date |
---|---|
KR20150016933A (ko) | 2015-02-13 |
KR20190110650A (ko) | 2019-09-30 |
JP2019178608A (ja) | 2019-10-17 |
CN108425389A (zh) | 2018-08-21 |
JP7009424B2 (ja) | 2022-01-25 |
JP7051785B2 (ja) | 2022-04-11 |
JP6088508B2 (ja) | 2017-03-01 |
EP2860315A4 (en) | 2016-01-06 |
US20180187394A1 (en) | 2018-07-05 |
EP2860315A1 (en) | 2015-04-15 |
JP6675995B2 (ja) | 2020-04-08 |
US11248361B2 (en) | 2022-02-15 |
US9915054B2 (en) | 2018-03-13 |
JP2017075529A (ja) | 2017-04-20 |
CN104246081A (zh) | 2014-12-24 |
KR102026348B1 (ko) | 2019-11-04 |
US20150039189A1 (en) | 2015-02-05 |
JP2020029769A (ja) | 2020-02-27 |
KR102137346B1 (ko) | 2020-07-23 |
WO2013183654A1 (ja) | 2013-12-12 |
JPWO2013183654A1 (ja) | 2016-02-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104246081B (zh) | 挖土机的控制方法及控制装置 | |
CN104395537B (zh) | 工程机械 | |
CN103608526B (zh) | 挖土机以及挖土机的控制方法 | |
CN103781972B (zh) | 挖土机以及挖土机的控制方法 | |
CN105804146B (zh) | 作业机械 | |
KR20100115706A (ko) | 하이브리드형 작업기계 | |
CN107208400B (zh) | 混合动力式工程机械 | |
JP2008214970A (ja) | 電動式建設機械 | |
CN107076182B (zh) | 混合动力建筑机械的控制系统 | |
CN107921958A (zh) | 混合动力作业机械 | |
CN102713085A (zh) | 混合式施工机械 | |
CN107250560B (zh) | 工程机械的驱动装置 | |
CN108138468A (zh) | 施工机械 | |
CN107850094A (zh) | 控制系统、作业机械及控制方法 | |
CN107251409A (zh) | 回转装置 | |
CN105940161A (zh) | 挖土机 | |
JP5442383B2 (ja) | ハイブリッド型建設機械 | |
CN108026945A (zh) | 控制系统、作业机械及控制方法 | |
KR20120114945A (ko) | 하이브리드 굴삭기의 선회 속도 지령 제어방법 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |