CN1651666A - 用于液压挖掘机工作装置的轨迹控制系统及方法 - Google Patents

用于液压挖掘机工作装置的轨迹控制系统及方法 Download PDF

Info

Publication number
CN1651666A
CN1651666A CN 200510200186 CN200510200186A CN1651666A CN 1651666 A CN1651666 A CN 1651666A CN 200510200186 CN200510200186 CN 200510200186 CN 200510200186 A CN200510200186 A CN 200510200186A CN 1651666 A CN1651666 A CN 1651666A
Authority
CN
China
Prior art keywords
scraper bowl
swing arm
dipper
angle
hydraulic
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
Application number
CN 200510200186
Other languages
English (en)
Other versions
CN100464036C (zh
Inventor
戴群亮
邵以东
唐建国
卢书湘
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangxi Liugong Machinery Co Ltd
Original Assignee
Guangxi Liugong Machinery Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Guangxi Liugong Machinery Co Ltd filed Critical Guangxi Liugong Machinery Co Ltd
Priority to CNB2005102001866A priority Critical patent/CN100464036C/zh
Publication of CN1651666A publication Critical patent/CN1651666A/zh
Application granted granted Critical
Publication of CN100464036C publication Critical patent/CN100464036C/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

一种用于液压挖掘机工作装置的轨迹控制系统及方法,是通过DSP接收动臂角度检测机构、斗杆角度检测机构、铲斗角度检测机构测量信号及相应液压缸压力信号、发动机转速信号,获得相应的电压值,对数据进行存储和处理;存储设定的工作装置的目标位置和姿态;根据工作装置的实际测量角度信号,与通过逆运算获得的数据相比较,产生校正信号;驱动工作装置中驱动油缸动作;采用CAN总线通讯方式,实现数据传输;由前馈控制与非线性PID控制算法相结合的方法进行控制。优点是能够实现液压挖掘机工作装置的自动操纵,精确而稳定地控制液压挖掘机工作装置的位置和姿态,使工作装置按照预先设定的轨迹运动,完成作业任务,缩短作业周期,提高作业效率和作业质量。

Description

用于液压挖掘机工作装置的轨迹控制系统及方法
技术领域
本发明是涉及一种用于液压挖掘机工作装置的轨迹控制系统及方法。
背景技术
1、液压挖掘机主要用于土方工程施工等场合,驾驶员在操纵液压挖掘机工作装置时需要具有一定的熟练性,在直线平整和斜坡挖掘过程中,往往要靠驾驶员的操作经验来完成复杂的动作,增加了驾驶员的劳动强度,降低了劳动生产率。而采用自动操纵可大幅度提高作业效率和作业质量,更好的完成作业任务。
2、目前已有的一些控制装置中未能考虑到液压挖掘机转速、负载以及工作装置姿态的变化对控制性能的影响,造成稳定性和控制精度变差,影响挖掘机工作装置作业的精度。
3、常用的普通位置伺服控制方法,大多数是采用比较典型的PID算法,但针对液压挖掘机工作装置这样特殊的对象,PID参数不易整定,往往不能获得良好的控制效果,并且由于外部载荷变化大,参数不易整定,工况复杂,工作装置各构件之间的耦合关系,造成PID调节器的控制性能变差。
发明内容
本发明的目的就是提供一种用于液压挖掘机工作装置轨迹控制系统及方法,通过该控制系统能够实现液压挖掘机工作装置自动操纵,准确而稳定地控制工作装置的位置和姿态,使工作装置按照预先设定的轨迹运动,完成作业任务。DSP控制器201根据角度传感器获得的动臂斗杆和铲斗的相对转动角度信息及压力、发动机转速信息,由DSP控制器201经过数据处理部分计算后,发出控制量,分别驱动动臂液压缸斗杆液压缸和铲斗液压缸动作,从而准确地控制铲斗的位置和姿态,实现液压挖掘机工作装置的自动操纵。
本发明的解决方案是这样的:
构成本发明的系统包括有动臂液压缸208、斗杆液压缸209、铲斗液压缸210,主控阀207,电磁比例先导阀205,齿轮泵211,溢流阀206,滤油器212,动臂104,斗杆106,铲斗108,其特征在于:
1、在动臂104与工作装置102的铰接处、动臂104与斗杆106的铰接处、斗杆106与铲斗108铰接处分别设置有动臂角度检测机构103、斗杆角度检测机构105、铲斗角度检测机构107;
2、具有DSP控制器201,用于接收通过A/D数据转换送入的动臂角度检测机构103、斗杆角度检测机构105、铲斗角度检测机构107测量的角度信号,以及动臂液压缸208压力、斗杆液压缸209压力、铲斗液压缸210压力信号、发动机转速信号,得到角度的电压值,以及压力和转速电压值,对接收的数据进行数据存储和处理;以及存储预先设定的工作装置的目标位置和姿态;通过对挖掘机工作装置实际的位置、姿态与预先设定的位置、姿态进行比较,产生校正信号;
3、DSP控制器201具有控制输出部分,用于发出的控制指令,产生占空比不同的PWM信号;由驱动放大部分将信号放大,产生相应的驱动电流,驱动先导电磁比例阀205动作;
4、DSP控制器201具有数据显示部分:用于显示液压挖掘机当前的工作状态、液压挖掘机工作装置102中铲斗108的空间位置和姿态信息;
5、具有操纵手柄(1、2),将操纵手柄移动信号通过数字量传输,以CAN总线的数据传输方式,发送给DSP控制器201。
在本发明中采用的控制方法为:
1、由动臂角度检测机构103、斗杆角度检测机构105、铲斗角度检测机构107检测动臂(104)、斗杆(106)和铲斗(108)的相对转动角度,将检测数据送入DSP控制器201;
2、由数据转换部分根据角度传感器采集的角位移信息,通过计算换算成为计算机能够识别的数字量;
3、由DSP控制器201进行数据处理:测量得到的液压挖掘机工作装置102中动臂104、斗杆106和铲斗108相对转动角度信号,通过算法运算后获得工作装置中铲斗108的空间坐标和姿态;反之,如果预先设定铲斗在空间的位置和姿态,则可以通过逆运算获得工作装置中动臂104、斗杆106和铲斗108的相对转动角度;
4、由DSP控制器201进行校正器算法运算部分,根据工作装置中动臂、斗杆和铲斗的实际测量角度信号,与通过逆运算获得的相对转动角度相比较,产生校正信号;
5、由DSP控制器201输出控制信号:将校正器产生的校正信号,转换为相应的PWM信号,通过放信号大,驱动电磁比例先导阀205动作,使主控阀207动作,从而推动液压缸动作;
6、由DSP控制器201进行数据存储部分,来存储测量信号,并在示教挖掘时,记录挖掘过程中动臂104、斗杆106和铲斗108的运行轨迹,控制系统根据记录的数据,形成自动挖掘时的挖掘轨迹序列,当控制器发出挖掘命令时,控制系统执行相应的控制算法,实现示教挖掘;数据存储部分还存储测量得到的数据,包括液压挖掘机工作装置102各机构的相对转动角度、发动机转速和液压缸压力等信息;存储预先设定的工作装置在典型作业时铲斗齿尖的运动轨迹信息。
7、由DSP控制器201将液压挖掘机当前的工作状态、液压挖掘机工作装置102中铲斗108的空间位置和姿态信息等,送到显示部分进行显示;
8、通过操纵手柄(1、2)与DSP控制器201之间通过CAN总线方式进行数据传输。
本发明的优点是能够实现液压挖掘机工作装置的自动操纵,精确而稳定地控制液压挖掘机工作装置的位置和姿态,使工作装置按照预先设定的轨迹运动,完成作业任务,缩短作业周期,提高作业效率和作业质量。
附图说明
附图是本发明的实施例。
附图1是本发明安装在液压挖掘机的示意图。
附图2液压挖掘机工作装置电液控制系统示意图。
附图3根据本发明实施例的DSP控制器的结构原理图。
附图4CAN总线联接示意图。
附图5操纵手柄示意图。
附图6动臂斗杆或铲斗角度检测机构示意图。
附图7液压挖掘机工作装置空间位置、姿态与角度变换关系示意图。
附图8校正控制器结构图。
附图9发动机转速变化增益补偿曲线示意图。
附图10负载变化增益补偿曲线示意图。
附图11是非线性PID控制参数KP修正示意图。
附图12是非线性PID控制参数KD修正示意图。
附图13是非线性PID控制参数KI修正示意图。
附图14液压挖掘机平整场地作业示意图。
附图15液压挖掘机直线挖掘作业示意图。
图附16操纵手柄运动方向示意图。
具体实施方式
本发明的控制系统包括有动臂液压缸208、斗杆液压缸209、铲斗液压缸210,主控阀207,电磁比例先导阀205,齿轮泵211,溢流阀206,滤油器212,动臂104,斗杆106,铲斗108,其中:
1、在动臂104与工作装置102的铰接处、动臂104与斗杆106的铰接处、斗杆106与铲斗108铰接处分别设置有动臂角度检测机构103、斗杆角度检测机构105、铲斗角度检测机构107;
2、具有DSP控制器201,用于接收通过A/D数据转换送入的动臂角度检测机构103、斗杆角度检测机构105、铲斗角度检测机构107测量的角度信号,以及动臂液压缸208压力、斗杆液压缸209压力、铲斗液压缸210压力信号以及发动机转速转速信号,得到角度的电压值,以及压力和转速电压值,对接收的数据进行数据存储和处理;以及存储预先设定的工作装置的目标位置和姿态;通过对挖掘机工作装置实际的位置、姿态与预先设定的位置、姿态进行比较,产生校正信号;
3、DSP控制器201具有控制输出部分,用于发出的控制指令,产生占空比不同的PWM信号;由驱动放大部分将信号放大,产生相应的驱动电流,驱动先导电磁比例阀205动作;
4、DSP控制器201具有数据显示部分:用于显示液压挖掘机当前的工作状态、液压挖掘机工作装置102中铲斗108的空间位置和姿态信息;
5、具有操纵手柄(1、2),将操纵手柄移动信号通过数字量传输,以CAN总线的数据传输方式发送给DSP控制器201。
压力传感器218、219、220分别测量动臂液压缸208、斗杆液压缸209和铲斗液压缸210的压力,根据来自压力传感器的电压值获得各液压缸的负载信息。
DSP控制器201通过CAN总线与其他控制器之间进行数据交换。
动臂角度检测机构103、斗杆角度检测机构105、铲斗角度检测机构107是采用转动式角度传感器,检测动臂104、斗杆106和铲斗108之间相对转动的角度。
本实施例提供了一个控制系统101包括DSP控制器201,如图3所示,用来实现挖掘机工作装置轨迹控制,其中DSP控制器201作为核心控制单元,其型号为TMS320LF2407,具有25ns的指令周期,40MIPS的处理能力,片内有32K×16的FLASH EEPROM,作为程序存储器,2.5K×16的RAM。2组×8路16位PWM输出,并带有可编程死区保护和PDP保护。2组×8路10位A/D转换器,具有多种同步触发的模式,内置看门狗电路。片内有锁相环电路,可外接较低频的振荡器。具有CAN总线通讯接口。
来自各传感器的信号输入到安装在液压挖掘机上的DSP控制器201,DSP控制器201根据测量信号,以及操纵手柄信号,经过数据处理及算法运算后输出PWM信号,经过放大电路放大,输出控制电流,驱动电磁比例阀205动作,主控阀207根据来在电磁比例阀205的先导压力,控制动臂液压缸208、斗杆液压缸209和铲斗液压缸210动作,使铲斗按预先设计的轨迹动作,实现挖掘机工作装置的自动操纵,完成相应的作业任务。
本发明中角度检测机构,如图6所示,包括:一个角度传感器303,通过外罩304固定在动臂306下绞点的销轴305处,由销轴301与固定在动臂上的销301,由拨杆302带动与之联接的角度传感器303轴转动,相对转动的角度以电压形式给出,用来检测动臂104相对与回转平台平面相对转动的角度;具有与图6所示相同的角度检测机构,安装在斗杆与动臂联接销轴处的角度传感器,用来检测斗杆106与动臂104之间的相对转动角度;具有与图6所示相同的角度检测机构,安装在斗杆与铲斗联接销轴处的角度检测机构,用来检测铲斗108与斗杆106之间的相对转动的角度。
数据存储部分由DSP中32K×16的FLASH EEPROM实现,用来存储测量信号,并在示教挖掘过程中,记录挖掘过程中,动臂104、斗杆106和铲斗108的相对转动角度,DSP控制器201根据记录的数据,形成自动挖掘时的挖掘轨迹序列,当DSP控制器201发出挖掘命令时,控制系统执行相应的控制算法,实现示教挖掘。
数据转换部分由A/D实现。连接到控制器上的各种传感器包括:角度传感器、发动机转速传感器、压力传感器,DSP控制器201将采集的测量信号,经过A/D转换后,实现模拟信号向数字信号转换,将测量信号的电压值等转换为相应的数字量,通过接口送入DSP控制器201中。
控制输出部分由DSP控制器201的PWM信号输出部分、输入/输出电路202,信号调理电路203,和放大驱动电路204,驱动电磁比例先导阀205动作,使主控阀207动作,从而推动液压缸动作;
数据显示部分,采用128×64液晶显示器,显示当前工作状态以及铲斗在空间的位置和姿态等信息。
数据传输采用CAN总线通讯方式,通过CAN总线将两个传统的控制手柄(1、2)及其他控制设备连接起来构成局域网,如图4所示。其连接方式采用两根双绞线,终端带有120欧姆的补偿电阻。CAN总线信号部分,实现现场设备与控制设备的信号连接,省去了大量导线,提高了控制信号的可靠性,抗干扰能力强。CAN总线适合于液压挖掘机工作环境恶劣,保证控制的实时性和灵活性,可扩展性,与其它外围设备构成多控制器网络结构;采用发送报文的编码方法和非破坏性优先级总线总裁技术,抗干扰能力强、可靠性高、具有较高的实时性。CAN总线通讯协议符合SAE J1939的标准,CAN物理层符合SAE J1939/15标准,通信速率为250Kbit/s,终端电阻为120欧姆。
一个控制手柄,将操纵手柄(1、2)移动信号通过数字量传输,发送给控制装置(CAN总线的数据传输方式)。
DSP控制器201还可以通过CAN总线与其他控制器之间进行数据交换;来自操纵手柄(1、2)的操纵信号及各个传感器的信号包括由CAN总线传输的信号输入到DSP控制器201,控制器201根据检测到的信号,执行相应的控制算法,控制电磁比例先导阀205动作,从而控制主控阀207,推动液压缸伸出或者缩进,实现对挖掘机工作装置的电控操纵。
作为上述的控制模式,操作控制手柄(1、2)上的按钮A或者B,可实现不同自动作业模式选择。操纵手柄(1、2)作为一个具有CAN总线接口的设备,连接到DSP控制器201的CAN总线接口上。操纵手柄(1、2)上包括控制按钮,如图5、图16所示。操纵手柄具有CAN总线设备接口,其通讯符合SAEJ1939协议。当按下模式选择按钮A或B时,由控制软件根据所选择的功能,执行程序,实现相应的控制功能。根据不同的按钮操作对应的挖掘方式包括:平整场地作业方式,直线挖掘作业方式以及示教挖掘方式。
控制装置的信号转换部分包括:一个输入接口电路(203、204),用来从角度传感器215、216、217接收检测信号,测量动臂104、斗杆106和铲斗108的相对转角,压力传感器218、219、220信号及转速传感器信号(未示出),经过信号调理电路202及输入/输出接口电路203,送入DSP控制器201的A/D接口端。
本发明的控制方法为:
1、由动臂角度检测机构103、斗杆角度检测机构105、铲斗角度检测机构107检测动臂机构相对转动角度,将检测数据送入DSP控制器201;
2、由数据转换部分根据角度传感器采集的角位移信息,通过计算换算成为计算机能够识别的数字量;
3、由DSP控制器201进行数据处理:测量得到的液压挖掘机工作装置102中动臂104、斗杆106和铲斗108相对转动角度信号,通过算法运算后获得工作装置中铲斗的空间坐标;反之,如果预先设定铲斗在空间坐标系中的位置和姿态,则可以通过逆运算获得工作装置中动臂104、斗杆106和铲斗108的相对转动角度;
4、由DSP控制器201进行校正器算法运算部分,根据实际测量的角度位置信号与预先给定的角度位置相比较,产生校正信号;
5、DSP控制器201输出控制信号,产生占空比不同的PWM信号;由驱动放大部分将信号放大,产生相应的驱动电流,驱动先导电磁比例阀205动作,使主控阀207动作,从而推动液压缸动作;
6、由DSP控制器201进行数据存储部分,存储测量信号,并在示教挖掘过程,记录挖掘过程中动臂104、斗杆106和铲斗108的运行轨迹,控制系统根据记录的数据,形成自动挖掘时的挖掘轨迹序列,当DSP控制器201发出挖掘命令时,控制系统执行相应的控制算法,实现示教挖掘;数据存储部分还存储测量得到的数据,包括液压挖掘机工作装置102各机构的相对转动角度、发动机转速和液压缸压力等信息;存储预先设定的工作装置在典型作业时铲斗齿尖的运行轨迹信息。
7、DSP控制器201的数据显示部分用于显示液压挖掘机当前的工作状态、液压挖掘机工作装置102中铲斗108的空间位置和姿态信息;
8、通过操纵手柄(1、2)与DSP控制器201之间通过CAN总线方式进行数据传输;DSP控制器201还可以通过CAN总线与其他控制器之间进行数据交换;
所述的控制算法是采用非线性PID算法,当DSP控制器201发出挖掘命令时,经非线性PID校正器进行计算,作为输入控制量,控制挖掘机工作装置运动。
在挖掘机工作装置(102)位置输出端取出信号,进行前馈校正,前馈校正产生的控制量与非线性PID校正器产生控制量一起,作为输入控制量。
根据检测的角度,采用动力学方程,通过计算获得重力力矩,计算出的重力补偿参数与本发明采用的非线性PID校正器产生控制量一起,作为挖掘机工作装置的输入控制量。
当同时采用前馈校正和重力参数补偿一起与非线性PID校正器产生控制量一起,作为挖掘机工作装置的输入控制量时,可以得到最佳的控制效果。
本实施例就是采用前馈校正和重力参数补偿一起与非线性PID校正器产生控制量一起,作为挖掘机工作装置的输入控制量。
本发明数据处理部分:
附图7中,铲斗齿尖V的空间直角坐标系是以液压挖掘机回转中心做为坐标原点,Z轴与液压挖掘机回转中心线重合,垂直于地面方向,X轴与水平面重合,并指向挖掘机前进的方向,Y轴沿着水平面与X轴垂直。l0表示C点到Y轴的距离;d1表示C点到X轴的距离;l1表示动臂C点到F点的距离;l2表示动臂F点到Q点的距离;l3表示动臂Q点到V点的距离。θ1表示线段CF与水平面的夹角;θ2表示线段CF与FQ的夹角;θ3表示线段FQ与QV的夹角;VxVyVz表示铲斗在空间坐标系中的坐标,β表示铲斗齿尖V与铲斗绞接点Q的连线与水平面的夹角;
根据图7所示,DSP控制器201的数据处理部分计算铲斗108在空间直角坐标系中的位置和姿态VxVyVzβ,通过逆运算获得工作装置中动臂104、斗杆106和铲斗108之间的相对转角θ1θ2θ3;将测量得到的工作装置中动臂104、斗杆106和铲斗108相对转动角度θ1θ2θ3,通过算法运算后获得工作装置中铲斗108的空间坐标和姿态。
液压挖掘机电液伺服系统存在滞后、非线性的特性,为了提高液压挖掘机电液伺服系统的控制特性,提高控制系统的稳定性,使其调整迅速、超调小,在控制回路增加PID校正器。针对液压挖掘机这样特殊的对象,普通PID算法往往不能获得良好的控制效果。如图8所示,根据本发明提供的校正控制器,包括反馈补偿特性的非线性PID控制、前馈补偿控制,以及重力补偿控制。PID校正器属于反馈控制,前馈补偿控制包括负载以及转速补偿,根据检测的角度由动力学方程,获得重力力矩,通过计算获得重力补偿参数K,DSP控制器201经过非线性PID校正器及前馈补偿运算后,产生控制信号,转换为相应的PWM信号,通过放大驱动电路放大后,为比例电磁阀提供控制电流,驱动电磁比例先导阀205动作,最终通过主控阀207推动液压缸动作。
前馈补偿控制包括负载补偿系数Kf以及转速补偿系数Ke,以及动力学补偿参数,其中动力学补偿参数由动力学方程根据检测的角度,通过计算获得重力项力矩补偿参数K,并作为前馈补偿量的一部分,与校正器输出的控制量一起,作为电磁比例先导阀205的输入控制量,驱动电磁比例先导阀205的动作。根据发动机转速补偿曲线如图9所示,DSP控制器201输出的每个电磁比例先导阀的电流值,与发动机转速变化增益补偿曲线中得到的校正系数相乘,将乘积作为修正过的电磁比例阀控制指令数值,输出到被控制的电磁比例先导阀205,实现根据发动机转速变化而进行前馈补偿。
发动机转速是由驾驶员设置油门的位置决定的,不同的油门位置对应不同的转速信号,即使发动机油门位置固定,发动机的转速也会随着负载的变化而变化,由于齿轮泵211是直接连接到发动机上的,所以如果发动机转速改变,那么齿轮泵211的排量也发生变化。另外,如果发动机的转速因为外加负载等变化,则齿轮泵211的转速会因为发动机的转速的变化而变化并且泵的输出量也发生变化,因此即使输出给电磁比例先导阀205的电流值是一样的,液压缸的伸出速度也要发生变化。为了补偿由于发动机转速变化造成泵流量变化,或者负载变化造成发动机转速变化对泵流量的影响,提高控制系统的性能,在发动机上安装转速传感器,对发动机速度变化进行补偿。DSP控制器201测得的发动机转速值,根据如图9所示的发动机转速变化增益补偿曲线,得到发动机增益补偿校正系数Ke,DSP控制器201输出的每个电磁比例先导阀的电流值与发动机转速补偿增益系数Ke相乘,将乘积作为修正过的电磁比例阀控制指令数值,输出到被控制的电磁比例先导阀205,实现根据发动机转速变化而进行前馈补偿。
DSP控制器201根据动臂液压缸208斗杆液压缸209及铲斗液压缸210中的压力信号,对由于负载变化造成的流量分配问题,进行前馈补偿控制。动臂、斗杆和铲斗液压缸的负载检测由压力传感器(218、219、220)构成等,并根据来自压力传感器的信息检测液压缸的负载信息,如图10所示的负载增益校正曲线,得到校正增益Kf,控制部分输出的比例阀的PWM控制信号与其相乘,经过放大驱动后,作为电磁比例阀205的输入控制信号,驱动比例阀动作,最终推动液压缸运动,实现对工作装置的位置和姿态的精确控制,并具有一定的稳定性。
根据对液压挖掘机进行动力学分析,根据工作装置重力项力矩和工作装置动臂、斗杆和铲斗的质量进行计算,得到重力补偿参数K,作为前馈补偿量的一部分,与非线性PID校正器给出的控制量相加,作为电磁比例先导阀205的控制电流值,驱动电磁比例先导阀205的动作。
校正控制器中反馈控制采用非线性PID算法,其中KP随误差e变化的修正曲线形状如图11所示,当控制开始系统具有较快的响应速度,比例增益KP较大,当误差e逐渐减小时,比例增益随着减小;KD随误差e变化的修正曲线形状如图12所示,KI随误差e变化的修正曲线形状如图13所示,当误差e信号较大时,积分增益KI相对较小,防止产生震荡,减小超调量,当误差e较小时,积分增益KI增大,消除系统的稳态误差。
如下描述DSP控制器201按照预先设定的轨迹进行挖掘作业,如:平整场地、直线挖掘和示教挖掘作业。如图14所示,当用上述方式的挖掘机轨迹控制系统101进行平整场地作业时,铲斗108对地的倾角保持不变,铲斗齿尖处与地面平行运动。
在进行实时控制时,根据来自DSP控制器201的数据存储器中设定的铲斗齿尖在空间的目标位置和姿态,由DSP控制器201中的数据处理部分进行逆运算,获得动臂104、斗杆106与铲斗108的目标转动角度,DSP控制器201根据目标转动角度与实际角度的偏差大小,通过前馈补偿和反馈控制,产生相应的控制信号,控制先导比例电磁阀205动作,从而驱动相应的液压缸动作,使铲斗齿尖沿着预先设定的轨迹运动,实现各种挖掘作业。DSP控制器201通过存储在程序存储器中预先设定铲斗齿尖的直线运动空间坐标,由逆运动学计算获得动臂、斗杆和铲斗的目标相对转动角度,与经过传感器测量的动臂104、斗杆106和铲斗108的实际相对转动角度进行比较,根据偏差大小,由DSP控制器201输出控制部分产生PWM控制信号,经过信号放大电路203,驱动电磁比例先导阀205,使主控阀207动作,从而推动液压缸动作,使液压挖掘机工作装置102中的铲斗齿尖沿着平行于地面方向运动,实现平整场地作业。
如附图15所示,与平整场地作业过程相同,通过前面所述的运动学正运算后得出铲斗108在空间的位置坐标,以及目标位置坐标,然后由逆运算获得动臂104、斗杆106和铲斗108的目标相对转动角度,DSP控制器201通过计算,发出控制量,驱动相应的液压缸动作,按照预先设定的直线挖掘作业控制程序,实现直线挖掘作业。
示教挖掘作业就是首先由人工操纵挖掘机工作装置102,DSP控制器201分别按时间序列记录铲斗108、斗杆106和动臂104的相对转角,并将采集的信号存储在DSP控制器201的数据存储部分,示教操作完成后,由DSP控制器201根据存储的运行轨迹,重复上述操作,实现示教挖掘作业。
如上所述根据用于本发明的一种液压挖掘机工作装置轨迹控制系统101,提供一种用于液压挖掘机工作装置102轨迹控制系统,通过该控制系统101能够实现液压挖掘机工作装置102的自动操纵,精确而稳定地控制液压挖掘机的工作装置的位置和姿态,使工作装置按照预先设定的轨迹运动,完成作业任务,缩短作业周期,提高作业效率和作业质量,所以在液压挖掘机中采用该控制系统101,具有很高的实用性和应用价值。

Claims (10)

1.一种用于液压挖掘机工作装置的轨迹控制系统,包括有动臂液压缸(208)、斗杆液压缸(209)、铲斗液压缸(210),主控阀(207),电磁比例先导阀(205),齿轮泵(211),溢流阀(206),滤油器(212),动臂(104),斗杆(106),铲斗(108),其特征在于:
(1)、在动臂(104)与工作装置(102)的铰接处、动臂(104)与斗杆(106)的铰接处、斗杆(106)与铲斗(108)铰接处分别设置有动臂角度检测机构(103)、斗杆角度检测机构(105)、铲斗角度检测机构(107);
(2)、具有数字信号处理器Digital Signal Processor,以下简称DSP控制器(201),用于接收通过A/D数据转换送入的动臂角度检测机构(103)、斗杆角度检测机构(105)、铲斗角度检测机构(107)测量的角度信号,以及动臂液压缸(208)压力、斗杆液压缸(209)压力、铲斗液压缸(210)压力信号、发动机转速信号,得到角度的电压值,以及压力和转速电压值,对接收的数据,进行数据存储和处理;以及存储预先设定的工作装置的目标位置和姿态;通过对挖掘机工作装置中铲斗(108)的实际位置、姿态与预先设定的位置、姿态进行比较,产生校正信号;
(3)、DSP控制器(201)具有控制输出部分,用于发出控制指令,产生占空比不同的脉宽调制信号(以下简称PWM);由驱动放大部分将信号放大,产生相应的驱动电流,驱动先导电磁比例阀(205)动作;
(4)、DSP控制器(201)具有数据显示部分;用于显示液压挖掘机当前的工作状态、液压挖掘机工作装置(102)中铲斗(108)的空间位置和姿态信息;
(5)、具有操纵手柄(1、2),将操纵手柄移动信号通过数字量传输,以CAN总线的数据传输方式发送给DSP控制器(201)。
2.根据权利要求1所述的用于液压挖掘机工作装置的轨迹控制系统,其特征在于压力传感器(218、219、220)分别测量动臂液压缸(208)、斗杆液压缸(209)和铲斗液压缸(210)的压力,根据来自压力传感器的电压值获得各液压缸的负载信息。
3.根据权利要求1所述的用于液压挖掘机工作装置的轨迹控制系统,其特征在于DSP控制器(201)通过控制器局部网Control area net work,以下简称CAN总线,与其他控制器之间进行数据交换。
4.根据权利要求1所述的用于液压挖掘机工作装置的轨迹控制系统,其特征在于动臂角度检测机构(103)、斗杆角度检测机构(105)、铲斗角度检测机构(107)是采用转动式角度传感器,检测相对转动的角度。
5.一种用于液压挖掘机工作装置的轨迹控制方法,其特征在于:
(1)、由动臂角度检测机构(103)、斗杆角度检测机构(105)、铲斗角度检测机构(107)测量动臂(104)、斗杆(106)和铲斗(108)相对转动角度,将测量数据送入DSP控制器(201);
(2)、由数据转换部分根据角度传感器采集的角位移信息,通过计算换算成为计算机能够识别的数字量;
(3)、由DSP控制器(201)进行数据处理:测量得到的液压挖掘机工作装置(102)中动臂(104)、斗杆(106)和铲斗(108)相对转动角度信号,通过算法运算后获得工作装置中铲斗(108)的空间位置和姿态;反之,如果预先设定铲斗(108)在空间的位置和姿态,则可以通过逆运算获得工作装置中动臂(104)、斗杆(106)和铲斗(108)的相对转动角度;
(4)、由DSP控制器(201)进行校正器算法运算部分,根据工作装置中动臂、斗杆和铲斗的实际测量角度信号,与通过逆运算获得的相对转动角度相比较,产生校正信号;
(5)、由DSP控制器(201)输出控制信号:将校正器产生的校正信号,转换为相应的脉宽调制信号(以下简称PWM信号),通过放信号大,驱动电磁比例先导阀(205)动作,使主控阀(207)动作,从而推动液压缸动作;
(6)、由DSP控制器(201)进行数据存储,存储工作装置的位置和姿态的测量数据,在示教挖掘时,记录挖掘过程中动臂(104)、斗杆(106)和铲斗(108)的运行轨迹,控制系统根据记录的数据,形成自动挖掘时的挖掘轨迹序列,当控制器发出挖掘命令时,控制系统执行相应的控制算法,实现示教挖掘;数据存储部分还存储测量得到的数据,包括液压挖掘机工作装置(102)各机构的相对转动角度、发动机转速和液压缸压力等信息;存储预先设定的工作装置在典型作业时铲斗齿尖的运行轨迹信息。
(7)、由DSP控制器(201)将液压挖掘机当前的工作状态、液压挖掘机工作装置(102)中铲斗(108)的空间位置和姿态信息等送到显示部分进行显示;
(8)、通过操纵手柄(1、2)与DSP控制器(201)之间通过CAN总线方式进行数据传输。
6.根据权利要求5所述的用于液压挖掘机工作装置的轨迹控制方法,其特征在于:铲斗齿尖V的空间直角坐标系是以液压挖掘机回转中心作为坐标原点,Z轴与液压挖掘机回转中心线重合,垂直于地面方向,X轴与水平面重合,并指向挖掘机前进的方向,Y轴沿着水平面与X轴垂直。设定l0表示C点到Y轴的距离;d1表示C点到X轴的距离;l1表示动臂C点到F点的距离;l2表示动臂F点到Q点的距离;l3表示动臂Q点到V点的距离。θ1表示线段CF与水平面的夹角;θ2表示线段CF与FQ的夹角;θ3表示线段FQ与QV的夹角;  VxVyVZ表示铲斗在空间坐标系中的坐标,
Figure A2005102001860004C1
表示铲斗斗尖V与铲斗绞接点Q的连线与水平面的夹角;由DSP控制器(201)的数据处理部分计算铲斗齿尖在空间坐标系中的位置和姿态
Figure A2005102001860004C2
,通过逆运算获得工作装置中动臂(104)、斗杆(106)和铲斗(108)之间的相对转角θ1θ2θ3;测量得到的工作装置中动臂(104)、斗杆(106)和铲斗(108)相对转动角度θ1θ2θ3,通过算法运算后获得工作装置中铲斗齿尖的空间坐标。
7.根据权利要求5所述的用于液压挖掘机工作装置的轨迹控制方法,其特征在于:所述的控制算法是采用非线性PID算法,当DSP控制器(201)发出挖掘命令时,根据工作装置设定角度与实际角度的偏差,经非线性PID校正器进行计算,作为输入控制量,控制挖掘机工作装置(102)运动。
8.根据权利要求7所述的用于液压挖掘机工作装置的轨迹控制方法,其特征在于:在挖掘机工作装置(102)位置输出端取出信号,进行前馈校正,前馈校正产生的控制量与非线性PID校正器产生控制量一起,作为输入控制量。
9.根据权利要求7所述的用于液压挖掘机工作装置的轨迹控制方法,其特征在于:根据检测的角度,由动力学方程计算挖掘机工作装置(102)的重力力矩,获得重力补偿参数K,与非线性PID校正器产生控制量一起,作为输入控制量。
10.根据权利要求8所述的用于液压挖掘机工作装置的轨迹控制方法,其特征在于:前馈校正采用负载补偿系数Kf以及转速补偿系数Ke,在发动机上安装转速传感器,由DSP控制器(201)测得的发动机转速值,根据发动机转速变化增益补偿曲线,得到发动机增益补偿校正系数Ke,DSP控制器(201)输出的每个电磁比例先导阀的电流值与发动机转速补偿增益系数Ke相乘,将乘积作为修改过的电磁比例阀控制指令数值,输出到被控制的电磁比例先导阀(205),实现根据发动机转速变化而进行前馈补偿;DSP控制器(201)根据动臂液压缸(208)斗杆液压缸(209)及铲斗液压缸(210)中的压力传感器(218、219、220)信息检测液压缸的压力值,通过负载增益校正曲线,得到负载校正增益Kf,控制部分输出的比例阀的PWM控制信号与其相乘,经过放大驱动后,作为电磁比例阀的输入控制信号,驱动电磁比例先导阀(205)动作,最终推动液压缸运动,实现对工作装置的位置和姿态的精确控制。
CNB2005102001866A 2005-03-28 2005-03-28 用于液压挖掘机工作装置的轨迹控制系统及方法 Expired - Fee Related CN100464036C (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CNB2005102001866A CN100464036C (zh) 2005-03-28 2005-03-28 用于液压挖掘机工作装置的轨迹控制系统及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CNB2005102001866A CN100464036C (zh) 2005-03-28 2005-03-28 用于液压挖掘机工作装置的轨迹控制系统及方法

Publications (2)

Publication Number Publication Date
CN1651666A true CN1651666A (zh) 2005-08-10
CN100464036C CN100464036C (zh) 2009-02-25

Family

ID=34876860

Family Applications (1)

Application Number Title Priority Date Filing Date
CNB2005102001866A Expired - Fee Related CN100464036C (zh) 2005-03-28 2005-03-28 用于液压挖掘机工作装置的轨迹控制系统及方法

Country Status (1)

Country Link
CN (1) CN100464036C (zh)

Cited By (78)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101169038B (zh) * 2006-10-27 2010-09-08 三一重型装备有限公司 全自动掘进机
CN101464681B (zh) * 2007-12-20 2011-03-30 比亚迪股份有限公司 一种伺服控制器及电液伺服系统
CN102041824A (zh) * 2010-12-09 2011-05-04 三一重机有限公司 一种挖掘机工作装置的自动控制系统及控制方法
CN102057166A (zh) * 2008-04-11 2011-05-11 伊顿公司 包括用于驱动多个可变负载的固定排量泵的液压系统及操作方法
CN102066670A (zh) * 2009-04-06 2011-05-18 日立建机株式会社 液压挖掘机的液压回路装置
CN102296661A (zh) * 2010-06-23 2011-12-28 广西柳工机械股份有限公司 混联式混合动力挖掘机能量管理与总成协调控制方法
WO2011160580A1 (zh) * 2010-06-22 2011-12-29 湖南三一智能控制设备有限公司 一种液压挖掘机的智能控制方法
CN102312462A (zh) * 2011-03-15 2012-01-11 陈海波 一种装载机动态负荷传感控制系统
CN102505727A (zh) * 2011-12-13 2012-06-20 三一重机有限公司 一种提高挖掘机调试效率的系统及方法
CN102518168A (zh) * 2011-12-08 2012-06-27 上海三一重机有限公司 液压系统控制装置及其控制方法及包括该装置的挖掘机
CN102535556A (zh) * 2012-01-09 2012-07-04 三一重工股份有限公司 用于提升挖掘机动力响应特性的系统和方法、挖掘机
CN102575453A (zh) * 2009-08-18 2012-07-11 罗伯特·博世有限公司 具有工作臂调节装置的移动式工作机及移动式工作机工作臂工作点调节的方法
US8244438B2 (en) 2008-01-31 2012-08-14 Caterpillar Inc. Tool control system
CN102691319A (zh) * 2011-03-21 2012-09-26 J.C.班福德挖掘机有限公司 工作机的连结装置
CN101981262B (zh) * 2008-02-29 2012-11-07 卡特彼勒公司 半自主的挖掘控制系统
CN102900121A (zh) * 2012-09-29 2013-01-30 张国军 一种用于工程机械的液压泵控制系统及方法
CN102947513A (zh) * 2010-06-23 2013-02-27 斗山英维高株式会社 建筑机械的作业轨迹控制装置及其方法
CN102995673A (zh) * 2012-12-19 2013-03-27 中联重科股份有限公司 一种拉绳定位控制方法、装置及系统
CN103154385A (zh) * 2011-10-06 2013-06-12 株式会社小松制作所 推土铲控制系统、建筑机械和推土铲控制方法
CN103233493A (zh) * 2013-05-05 2013-08-07 吉林大学 矿用挖掘机挖掘力监测及自动称量系统及方法
CN103362172A (zh) * 2012-03-29 2013-10-23 哈尼施费格尔技术公司 用于挖掘机的碰撞探测和减缓系统及其方法
CN101999070B (zh) * 2007-11-30 2013-12-11 卡特彼勒公司 具有重心补偿的有效负载系统
CN103732832A (zh) * 2012-08-06 2014-04-16 株式会社小松制作所 作业机械及作业机械的推土铲的自动控制方法
CN103842663A (zh) * 2011-10-07 2014-06-04 沃尔沃建造设备有限公司 用于施工机械的操作工作装置的控制系统
CN103857853A (zh) * 2012-10-05 2014-06-11 株式会社小松制作所 挖掘机械的显示系统及挖掘机械
CN103857852A (zh) * 2012-10-05 2014-06-11 株式会社小松制作所 挖掘机械的显示系统及挖掘机械
CN103988051A (zh) * 2011-12-01 2014-08-13 诺思罗普·格鲁曼·利特夫有限责任公司 调节装置、转速传感器和借助谐波期望值信号驱动调节装置的方法
CN104520511A (zh) * 2014-09-05 2015-04-15 株式会社小松制作所 液压挖掘机
CN104612194A (zh) * 2013-12-30 2015-05-13 柳州柳工挖掘机有限公司 挖掘机工作装置回转的控制方法
US9043098B2 (en) 2012-10-05 2015-05-26 Komatsu Ltd. Display system of excavating machine and excavating machine
CN104781478A (zh) * 2012-11-19 2015-07-15 株式会社小松制作所 挖掘机械的显示系统以及挖掘机械
CN105102726A (zh) * 2014-06-04 2015-11-25 株式会社小松制作所 建筑机械的控制系统、建筑机械及建筑机械的控制方法
CN105259888A (zh) * 2015-10-29 2016-01-20 上海华兴数字科技有限公司 一种挖掘机示教控制系统、方法及挖掘机
CN105339560A (zh) * 2014-06-03 2016-02-17 株式会社小松制作所 挖掘机械的控制系统以及挖掘机械
CN105804137A (zh) * 2014-12-31 2016-07-27 徐工集团工程机械股份有限公司 一种液压挖掘机及其进行平地控制的方法
WO2016123735A1 (en) * 2015-02-02 2016-08-11 Guangxi Liugong Machinery Co., Ltd. Lifting arrangement for construction machine
CN106170595A (zh) * 2015-02-02 2016-11-30 广西柳工机械股份有限公司 用于建筑机械的提升布置
CN106168045A (zh) * 2016-07-16 2016-11-30 谭琛 液压挖掘机防倾覆系统
CN106351280A (zh) * 2016-10-26 2017-01-25 太原理工大学 基于前馈补偿的混合动力工程机械节能方法
CN106381899A (zh) * 2016-08-30 2017-02-08 中国航空工业集团公司西安飞行自动控制研究所 一种电传挖掘机位置闭环控制装置和方法
CN107250466A (zh) * 2015-03-05 2017-10-13 株式会社小松制作所 作业机械的图像显示系统、作业机械的远程操作系统以及作业机械
CN107558530A (zh) * 2017-08-09 2018-01-09 中国航空工业集团公司西安飞行自动控制研究所 一种电传挖掘机的辅助修坡作业功能实现方法
CN107709674A (zh) * 2015-06-16 2018-02-16 科派克系统公司 用于确定竖直位置的方法和电子控制单元
CN107882103A (zh) * 2017-10-26 2018-04-06 南京工业大学 一种挖掘机三维姿态显示及远程自动控制系统
CN107882080A (zh) * 2017-11-08 2018-04-06 苏州蓝博控制技术有限公司 挖掘机精细工作控制方法、系统及挖掘机
CN105121751B (zh) * 2014-04-24 2018-04-27 株式会社小松制作所 作业车辆
JP2018097722A (ja) * 2016-12-15 2018-06-21 三菱重工業株式会社 制御装置、制御方法、プログラム
CN108291385A (zh) * 2015-12-18 2018-07-17 住友重机械工业株式会社 挖土机及其控制方法
CN108474195A (zh) * 2015-12-28 2018-08-31 住友建机株式会社 挖土机
CN108643275A (zh) * 2018-06-06 2018-10-12 马鞍山松鹤信息科技有限公司 一种挖掘机轨迹规划与控制系统
CN108661111A (zh) * 2018-06-27 2018-10-16 潍柴动力股份有限公司 一种液压控制系统及方法
CN108699800A (zh) * 2016-06-09 2018-10-23 日立建机株式会社 作业机械
CN108999228A (zh) * 2018-08-08 2018-12-14 太原科技大学 一种双层结构的挖掘机控制系统
CN109072583A (zh) * 2017-04-10 2018-12-21 株式会社小松制作所 建筑机械以及控制方法
CN109296024A (zh) * 2018-11-30 2019-02-01 徐州市产品质量监督检验中心 一种无人挖掘机采装位姿精度检测方法
CN109352678A (zh) * 2018-09-25 2019-02-19 珠海格力电器股份有限公司 机器人轴的重力补偿方法及装置、机器人
CN109564534A (zh) * 2017-03-28 2019-04-02 日立建机株式会社 工作数据存储装置
CN110195452A (zh) * 2019-06-13 2019-09-03 三一重机有限公司 挖掘机控制方法及系统
CN110455290A (zh) * 2019-07-17 2019-11-15 爱克斯维智能科技(苏州)有限公司 一种智能液压挖掘机的最优轨迹规划方法
CN110703650A (zh) * 2019-10-21 2020-01-17 北京易联创安科技发展有限公司 一种电磁阀电控手柄线性校正装置及其校正方法
CN111794298A (zh) * 2019-04-02 2020-10-20 赫克斯冈技术中心 将控制信号重新映射到工具的转动自由度的系统
CN112482485A (zh) * 2020-11-10 2021-03-12 徐州徐工挖掘机械有限公司 执行机构轨迹控制方法、装置、控制器以及存储介质
CN112601863A (zh) * 2018-08-31 2021-04-02 神钢建机株式会社 工程机械和评价装置
CN112962709A (zh) * 2020-07-31 2021-06-15 百度(美国)有限责任公司 工程机械设备及其作业轨迹规划方法和系统、存储介质
CN112975983A (zh) * 2021-03-16 2021-06-18 上海三一重机股份有限公司 作业机械的动臂矫正方法及装置
CN113006185A (zh) * 2021-02-08 2021-06-22 南京工程学院 一种挖掘机自动导航作业方法及系统
CN113216311A (zh) * 2021-05-19 2021-08-06 三一重机有限公司 挖掘机自适应控制方法、装置及挖掘机
CN113302362A (zh) * 2019-03-29 2021-08-24 株式会社小松制作所 作业机械的校正方法、作业机械的控制器以及作业机械
CN113445568A (zh) * 2021-08-09 2021-09-28 三一重机有限公司 挖掘机轨迹控制方法、装置及挖掘机
CN113526416A (zh) * 2020-04-14 2021-10-22 丹佛斯动力系统公司 改进的液压装置
CN113737885A (zh) * 2021-09-15 2021-12-03 北京拓疆者智能科技有限公司 挖掘机控制方法、装置、挖掘机及存储介质
CN114174597A (zh) * 2019-07-31 2022-03-11 住友重机械工业株式会社 挖土机
CN114319476A (zh) * 2021-12-30 2022-04-12 爱克斯维智能科技(苏州)有限公司 基于挖掘机的碎石高精度整平控制系统
WO2022110840A1 (zh) * 2020-11-25 2022-06-02 三一重机有限公司 主动降低挖掘机动作冲击的装置、方法及挖掘机
CN114908836A (zh) * 2022-06-20 2022-08-16 徐州徐工挖掘机械有限公司 一种挖掘轨迹规划调整方法
CN114991235A (zh) * 2022-06-02 2022-09-02 北京航空航天大学 一种正铲液压挖掘机人机协同智能控制方法及系统
CN115030247A (zh) * 2022-05-27 2022-09-09 三一重机有限公司 一种臂架位姿信息的校正方法、装置及挖掘机
CN115198818A (zh) * 2022-08-31 2022-10-18 上海三一重机股份有限公司 作业机械控制方法、装置、设备、介质及作业机械

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101859121B (zh) * 2010-04-14 2012-01-11 武汉船用机械有限责任公司 一种拖缆机液压马达遥控控制系统及其信号处理方法
CN101886405B (zh) * 2010-07-21 2012-01-11 山河智能装备股份有限公司 挖掘节能及平地高效的小型液压挖掘机主阀
CN102566598B (zh) * 2012-02-03 2015-04-01 三一汽车制造有限公司 一种工程机械及其控制方法、控制系统

Cited By (138)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101169038B (zh) * 2006-10-27 2010-09-08 三一重型装备有限公司 全自动掘进机
CN101999070B (zh) * 2007-11-30 2013-12-11 卡特彼勒公司 具有重心补偿的有效负载系统
CN101464681B (zh) * 2007-12-20 2011-03-30 比亚迪股份有限公司 一种伺服控制器及电液伺服系统
CN101932774B (zh) * 2008-01-31 2013-07-31 卡特彼勒公司 工具控制系统
US8244438B2 (en) 2008-01-31 2012-08-14 Caterpillar Inc. Tool control system
CN101981262B (zh) * 2008-02-29 2012-11-07 卡特彼勒公司 半自主的挖掘控制系统
CN102057166B (zh) * 2008-04-11 2014-12-10 伊顿公司 包括用于驱动多个可变负载的固定排量泵的液压系统及操作方法
CN102057166A (zh) * 2008-04-11 2011-05-11 伊顿公司 包括用于驱动多个可变负载的固定排量泵的液压系统及操作方法
CN102066670A (zh) * 2009-04-06 2011-05-18 日立建机株式会社 液压挖掘机的液压回路装置
CN102066670B (zh) * 2009-04-06 2014-05-21 日立建机株式会社 液压挖掘机的液压回路装置
CN102575453B (zh) * 2009-08-18 2015-11-25 罗伯特·博世有限公司 移动式工作机及移动式工作机工作臂工作点调节的方法
CN102575453A (zh) * 2009-08-18 2012-07-11 罗伯特·博世有限公司 具有工作臂调节装置的移动式工作机及移动式工作机工作臂工作点调节的方法
WO2011160580A1 (zh) * 2010-06-22 2011-12-29 湖南三一智能控制设备有限公司 一种液压挖掘机的智能控制方法
CN102296661A (zh) * 2010-06-23 2011-12-28 广西柳工机械股份有限公司 混联式混合动力挖掘机能量管理与总成协调控制方法
CN102947513B (zh) * 2010-06-23 2015-07-08 斗山英维高株式会社 建筑机械的作业轨迹控制装置及其方法
CN102296661B (zh) * 2010-06-23 2015-07-22 广西柳工机械股份有限公司 混联式混合动力挖掘机能量管理与总成协调控制方法
CN102947513A (zh) * 2010-06-23 2013-02-27 斗山英维高株式会社 建筑机械的作业轨迹控制装置及其方法
EP2586918A4 (en) * 2010-06-23 2014-10-29 Doosan Infracore Co Ltd APPARATUS AND METHOD FOR CONTROLLING A WORKING TRACK OF A CONSTRUCTION MACHINE
EP2586918A2 (en) * 2010-06-23 2013-05-01 Doosan Infracore Co., Ltd. Apparatus and method for controlling work trajectory of construction equipment
CN102041824B (zh) * 2010-12-09 2012-08-29 三一重机有限公司 一种挖掘机工作装置的自动控制系统及控制方法
CN102041824A (zh) * 2010-12-09 2011-05-04 三一重机有限公司 一种挖掘机工作装置的自动控制系统及控制方法
CN102312462A (zh) * 2011-03-15 2012-01-11 陈海波 一种装载机动态负荷传感控制系统
CN102691319B (zh) * 2011-03-21 2015-06-17 J.C.班福德挖掘机有限公司 工作机的连结装置
CN102691319A (zh) * 2011-03-21 2012-09-26 J.C.班福德挖掘机有限公司 工作机的连结装置
CN103154385A (zh) * 2011-10-06 2013-06-12 株式会社小松制作所 推土铲控制系统、建筑机械和推土铲控制方法
CN103154385B (zh) * 2011-10-06 2014-05-28 株式会社小松制作所 推土铲控制系统、建筑机械
CN103842663A (zh) * 2011-10-07 2014-06-04 沃尔沃建造设备有限公司 用于施工机械的操作工作装置的控制系统
CN103988051A (zh) * 2011-12-01 2014-08-13 诺思罗普·格鲁曼·利特夫有限责任公司 调节装置、转速传感器和借助谐波期望值信号驱动调节装置的方法
US9518824B2 (en) 2011-12-01 2016-12-13 Northrop Grumman Litef Gmbh Control device, rotation rate sensor and method of operating a control device with harmonic set point signal
CN102518168A (zh) * 2011-12-08 2012-06-27 上海三一重机有限公司 液压系统控制装置及其控制方法及包括该装置的挖掘机
CN102518168B (zh) * 2011-12-08 2015-04-08 上海三一重机有限公司 液压系统控制装置及其控制方法及包括该装置的挖掘机
CN102505727B (zh) * 2011-12-13 2014-08-20 三一重机有限公司 一种提高挖掘机调试效率的系统及方法
CN102505727A (zh) * 2011-12-13 2012-06-20 三一重机有限公司 一种提高挖掘机调试效率的系统及方法
CN102535556B (zh) * 2012-01-09 2014-11-19 三一重工股份有限公司 用于提升挖掘机动力响应特性的系统和方法、挖掘机
CN102535556A (zh) * 2012-01-09 2012-07-04 三一重工股份有限公司 用于提升挖掘机动力响应特性的系统和方法、挖掘机
CN103362172B (zh) * 2012-03-29 2016-12-28 哈尼施费格尔技术公司 用于挖掘机的碰撞探测和减缓系统及其方法
CN103362172A (zh) * 2012-03-29 2013-10-23 哈尼施费格尔技术公司 用于挖掘机的碰撞探测和减缓系统及其方法
CN103732832A (zh) * 2012-08-06 2014-04-16 株式会社小松制作所 作业机械及作业机械的推土铲的自动控制方法
CN103732832B (zh) * 2012-08-06 2015-06-03 株式会社小松制作所 作业机械及作业机械的推土铲的自动控制方法
CN102900121A (zh) * 2012-09-29 2013-01-30 张国军 一种用于工程机械的液压泵控制系统及方法
CN102900121B (zh) * 2012-09-29 2015-10-14 张国军 一种用于工程机械的液压泵控制系统及方法
CN103857852B (zh) * 2012-10-05 2015-06-24 株式会社小松制作所 挖掘机械的显示系统及挖掘机械
CN103857853A (zh) * 2012-10-05 2014-06-11 株式会社小松制作所 挖掘机械的显示系统及挖掘机械
CN103857853B (zh) * 2012-10-05 2015-07-08 株式会社小松制作所 挖掘机械的显示系统及挖掘机械
US9043098B2 (en) 2012-10-05 2015-05-26 Komatsu Ltd. Display system of excavating machine and excavating machine
CN103857852A (zh) * 2012-10-05 2014-06-11 株式会社小松制作所 挖掘机械的显示系统及挖掘机械
CN104781478B (zh) * 2012-11-19 2017-09-08 株式会社小松制作所 挖掘机械的显示系统以及挖掘机械
CN104781478A (zh) * 2012-11-19 2015-07-15 株式会社小松制作所 挖掘机械的显示系统以及挖掘机械
CN102995673B (zh) * 2012-12-19 2015-11-11 中联重科股份有限公司 一种拉绳定位控制方法、装置及系统
CN102995673A (zh) * 2012-12-19 2013-03-27 中联重科股份有限公司 一种拉绳定位控制方法、装置及系统
CN103233493B (zh) * 2013-05-05 2015-08-26 吉林大学 矿用挖掘机挖掘力监测及自动称量系统及方法
CN103233493A (zh) * 2013-05-05 2013-08-07 吉林大学 矿用挖掘机挖掘力监测及自动称量系统及方法
CN104612194A (zh) * 2013-12-30 2015-05-13 柳州柳工挖掘机有限公司 挖掘机工作装置回转的控制方法
CN105121751B (zh) * 2014-04-24 2018-04-27 株式会社小松制作所 作业车辆
CN105339560A (zh) * 2014-06-03 2016-02-17 株式会社小松制作所 挖掘机械的控制系统以及挖掘机械
US9945095B2 (en) 2014-06-03 2018-04-17 Komatsu Ltd. Control system of excavating machine and excavating machine
CN105339560B (zh) * 2014-06-03 2018-05-18 株式会社小松制作所 挖掘机械的控制系统以及挖掘机械
CN105102726A (zh) * 2014-06-04 2015-11-25 株式会社小松制作所 建筑机械的控制系统、建筑机械及建筑机械的控制方法
US9598841B2 (en) 2014-06-04 2017-03-21 Komatsu Ltd. Construction machine control system, construction machine, and construction machine control method
US9702119B2 (en) 2014-09-05 2017-07-11 Komatsu Ltd. Hydraulic excavator
CN104520511A (zh) * 2014-09-05 2015-04-15 株式会社小松制作所 液压挖掘机
CN104520511B (zh) * 2014-09-05 2016-06-01 株式会社小松制作所 液压挖掘机
DE112014000129B4 (de) * 2014-09-05 2016-03-03 Komatsu Ltd. Hydraulikbagger
CN105804137B (zh) * 2014-12-31 2018-03-09 徐工集团工程机械股份有限公司 一种液压挖掘机及其进行平地控制的方法
CN105804137A (zh) * 2014-12-31 2016-07-27 徐工集团工程机械股份有限公司 一种液压挖掘机及其进行平地控制的方法
CN106170595A (zh) * 2015-02-02 2016-11-30 广西柳工机械股份有限公司 用于建筑机械的提升布置
CN106164382A (zh) * 2015-02-02 2016-11-23 广西柳工机械股份有限公司 用于建筑机械的提升布置
CN106170595B (zh) * 2015-02-02 2019-04-23 广西柳工机械股份有限公司 用于建筑机械的提升布置
US9567724B2 (en) 2015-02-02 2017-02-14 Guangxi Liugong Machinery Co., Ltd. Lifting arrangement for a construction machine
WO2016123735A1 (en) * 2015-02-02 2016-08-11 Guangxi Liugong Machinery Co., Ltd. Lifting arrangement for construction machine
CN106164382B (zh) * 2015-02-02 2018-12-18 广西柳工机械股份有限公司 用于建筑机械的提升布置
US11384515B2 (en) 2015-03-05 2022-07-12 Komatsu Ltd. Image display system for work machine, remote operation system for work machine, and work machine
US10829910B2 (en) 2015-03-05 2020-11-10 Komatsu Ltd. Image display system for work machine, remote operation system for work machine, and work machine
CN107250466A (zh) * 2015-03-05 2017-10-13 株式会社小松制作所 作业机械的图像显示系统、作业机械的远程操作系统以及作业机械
KR20180018786A (ko) * 2015-06-16 2018-02-21 씨피에이씨 시스템스 에이비 수직 위치를 알아내기 위한 방법 및 전자 제어 유닛
CN107709674A (zh) * 2015-06-16 2018-02-16 科派克系统公司 用于确定竖直位置的方法和电子控制单元
KR102459914B1 (ko) 2015-06-16 2022-10-26 씨피에이씨 시스템스 에이비 수직 위치를 알아내기 위한 방법 및 전자 제어 유닛
CN107709674B (zh) * 2015-06-16 2021-04-09 科派克系统公司 用于确定竖直位置的方法和电子控制单元
CN105259888A (zh) * 2015-10-29 2016-01-20 上海华兴数字科技有限公司 一种挖掘机示教控制系统、方法及挖掘机
CN108291385A (zh) * 2015-12-18 2018-07-17 住友重机械工业株式会社 挖土机及其控制方法
CN108474195B (zh) * 2015-12-28 2021-05-07 住友建机株式会社 挖土机
CN108474195A (zh) * 2015-12-28 2018-08-31 住友建机株式会社 挖土机
CN108699800A (zh) * 2016-06-09 2018-10-23 日立建机株式会社 作业机械
CN108699800B (zh) * 2016-06-09 2020-08-11 日立建机株式会社 作业机械
CN106168045A (zh) * 2016-07-16 2016-11-30 谭琛 液压挖掘机防倾覆系统
CN106381899A (zh) * 2016-08-30 2017-02-08 中国航空工业集团公司西安飞行自动控制研究所 一种电传挖掘机位置闭环控制装置和方法
CN106351280A (zh) * 2016-10-26 2017-01-25 太原理工大学 基于前馈补偿的混合动力工程机械节能方法
JP2018097722A (ja) * 2016-12-15 2018-06-21 三菱重工業株式会社 制御装置、制御方法、プログラム
CN109564534A (zh) * 2017-03-28 2019-04-02 日立建机株式会社 工作数据存储装置
CN109564534B (zh) * 2017-03-28 2023-05-23 日立建机株式会社 工作数据存储装置
CN109072583A (zh) * 2017-04-10 2018-12-21 株式会社小松制作所 建筑机械以及控制方法
US10822769B2 (en) 2017-04-10 2020-11-03 Komatsu Ltd. Earthmoving machine and control method
CN107558530A (zh) * 2017-08-09 2018-01-09 中国航空工业集团公司西安飞行自动控制研究所 一种电传挖掘机的辅助修坡作业功能实现方法
CN107558530B (zh) * 2017-08-09 2020-02-14 中国航空工业集团公司西安飞行自动控制研究所 一种电传挖掘机的辅助修坡作业功能实现方法
CN107882103B (zh) * 2017-10-26 2019-09-10 南京工业大学 一种挖掘机三维姿态显示及远程自动控制系统
CN107882103A (zh) * 2017-10-26 2018-04-06 南京工业大学 一种挖掘机三维姿态显示及远程自动控制系统
CN107882080A (zh) * 2017-11-08 2018-04-06 苏州蓝博控制技术有限公司 挖掘机精细工作控制方法、系统及挖掘机
CN108643275A (zh) * 2018-06-06 2018-10-12 马鞍山松鹤信息科技有限公司 一种挖掘机轨迹规划与控制系统
CN108661111A (zh) * 2018-06-27 2018-10-16 潍柴动力股份有限公司 一种液压控制系统及方法
CN108999228A (zh) * 2018-08-08 2018-12-14 太原科技大学 一种双层结构的挖掘机控制系统
CN112601863A (zh) * 2018-08-31 2021-04-02 神钢建机株式会社 工程机械和评价装置
CN109352678A (zh) * 2018-09-25 2019-02-19 珠海格力电器股份有限公司 机器人轴的重力补偿方法及装置、机器人
CN109352678B (zh) * 2018-09-25 2020-11-27 珠海格力电器股份有限公司 机器人轴的重力补偿方法及装置、机器人
CN109296024B (zh) * 2018-11-30 2023-04-07 徐州市产品质量监督检验中心 一种无人挖掘机采装位姿精度检测方法
CN109296024A (zh) * 2018-11-30 2019-02-01 徐州市产品质量监督检验中心 一种无人挖掘机采装位姿精度检测方法
CN113302362B (zh) * 2019-03-29 2023-03-14 株式会社小松制作所 作业机械的校正方法、作业机械的控制器以及作业机械
US11834812B2 (en) 2019-03-29 2023-12-05 Komatsu Ltd. Method for calibrating work machine, controller for work machine, and work machine
CN113302362A (zh) * 2019-03-29 2021-08-24 株式会社小松制作所 作业机械的校正方法、作业机械的控制器以及作业机械
CN111794298A (zh) * 2019-04-02 2020-10-20 赫克斯冈技术中心 将控制信号重新映射到工具的转动自由度的系统
US11505918B2 (en) 2019-04-02 2022-11-22 Hexagon Technology Center Gmbh System for remapping a control signal for excavator arm movement to a rotatory degree of freedom of a tool
CN111794298B (zh) * 2019-04-02 2022-04-05 赫克斯冈技术中心 用于控制挖掘机的多个连杆的移动的系统
CN110195452A (zh) * 2019-06-13 2019-09-03 三一重机有限公司 挖掘机控制方法及系统
CN110455290A (zh) * 2019-07-17 2019-11-15 爱克斯维智能科技(苏州)有限公司 一种智能液压挖掘机的最优轨迹规划方法
CN110455290B (zh) * 2019-07-17 2020-12-08 爱克斯维智能科技(苏州)有限公司 一种智能液压挖掘机的最优轨迹规划方法
CN114174597A (zh) * 2019-07-31 2022-03-11 住友重机械工业株式会社 挖土机
CN114174597B (zh) * 2019-07-31 2024-01-16 住友重机械工业株式会社 挖土机
CN110703650A (zh) * 2019-10-21 2020-01-17 北京易联创安科技发展有限公司 一种电磁阀电控手柄线性校正装置及其校正方法
CN110703650B (zh) * 2019-10-21 2020-10-23 北京易联创安科技发展有限公司 一种电磁阀电控手柄线性校正方法
CN113526416A (zh) * 2020-04-14 2021-10-22 丹佛斯动力系统公司 改进的液压装置
US11939739B2 (en) 2020-04-14 2024-03-26 Danfoss Power Solutions Inc. Hydraulic arrangement
CN112962709A (zh) * 2020-07-31 2021-06-15 百度(美国)有限责任公司 工程机械设备及其作业轨迹规划方法和系统、存储介质
US11624171B2 (en) 2020-07-31 2023-04-11 Baidu Usa Llc Engineering machinery equipment, and method, system, and storage medium for operation trajectory planning thereof
CN112482485A (zh) * 2020-11-10 2021-03-12 徐州徐工挖掘机械有限公司 执行机构轨迹控制方法、装置、控制器以及存储介质
WO2022110840A1 (zh) * 2020-11-25 2022-06-02 三一重机有限公司 主动降低挖掘机动作冲击的装置、方法及挖掘机
CN113006185A (zh) * 2021-02-08 2021-06-22 南京工程学院 一种挖掘机自动导航作业方法及系统
WO2022193925A1 (zh) * 2021-03-16 2022-09-22 上海三一重机股份有限公司 作业机械的动臂矫正方法及装置
CN112975983B (zh) * 2021-03-16 2022-04-01 上海三一重机股份有限公司 作业机械的动臂矫正方法及装置
CN112975983A (zh) * 2021-03-16 2021-06-18 上海三一重机股份有限公司 作业机械的动臂矫正方法及装置
CN113216311A (zh) * 2021-05-19 2021-08-06 三一重机有限公司 挖掘机自适应控制方法、装置及挖掘机
CN113445568A (zh) * 2021-08-09 2021-09-28 三一重机有限公司 挖掘机轨迹控制方法、装置及挖掘机
CN113737885A (zh) * 2021-09-15 2021-12-03 北京拓疆者智能科技有限公司 挖掘机控制方法、装置、挖掘机及存储介质
CN114319476A (zh) * 2021-12-30 2022-04-12 爱克斯维智能科技(苏州)有限公司 基于挖掘机的碎石高精度整平控制系统
CN115030247B (zh) * 2022-05-27 2023-10-31 三一重机有限公司 一种臂架位姿信息的校正方法、装置及挖掘机
CN115030247A (zh) * 2022-05-27 2022-09-09 三一重机有限公司 一种臂架位姿信息的校正方法、装置及挖掘机
CN114991235A (zh) * 2022-06-02 2022-09-02 北京航空航天大学 一种正铲液压挖掘机人机协同智能控制方法及系统
CN114908836A (zh) * 2022-06-20 2022-08-16 徐州徐工挖掘机械有限公司 一种挖掘轨迹规划调整方法
CN115198818A (zh) * 2022-08-31 2022-10-18 上海三一重机股份有限公司 作业机械控制方法、装置、设备、介质及作业机械
CN115198818B (zh) * 2022-08-31 2023-12-26 上海三一重机股份有限公司 作业机械控制方法、装置、设备、介质及作业机械

Also Published As

Publication number Publication date
CN100464036C (zh) 2009-02-25

Similar Documents

Publication Publication Date Title
CN1651666A (zh) 用于液压挖掘机工作装置的轨迹控制系统及方法
US8024095B2 (en) Adaptive work cycle control system
US9828781B2 (en) Fine implement control system using relative positioning
CN113605483B (zh) 一种挖掘机自动作业控制方法和装置
CN101918645B (zh) 装载机高度控制系统
CN109778941B (zh) 一种基于强化学习的半自主挖掘系统和方法
CN111733918B (zh) 挖掘机卸料作业辅助系统及轨迹规划方法
CN102041824A (zh) 一种挖掘机工作装置的自动控制系统及控制方法
WO2013013521A1 (zh) 一种平地机找平控制系统和控制方法及平地机
CN101903839A (zh) 持续的作业机具角度控制
US11686071B2 (en) Online machine learning for calibration of autonomous earth moving vehicles
CN101481918A (zh) 一种液压挖掘机铲斗运动的控制方法及控制装置
US11346086B1 (en) Machine learning for optimizing tool path planning in autonomous earth moving vehicles
CN110397108A (zh) 挖掘机控制方法、装置、服务器、车载设备及存储介质
CN110453749A (zh) 一种液压挖掘机智能挖掘系统及控制方法
CN113737885A (zh) 挖掘机控制方法、装置、挖掘机及存储介质
CN111042245A (zh) 一种挖掘机辅助作业控制方法及系统
JP2005180170A (ja) 作業工具を制御する方法およびシステム
CN1210570A (zh) 用于施工机械的控制设备
US20230305560A1 (en) Online machine learning for autonomous earth moving vehicle control
CN109296019A (zh) 挖掘机臂运动控制方法、系统及装置
JPWO2019049701A1 (ja) ショベル
US9752336B2 (en) Systems and methods for controlling an implement of a machine utilizing an orientation leveling system
Płonecki et al. A concept of digital control system to assist the operator of hydraulic excavators
Shao et al. Automatic excavation planning of hydraulic excavator

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
EE01 Entry into force of recordation of patent licensing contract

Assignee: JIANGSU LIUGONG MACHINERY Co.,Ltd.

Assignor: GUANGXI LIUGONG MACHINERY Co.,Ltd.

Contract record no.: 2011320000501

Denomination of invention: Path control system used for hydraulic digger operating device and its method

Granted publication date: 20090225

License type: Exclusive License

Open date: 20050810

Record date: 20110402

EC01 Cancellation of recordation of patent licensing contract

Assignee: JIANGSU LIUGONG MACHINERY Co.,Ltd.

Assignor: GUANGXI LIUGONG MACHINERY Co.,Ltd.

Contract record no.: 2011320000501

Date of cancellation: 20131205

LICC Enforcement, change and cancellation of record of contracts on the licence for exploitation of a patent or utility model
EE01 Entry into force of recordation of patent licensing contract

Application publication date: 20050810

Assignee: YANGZHOU LIUGONG CONSTRUCTION MACHINERY Co.,Ltd.

Assignor: GUANGXI LIUGONG MACHINERY Co.,Ltd.

Contract record no.: 2014320000010

Denomination of invention: Path control system used for hydraulic digger operating device and its method

Granted publication date: 20090225

License type: Exclusive License

Record date: 20140113

LICC Enforcement, change and cancellation of record of contracts on the licence for exploitation of a patent or utility model
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20090225