CN105121753B - 作业机械的校正装置及作业机械的作业装置参数的校正方法 - Google Patents

作业机械的校正装置及作业机械的作业装置参数的校正方法 Download PDF

Info

Publication number
CN105121753B
CN105121753B CN201580000442.9A CN201580000442A CN105121753B CN 105121753 B CN105121753 B CN 105121753B CN 201580000442 A CN201580000442 A CN 201580000442A CN 105121753 B CN105121753 B CN 105121753B
Authority
CN
China
Prior art keywords
drive division
work machine
work
forearm
large arm
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
Application number
CN201580000442.9A
Other languages
English (en)
Other versions
CN105121753A (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.)
Komatsu Ltd
Original Assignee
Komatsu 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 Komatsu Ltd filed Critical Komatsu Ltd
Publication of CN105121753A publication Critical patent/CN105121753A/zh
Application granted granted Critical
Publication of CN105121753B publication Critical patent/CN105121753B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/264Sensors and their calibration for indicating the position of the work tool
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; 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/30Dredgers; 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/32Dredgers; 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
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; 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/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/425Drive systems for dipper-arms, backhoes or the like
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2264Arrangements or adaptations of elements for hydraulic drives
    • E02F9/2271Actuators and supports therefor and protection therefor
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/264Sensors and their calibration for indicating the position of the work tool
    • E02F9/265Sensors 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)
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D5/00Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
    • G01D5/12Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means
    • G01D5/14Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing the magnitude of a current or voltage
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D5/00Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
    • G01D5/12Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means
    • G01D5/14Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing the magnitude of a current or voltage
    • G01D5/142Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing the magnitude of a current or voltage using Hall-effect devices
    • G01D5/145Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing the magnitude of a current or voltage using Hall-effect devices influenced by the relative movement between the Hall device and magnetic fields
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D5/00Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
    • G01D5/12Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means
    • G01D5/244Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means influencing characteristics of pulses or pulse trains; generating pulses or pulse trains
    • G01D5/24471Error correction
    • G01D5/2449Error correction using hard-stored calibration data
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D5/00Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
    • G01D5/26Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light
    • G01D5/32Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light
    • G01D5/34Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light the beams of light being detected by photocells
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D5/00Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
    • G01D5/26Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light
    • G01D5/32Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light
    • G01D5/34Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light the beams of light being detected by photocells
    • G01D5/347Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable characterised by optical transfer means, i.e. using infrared, visible, or ultraviolet light with attenuation or whole or partial obturation of beams of light the beams of light being detected by photocells using displacement encoding scales
    • G01D5/3473Circular or rotary encoders

Abstract

作业机械的校正装置具备:作业装置参数取得部(86),其取得构成第一驱动部及第二驱动部的部件的作业装置参数;计测值取得部(83A),其取得由外部计测装置计测到的作业机械主体、第一驱动部及第二驱动部的计测值;第一校正部(88),其基于由计测值取得部(83A)取得的第一驱动部的计测值,校正由作业装置参数取得部(86)取得的构成第一驱动部的部件的作业装置参数;第二校正部(89),其基于由第一校正部校正过的第一驱动部的作业装置参数和由计测值取得部取得的作业机械主体、第一驱动部及第二驱动部的基准点的计测值,校正构成第二驱动部的部件的作业装置参数。

Description

作业机械的校正装置及作业机械的作业装置参数的校正方法
技术领域
本发明涉及一种作业机械的校正装置及作业机械的作业装置参数的校正方法。
背景技术
以往,已知一种具备对作业装置的作业点的当前位置进行检测的位置检测装置的液压挖掘机。例如,在专利文献1所公开的液压挖掘机中,基于来自GPS天线的位置信息,运算铲斗的刃尖的位置坐标。具体而言,基于GPS天线和大臂销的位置关系、大臂、小臂和铲斗各自的长度、大臂、小臂及大臂和铲斗各自的方向角等参数,运算铲斗的刃尖的位置坐标。在此,在使小臂和铲斗转动的液压缸上设置行程传感器等,利用传感器取得液压缸的伸长状态,基于传感器输出值运算小臂和铲斗的位置坐标。
这种技术能够通过利用液压挖掘机的控制器推定铲斗的刃尖位置,使铲斗的刃尖仿照设计上的挖掘面进行动作,来防止铲斗对挖掘面的侵蚀,实现高效的挖掘作业。
因此,利用液压挖掘机的控制器正确把握铲斗的刃尖位置是重要的,在专利文献1所记载的技术中,例如,利用全站仪等外部计测装置计测作业装置的铲斗的刃尖的五个姿势,基于计测到的铲斗的刃尖的计测值,校正液压挖掘机的控制器计算刃尖位置的所需的作业装置参数。
现有技术文献
专利文献
专利文献1:(日本)特开2012-202061号公报
发明内容
发明所要解决的技术问题
然而,在所述专利文献1所记载的技术中,根据铲斗的刃尖位置校正大臂、小臂、铲斗的全部作业装置参数,因此,经过校正的作业装置参数会分别与真实值产生误差,故而存在如下问题:校正时的姿势以外的姿势下的铲斗的刃尖位置的推定精度与实际计测到的铲斗的刃尖位置的计测值相比较差,难以落入规定的误差范围内。
本发明的目的在于提供一种作业机械的校正装置及作业机械的作业装置参数的校正方法,该校正装置及校正方法能够在具备转动自如地连接于作业机械主体的第一驱动部和转动自如地连接于第一驱动部的第二驱动部的作业装置中,高精度地推定第二驱动部的基准点的位置。
用于解决技术问题的手段
本发明第一方式的作业机械的校正装置装备于作业机械,所述作业机械具备:作业机械主体;作业装置,其具备第一驱动部及第二驱动部,所述第一驱动部转动自如地连接于所述作业机械主体,由设于所述作业机械主体的第一液压缸驱动,所述第二驱动部转动自如地连接于所述第一驱动部,由设于所述第一驱动部的第二液压缸驱动;第一转动角检测部,其检测所述第一驱动部的转动角信息;第二转动角检测部,其检测所述第二驱动部的转动角信息;姿势运算部,其基于检测出的第一驱动部及第二驱动部的转动角信息,运算所述第一驱动部及所述第二驱动部的姿势;推定位置运算部,其基于对构成所述第一驱动部及所述第二驱动部的部件设定的作业装置参数和由所述姿势运算部运算出的所述第一驱动部及所述第二驱动部的姿势,运算所述第一驱动部及所述第二驱动部的基准点的推定位置;所述作业机械的校正装置校正所述作业装置参数,其特征在于,具备:计测值取得部,其取得由外部计测装置计测到的所述作业机械主体、所述第一驱动部及所述第二驱动部的基准点的计测值;作业装置参数取得部,其取得在所述推定位置运算部中使用的构成所述第一驱动部及所述第二驱动部的部件的作业装置参数;第一校正部,其基于由所述计测值取得部计测到的所述作业机械主体的基准点的计测值及所述第一驱动部的基准点的计测值,对构成所述第一驱动部的部件的作业装置参数进行校正;第二校正部,其基于由所述第一校正部校正过的构成所述第一驱动部的部件的作业装置参数和由所述计测值取得部取得的所述作业机械主体的基准点的计测值、所述第一驱动部的基准点的计测值及所述第二驱动部的基准点的计测值,对构成所述第二驱动部的部件的作业装置参数进行校正。
根据本发明的第一方式,能够利用第一校正部预先校正构成第一驱动部的部件的作业装置参数,因此在第二校正部中,能够基于校正后的作业装置参数和第二驱动部的基准点的计测值,进行构成第二驱动部的部件的作业装置参数的校正。因此,能够在减少构成第一驱动部的部件的作业装置参数的误差的状态下,高精度地校正构成第二驱动部的部件的作业装置参数。
本发明第二方式的作业机械的校正装置的特征在于,在第一方式中,所述第一转动角检测部及所述第二转动角检测部是设于所述第一液压缸及所述第二液压缸、检测各自的行程量的行程量检测部。
本发明第三方式的作业机械的校正装置的特征在于,在第二方式中,所述作业机械具备检测所述第一驱动部相对于所述作业机械主体的转动角的编码器,所述姿势运算部基于由所述编码器检测到的所述第一驱动部的转动角的基准位置,进行所述行程量检测部的基准位置的校正。
本发明第四方式的作业机械的校正装置的特征在于,在第一方式至第三方式的任一方式中,所述第一校正部及所述第二校正部通过进行收敛运算来进行校正,直到数值解析式收敛于规定的误差范围,所述数值解析式包括构成所述第一驱动部及所述第二驱动部的部件的作业装置参数和所述第一驱动部及所述第二驱动部的基准点的计测值,所述第二校正部的允许误差范围比所述第一校正部的允许误差范围大。
本发明第五方式的作业装置的特征在于,在第一方式至第四方式的任一方式中,所述第一驱动部具备:大臂,其经由销转动自如地连接于所述作业机械主体,由设于所述作业机械主体的大臂缸驱动;小臂,其经由销转动自如地连接于所述大臂的前端,由设于所述大臂的小臂缸驱动;所述第二驱动部是经由销连接于所述小臂的前端的作业件,所述第一驱动部的基准点是所述小臂的前端的销,所述第二驱动部的基准点是所述作业件的作业方向前端。
本发明第六方式的作业机械的校正装置的特征在于,在第五方式中,所述第一校正部基于所述作业机械的三个姿势对构成所述第一驱动部的部件的作业装置参数进行校正,所述第二校正部基于所述作业机械的两个姿势对构成所述第二驱动部的部件的作业装置参数进行校正。
本发明第七方式的作业装置的校正装置装备于作业机械,所述作业机械具备:作业机械主体;作业装置,其具备大臂、小臂及铲斗,所述大臂转动自如地连接于所述作业机械主体,由设于所述作业机械主体的大臂缸驱动,所述小臂转动自如地连接于所述大臂,由设于所述大臂的小臂缸驱动,所述铲斗转动自如地连接于所述小臂,由设于所述小臂的铲斗缸驱动;大臂转动角检测部,其检测所述大臂相对于所述作业机械主体的转动角信息;小臂转动角检测部,其检测所述小臂相对于所述大臂的转动角信息;铲斗转动角检测部,其检测所述铲斗相对于所述小臂的转动角信息;姿势运算部,其基于由所述大臂转动角检测部、所述小臂转动角检测部及所述铲斗转动角检测部检测到的各个转动角信息,运算所述大臂、所述小臂及所述铲斗的姿势;推定位置运算部,其基于对所述大臂、所述小臂、所述铲斗设定的作业装置参数和由所述姿势运算部运算出的所述大臂、所述小臂及所述铲斗的姿势,运算所述铲斗的刃尖的推定位置;所述作业机械的校正装置校正所述作业装置参数,其特征在于,具备:计测值取得部,其取得由外部计测装置计测到的所述作业机械主体的基准点的计测值、所述大臂的基准点的计测值、所述小臂的基准点的计测值及所述铲斗的基准点的计测值;作业装置参数取得部,其取得在所述推定位置运算部中使用的所述大臂、所述小臂及所述铲斗的作业装置参数;第一校正部,其基于由所述计测值取得部取得的所述作业机械主体、所述大臂及所述小臂的基准点的计测值,对所述大臂及所述小臂的作业装置参数进行校正;第二校正部,其基于由所述第一校正部校正过的所述大臂及所述小臂的作业装置参数、和由所述计测值取得部取得的所述作业机械主体、所述大臂、所述小臂及所述铲斗的基准点的计测值,校正所述铲斗的作业装置参数。
本发明第八方式的作业机械的作业装置参数的校正方法在作业机械中实施,所述作业机械具备:作业机械主体;作业装置,其具备第一驱动部及第二驱动部,所述第一驱动部转动自如地连接于所述作业机械主体,由设于所述作业机械主体的第一液压缸驱动,所述第二驱动部转动自如地连接于所述第一驱动部,由设于所述第一驱动部的第二液压缸驱动;第一转动角检测部,其检测所述第一驱动部的相对于作业机械的转动角信息;第二转动角检测部,其检测所述第二驱动部的相对于第一驱动部的转动角信息;姿势运算部,其基于检测出的第一驱动部及第二驱动部的转动角信息,运算所述第一驱动部及所述第二驱动部的姿势;推定位置运算部,其基于对构成所述第一驱动部及所述第二驱动部的部件设定的作业装置参数和由所述姿势运算部运算出的所述第一驱动部及所述第二驱动部的姿势,运算所述第一驱动部及所述第二驱动部的基准点的推定位置;所述作业机械的作业装置参数的校正方法校正所述作业装置参数,其特征在于,实施:取得对构成所述第一驱动部及所述第二驱动部的部件设定的作业装置参数的步骤;取得使用外部计测装置计测到的所述作业机械主体、所述第一驱动部及所述第二驱动部的基准点的计测值的步骤;基于所述作业机械主体及所述第一驱动部的基准点的计测值,对构成所述第一驱动部的部件的作业装置参数进行校正的步骤;基于经过校正的构成所述第一驱动部的部件的作业装置参数、和所述作业机械主体、所述第一驱动部及所述第二驱动部的基准点的计测值,对构成所述第二驱动部的部件的作业装置参数进行校正的步骤。
附图说明
图1是本发明的实施方式的作业机械的立体图。
图2A是所述实施方式的作业机械的侧视示意图。
图2B是所述实施方式的作业机械的后视示意图。
图2C是所述实施方式的作业机械的俯视示意图。
图3是所述实施方式的作业机械的控制框图。
图4是表示所述实施方式的第一编码器的安装位置的侧视图。
图5是表示所述实施方式的第一编码器的结构的立体图。
图6是表示所述实施方式的磁力传感器的结构的示意图。
图7是所述实施方式的作业机械的大臂的侧视图。
图8是所述实施方式的作业机械的小臂的侧视图。
图9是所述实施方式的作业机械的小臂及铲斗的侧视图。
图10是所述实施方式的作业机械的铲斗的侧视图。
图11是所述实施方式的作业机械的液压缸的侧视图。
图12是所述实施方式的作业机械的校正装置的功能框图。
图13是表示所述实施方式的外部计测装置对作业机械的计测步骤的流程图。
图14是用于说明所述实施方式的作业机械的大臂销位置的计测方法的示意图。
图15是用于说明所述实施方式的作业机械的铲斗销位置的计测方法的示意图。
图16是用于说明所述实施方式的作业机械的铲斗的刃尖位置的计测方法的示意图。
图17是用于说明所述实施方式的作用的流程图。
图18是用于说明所述实施方式的效果的示意图。
具体实施方式
以下,参照附图对本发明一实施方式的液压挖掘机的校正装置及校正方法进行说明。
[1]液压挖掘机1的整体结构
图1是利用本实施方式的校正装置实施校正的液压挖掘机1的立体图。液压挖掘机1具备作业机械主体2和作业装置3。
作业机械主体2具备下部行驶体4和上部回转体5,上部回转体5转动自如地设于下部行驶体4。
上部回转体5收纳后述的液压泵54和发动机54A等装置。
在上部回转体5上,在前部设有驾驶室6,在驾驶室6内,设有用于供操作人员落座的座椅、后述的显示输入装置71及操作装置51。
在下部行驶体4设有一对行驶装置4A,行驶装置4A具有履带4B,通过履带4B旋转,液压挖掘机1行驶。注意,在本实施方式中,以落座于座椅时操作人员的视线为基准规定前后左右。
作业装置3设于作业机械主体2的前部,具备大臂31、小臂32、铲斗33、大臂缸34、小臂缸35及铲斗缸36。注意,本发明的第一驱动部是由大臂31及小臂32构成的部分,第二驱动部是包括铲斗33、第一连杆部件40(后述)、第二连杆部件41(后述)的部分。
大臂31的基端部经由大臂销37转动自如地安装于作业机械主体2的前部。大臂销37相当于大臂31相对于上部回转体5的转动中心。
小臂32的基端部经由小臂销38能够转动地安装于大臂31的前端部。小臂销38相当于小臂32相对于大臂31的转动中心。
在小臂32的前端部,经由铲斗销39能够转动地安装有铲斗33。铲斗销39设于小臂32的前端,是本发明的第一驱动部的基准点,相当于铲斗33相对于小臂32的转动中心。第一驱动部的基准点可以设于大臂31或小臂32的任意位置。
大臂缸34、小臂缸35及铲斗缸36是分别由液压驱动而伸长缩短的液压缸。注意,大臂缸34或小臂缸35是本发明中所谓的第一液压缸,铲斗缸36是本发明中所谓的第二液压缸。
大臂缸34的基端部经由大臂缸底销34A能够转动地安装于上部回转体5。
另外,大臂缸34的前端部经由大臂缸顶销34B能够转动地安装于大臂31。大臂缸34通过利用液压进行伸缩来驱动大臂31。
小臂缸35的基端部经由小臂缸底销35A能够转动地安装于大臂31。
另外,小臂缸35的前端部经由小臂缸顶销35B能够转动地安装于小臂32。小臂缸35通过利用液压进行伸缩来驱动小臂32。
铲斗缸36的基端部经由铲斗缸底销36A能够转动地安装于大臂32。
另外,铲斗缸36的前端部经由铲斗缸顶销36B能够转动地安装于第一连杆部件40的一端及第二连杆部件41的一端。
第一连杆部件40的另一端经由第一连杆销40A转动自如地安装于小臂32的前端部。
第二连杆部件41的另一端经由第二连杆销41A转动自如地安装于铲斗33。铲斗缸36通过利用液压进行伸缩来驱动铲斗33。
图2A、图2B、图2C是示意性表示液压挖掘机1的结构的图。图2A是液压挖掘机1的侧视图。图2B是液压挖掘机1的后视图。图2C是液压挖掘机1的俯视图。如图2A所示,大臂31的长度即大臂销37与小臂销38之间的长度是L1。小臂32的长度即小臂销38与铲斗销39之间的长度是L2。铲斗33的长度即铲斗销39与铲斗33的刃尖P之间的长度是L3。注意,铲斗33的刃尖P是本发明的第二驱动部的基准点。第二驱动部的基准点也可以设于铲斗33上的任意位置。
在大臂缸34、小臂缸35和铲斗缸36上,分别设有作为转动角检测部的大臂缸行程传感器42、小臂缸行程传感器43及铲斗缸行程传感器44。
各缸行程传感器42~44是设置于液压缸34~36的侧方的、检测液压缸的行程的行程传感器,通过检测作为转动角信息的各液压缸34~36的行程长度,能够利用后述的显示控制器72的姿势运算部72C,运算大臂31相对于作业机械主体2的转动角、小臂32相对于大臂31的转动角和铲斗33相对于小臂32的转动角。注意,转动角检测部也可以代用于由在各作业装置的转动部安装的角度传感器进行的转动角信息的检测。
具体而言,后述的显示控制器72内的姿势运算部72C根据大臂缸行程传感器42所检测到的大臂缸34的行程长度,如图2A所示,运算大臂31相对于后述车体坐标系的z轴的转动角α。
显示控制器72内的姿势运算部72C根据小臂缸行程传感器43所检测到的小臂缸35的行程长度,运算小臂32相对于大臂31的转动角β。
显示控制器72内的姿势运算部72C根据铲斗缸行程传感器44所检测到的铲斗缸36的行程长度,运算铲斗33相对于小臂32的转动角γ。对于转动角α、β、γ的计算方法,将在后面详细说明。
另外,在大臂销37的位置设有第一编码器42A,在小臂销38的位置设有第二编码器43A。
第一编码器42A将大臂31的转动区域内的规定的角度位置作为基准位置,向显示控制器72的姿势运算部72C输出脉冲信号。
第二编码器43A将小臂32的转动区域内的规定的角度位置作为基准位置,向显示控制器72的姿势运算部72C输出脉冲信号。
在姿势运算部72C中,基于从第一编码器42A输出的脉冲信号,进行大臂缸行程传感器42的基准位置的校正,基于从第二编码器43A输出的脉冲信号,进行小臂缸行程传感器43的校正。
也就是说,第一编码器42A及第二编码器43A作为大臂缸行程传感器42及小臂缸行程传感器43的复位传感器发挥功能。
由此,将根据缸行程传感器42、43的检测结果得到的行程位置复位到基准位置来降低误差,能够高精度地推定小臂32的前端的铲斗销39的位置。
具体而言,如图4所示,大臂缸行程传感器42设于大臂缸34的缸筒341的前端,检测活塞342的行程量。第一编码器42A设于大臂31的转动位置,进行大臂缸行程传感器42的校正。如图5所示,该第一编码器42A具备发光部42A1、圆盘部42A2和感光部42A3。
发光部42A1具备对感光部42A3照射光线的发光元件。
圆盘部42A2被能够旋转地保持,在该圆盘部42A2上,沿圆周方向以规定间隔形成多个通孔42A4,在其内侧形成有一处通孔42A5。通孔42A5形成在与大臂31的转动区域内的基准位置对应的位置,例如大臂31的转动区域的大致中央。
感光部42A3在与发光部42A1对应的位置具备多个感光元件42A6,在感光元件42A6感受到光时输出脉冲信号。
在这样的第一编码器42A中,圆盘部42A2根据大臂31的转动而相应地转动。若通过圆盘部42A2的转动使得通孔42A5在发光部42A1的下部通过,则从发光部42A1照射出的光经由通孔42A5,被感光部42A3的感光元件42A6感受到。感受到光的感光元件42A6向姿势运算部72C输出脉冲信号。注意,设于小臂销38的第二编码器43A也是与上述相同的构造及作用。
姿势运算部72C在输入了脉冲信号时,读取大臂缸行程传感器42的信号值,进行基准位置的校正。
另一方面,铲斗33由于在耐水环境方面存在使用上的问题,因此无法使用编码器。因此,在铲斗缸36上设有磁力传感器44A,通过检测设置于铲斗缸36的磁铁的通过,来检测基准位置的通过。
如图6所示,磁力传感器44A安装于铲斗缸36的缸筒361的外部。磁力传感器44A沿活塞362的直动方向具有隔开规定距离地配置的两个传感器44B、44C。
传感器44B、44C设于已知的基准位置,在活塞362上,设有生成磁力线的磁铁44D。传感器44B、44C使由磁铁44D生成的磁力线透过来检测磁力(磁通密度),输出与磁力(磁通密度)对应的电信号(电压)。
由传感器44B、44C检测到的信号被输出到显示控制器72,在该显示控制器72中,基于传感器44B、44C的检测结果,进行将根据铲斗缸行程传感器44的检测结果得到的行程位置复位到基准位置的处理。
磁力传感器44A由于利用磁力检测基准位置,因此在铲斗33的行程精度上容易产生波动,与将编码器42A、43A作为复位传感器的大臂31和小臂32的情况相比,检测行程值的误差较大。
如图2A所示,作业机械主体2具备位置检测部45,该位置检测部45检测液压挖掘机1的作业机械主体2的当前位置。位置检测部45具有图1所示的RTK-GNSS(Real TimeKinematic-Global Navigation Satellite Systems:GNSS称作“全球导航卫星系统”)用的两根天线46、47和图2A所示的位置运算器48。注意,也可以在上部回转体5的上部设置扶手,天线46、47设置于扶手。
天线46、47以后述车体坐标系x-y-z的原点O为基准,沿x轴、y轴及z轴(参照图2A~图2C)隔开一定距离(分别为Lbdx、Lbdy、Lbdz)配置。
与由天线46、47接收到的GNSS电波对应的信号被输入到位置运算器48。位置运算器48检测天线46、47在全局坐标系中的当前位置。注意,全局坐标系用X-Y-Z表示,将水平面设为XY,将竖直方向设为Z。另外,全局坐标系是由GNSS计测到的坐标系,是以固定于地球的原点为基准的坐标系。
与此相对,后述车体坐标系是以固定于作业机械主体2(具体是上部回转体5)的原点O为基准的坐标系。
天线46(以下,也可以称作“基准天线46”)是用于检测作业机械主体2的当前位置的天线。天线47(以下,也可以称作“方向天线47”)是用于检测作业机械主体2(具体是上部回转体5)的方向的天线。位置检测部45利用基准天线46和方向天线47的位置,检测后述车体坐标系的x轴在全局坐标系中的方向角。注意,天线46、47也可以是GPS用的天线。
如图2所示,作业机械主体2具备计测车体的倾斜角的IMU49(InertialMeasurement Unit:惯性测量单元),利用该IMU49输出Y方向的侧倾角(θ1:参照图2B)及X方向的俯仰角(θ2:参照图2C)的角速度和加速度。
图3是表示液压挖掘机1的控制系统的结构的框图。
液压挖掘机1具备操作装置51、作业装置控制器52、液压控制回路53、液压泵54、液压马达61、发动机54A和显示系统70。
操作装置51具备作业装置操作杆55和作业装置操作检测部56。
作业装置操作杆55具备左右的操作杆55L、55R。通过左操作杆55L的左右操作进行上部回转体5的左右回转指令,通过左操作杆55L的前后操作指令小臂32的倾卸/挖掘。通过右操作杆55R的左右操作指令铲斗33的挖掘/倾卸,通过右操作杆55R的前后操作指令大臂31的下降/上升。
作业装置操作检测部56L、56R检测作业装置操作杆55的操作内容,将其作为检测信号向作业装置控制器52输出。来自作业装置操作杆55的对液压控制回路53的操作指令既可以是先导液压方式,也可以是电力杆方式,任一种都可以。在电力杆方式的情况下,利用电位计等将操作指令转换成电信号,输入到作业装置控制器52。在先导液压方式的情况下,利用通过杆操作而生成的先导液压驱动比例阀,调整工作油的流量。另外,利用压力传感器检测先导压力,将其转换成电信号并输入到作业装置控制器52。
行驶操作杆59是用于供操作人员操作液压挖掘机1的行驶的部件。基于行驶操作检测部60、行驶操作杆59的操作内容,进行液压向下部行驶体4的液压马达61的供给。
作业装置控制器52具备RAM和ROM等存储部52A及CPU等运算部52B。作业装置控制器52主要进行作业装置3的动作控制。作业装置控制器52根据作业装置操作杆55的操作生成用于使作业装置3动作的控制信号,并将其输出到液压控制回路53。
液压控制回路53具备比例控制阀、EPC阀等液压控制设备,基于来自作业装置控制器52的控制信号,控制从液压泵54向液压缸34~36供给的工作油的流量。
根据从液压控制回路53供给来的工作油驱动液压缸34~36,由此,作业装置3进行动作。
另外,基于回转操作杆的操作驱动比例控制阀,由此,驱动液压马达61,上部回转体5进行回转。注意,驱动上部回转体5的回转马达也可以不是液压驱动,而使用电动式。
在液压挖掘机1上搭载有显示系统70。显示系统70是用于向操作人员提供用于挖掘作业区域内的地面而形成为后述设计面那样的形状的信息的系统。显示系统70具备显示输入装置71、显示控制器72和校正部80。注意,显示系统70的各功能也可以设为单独的控制器。
显示输入装置71具备触摸板式的输入部71A和LCD(Liquid Crystal Display:液晶显示器)等显示部71B。显示输入装置71显示用于提供用来进行挖掘的信息的引导画面。另外,在引导画面中显示有各种键,操作人员通过触摸引导画面上的各种键,能够执行显示系统70的各种功能。
输入部71A是供操作人员输入计测值等各种信息的部分,由键盘、触摸板等构成。
显示控制器72执行显示系统70的各种功能。显示控制器72与作业装置控制器52能够通过无线或有线的通信手段相互进行通信。显示控制器72具备RAM、ROM等已知形式的存储部72A、CPU等位置运算部72B和姿势运算部72C。
位置运算部72B基于存储于存储部72A的各种数据和位置检测部45的检测结果,执行用于显示引导画面的各种运算。
姿势运算部72C基于缸行程传感器42~44的检测值,利用由设于大臂31、小臂32、铲斗33的各个缸行程传感器42~44检测的液压缸行程,运算姿势角即大臂31的转动角α、小臂32的转动角β、铲斗33的转动角γ。另外,姿势运算部72C在编码器42A、43A、磁力传感器44A中,对由各液压缸34~36的缸行程传感器42~44取得的行程值进行复位。并且,姿势运算部72C由IMU49的角速度、加速度,运算液压挖掘机1的侧倾角θ1、俯仰角θ2。
在显示控制器72的存储部72A中,预先作出并存储有设计地形数据。设计地形数据是关于三维的设计地形的形状及位置的信息。设计地形表示作业对象即地面的目标形状。显示控制器72基于设计地形数据和来自上述各种传感器的检测结果等数据,使引导画面显示于显示输入装置71。
另外,存储部72A存储作业装置参数。
[3]铲斗33的刃尖P的位置的运算方法
接下来,对上述铲斗33的刃尖P的位置的运算方法详细进行说明。显示控制器72的姿势运算部72C基于位置检测部45的检测结果及存储于存储部72A的多个参数,运算铲斗33的刃尖P的推定位置。
参数包括作业装置参数和天线参数。作业装置参数包括表示大臂31、小臂32和铲斗33的尺寸和转动角的多个参数。天线参数包括表示天线46、47与大臂31的位置关系的多个参数。
如图3所示,显示控制器72的位置运算部72B具备第一推定位置运算部72D和第二推定位置运算部72E。第一推定位置运算部72D基于作业装置参数,运算铲斗33的刃尖P在车体坐标系中的推定位置。
第二推定位置运算部72E根据天线参数、位置检测部45检测到的天线46、47在全局坐标系中的推定位置、第一推定位置运算部72D运算出的铲斗33的刃尖P在车体坐标系中的推定位置,运算铲斗33的刃尖P在全局坐标系中的推定位置。具体而言,铲斗33的刃尖P的推定位置以如下方式求出。
首先,如图2A、图2B、图2C所示,设定以上部回转体5的回转中心为原点O的车体坐标系x-y-z。注意,车体坐标系将车体前后方向设为x轴,将车体左右方向设为y轴,将车体竖直方向设为z轴。
另外,在以下的说明中,将大臂销37设为液压挖掘机1的基准位置。大臂销37的位置是指大臂销37在车宽方向上的中点的位置,但实际上是给出了大臂销37相对于车体坐标系的位置坐标。液压挖掘机1的基准位置可以在上部回转体5上任意地设定。
根据各缸行程传感器42、43、44的检测结果,运算上述大臂31、小臂32、铲斗33的当前的转动角α、β、γ。
铲斗33的刃尖P在车体坐标系中的坐标(x,y,z)是使用大臂31、小臂32、铲斗33的转动角α、β、γ和作为作业参数的大臂31、小臂32、铲斗33的长度L1、L2、L3,通过以下的数学式(1)运算得出的。
[数学式1]
x=L1sinα+L2sin(α+β)+L3sin(α+β+γ)
y=0
z=L1cosα+L2cos(α+β)+L3cos(α+β+γ)
···(1)
另外,由数学式(1)求出的铲斗33的刃尖P在车体坐标系中的坐标(x,y,z)通过以下的数学式(2)转换成全局坐标系中的坐标(X,Y,Z)。
[数学式2]
但是,ω、κ如以下的数学式(3)那样表示。
[数学式3]
κ=-θ3
···(3)
在此,如上所述,θ1是侧倾角,θ2是俯仰角。另外,如图2(C)所示,θ3是偏航角,是上述车体坐标系的x轴在全局坐标系中的方向角。因此,偏航角θ3是基于由位置检测部45检测到的基准天线46和方向天线47的位置运算得出的。(A,B,C)是车体坐标系的原点在全局坐标系中的坐标。
前述天线参数表示天线46、47与车体坐标系的原点的位置关系、即天线46、47与大臂销37在车宽方向上的中点的位置关系。
具体而言,如图2B及图2C所示,天线参数包括大臂销37与基准天线46之间在车体坐标系的x轴方向上的距离Lbbx、大臂销37与基准天线46之间在车体坐标系的y轴方向上的距离Lbby和大臂销37与基准天线46之间在车体坐标系的z轴方向上的距离Lbbz。另外,天线参数包括大臂销37与方向天线47之间在车体坐标系的x轴方向上的距离Lbdx、大臂销37与方向天线47之间在车体坐标系的y轴方向上的距离Lbdy和大臂销37与方向天线47之间在车体坐标系的z轴方向上的距离Lbdz。
(A,B,C)是基于天线46、47检测到的天线46、47在全局坐标系中的坐标和天线参数运算得出的。
显示控制器72基于以前述方式运算出的铲斗33的刃尖P的当前位置和存储于存储部72A的设计地形数据,运算三维设计地形和铲斗33的刃尖P的距离。该距离能够显示于显示部71B,或者用作进行挖掘控制时的参数。
接下来,对根据缸行程传感器42、43、44的检测结果运算大臂31、小臂32、铲斗33的当前的转动角α、β、γ的方法进行说明。
图7是大臂31的侧视图。大臂31的转动角α由以下的数学式(4)使用图7所示的作业装置参数表示。
[数学式4]
如图7所示,作为大臂31的作业装置参数的Lboom2_x是大臂缸底销34A与大臂销37之间在安装有大臂31的作业机械主体2的水平方向(即,相当于车体坐标系的x轴方向)上的距离。作为大臂31的作业装置参数的Lboom2_z是大臂缸底销34A与大臂销37之间在安装有大臂31的作业机械主体2的竖直方向(即,相当于车体坐标系的z轴方向)上的距离。作为大臂31的作业装置参数的Lboom1是大臂缸顶销34B与大臂销37之间的距离。作为大臂31的作业装置参数的Lboom2是大臂缸底销34A与大臂销37之间的距离。作为大臂31的作业装置参数的Lboom_cyl是大臂缸底销34A与大臂缸顶销34B之间的距离。作为大臂31的作业装置参数的Lboom1_z是大臂缸顶销34B与大臂销37之间在zboom轴方向上的距离。注意,在侧视下,将连结大臂销37与小臂销38的方向设为xboom轴,将与xboom轴垂直的方向设为zboom轴。作为大臂31的作业装置参数的Lboom1_x是大臂缸顶销34B与大臂销37之间在xboom轴方向上的距离。
图8是小臂32的侧视图。小臂32的转动角β由以下的数学式(5)使用图7及图8所示的作业装置参数表示。
[数学式5]
如图8所示,作为大臂31的作业装置参数的Lboom3_z是大臂缸底销35A与小臂销38之间在zboom轴方向上的距离。作为大臂31的作业装置参数的Lboom3_x是大臂缸底销35A与小臂销38之间在xboom轴方向上的距离。作为大臂31的作业装置参数的Lboom3是小臂缸底销35A与小臂销38之间的距离。如图8所示,作为小臂32的作业装置参数的Larm2是小臂缸顶销35B与小臂销38之间的距离。如图7所示,作为小臂32的作业装置参数的arm_cyl是小臂缸底销35A与小臂缸顶销35B之间的距离。
如图8所示,作为小臂32的作业装置参数的Larm2_x是小臂缸顶销35B与小臂销38之间在xarm2轴方向上的距离。作为小臂32的作业装置参数的Larm2_z是小臂缸顶销35B与小臂销38之间在zarm2轴方向上的距离。
注意,在侧视下,将连结小臂缸顶销35B与铲斗销39的方向设为xarm2轴,将与xarm2轴垂直的方向设为zarm2轴。作为小臂32的作业装置参数的Larm1_x是小臂销38与铲斗销39之间在xarm2轴方向上的距离。作为小臂32的作业装置参数的Larm1_z是小臂销38与铲斗销39之间在zarm2轴方向上的距离。另外,在侧视下,将连结小臂销38与铲斗销39的方向设为xarm1轴。小臂32的转动角β是xboom轴与xarm1轴之间所成的角。
图9是铲斗33及小臂32的侧视图。图10是铲斗33的侧视图。铲斗33的转动角γ由以下的数学式(6)使用图7至图10所示的作业装置参数表示。
[数学式6]
如图8所示,作为小臂32的作业装置参数的Larm3_z2是第一连杆销40A与铲斗销39之间在zarm2轴方向上的距离。作为小臂32的作业装置参数的Larm3_x2是第一连杆销40A与铲斗销39之间在xarm2轴方向上的距离。
如图10所示,作为小臂32的作业装置参数的Ltmp是铲斗缸顶销36B与铲斗销39之间的距离。作为小臂32的作业装置参数的Larm4是第一连杆销40A与铲斗销39之间的距离。作为铲斗33的作业装置参数的Lbucket1是铲斗缸顶销36B与第一连杆销40A之间的距离。作为铲斗33的作业装置参数的Lbucket3是铲斗缸顶销39与第二连杆销41A之间的距离。作为铲斗33的作业装置参数的Lbucket2是铲斗缸顶销36B与第二连杆销41A之间的距离。
如图10所示,作为铲斗33的作业装置参数的Lbucket4_x是铲斗销39与第二连杆销41A之间在xbucket轴方向上的距离。作为铲斗33的作业装置参数的Lbucket4_z是铲斗销39与第二连杆销41A之间在zbucket轴方向上的距离。
注意,在侧视下,将连结铲斗销39与铲斗33的刃尖P的方向设为xbucket轴,将与xbucket轴垂直的方向设为zbucket轴。铲斗33的转动角γ是xbucket轴与xarm1轴之间所成的角。上述Ltmp由以下的数学式(7)表示。
[数学式7]
注意,如图8所示,作为小臂32的作业装置参数的Larm3是铲斗缸底销36A与第一连杆销40A之间的距离。作为小臂32的作业装置参数的Larm3_x1是铲斗缸底销36A与铲斗销39之间在xarm2轴方向上的距离。作为小臂32的作业装置参数的Larm3_z1是铲斗缸底销36A与铲斗销39之间在zarm2轴方向上的距离。
另外,如图11所示,上述boom_cyl是大臂缸行程传感器42所检测到的大臂缸34的行程长度bss加上作为大臂31的作业装置参数的大臂缸偏置作业参数boft所得的值。同样,arm_cyl是小臂缸行程传感器43所检测到的小臂缸35的行程长度ass加上作为小臂32的作业装置参数的小臂缸偏置作业装置参数aoft所得的值。同样,bucket_cyl是铲斗缸行程传感器44所检测到的铲斗缸36的行程长度bkss加上包括铲斗缸36的最小距离的、作为铲斗33的作业装置参数的铲斗缸偏置作业装置参数bkoft所得的值。
[4]校正部80的结构
图3所示的校正部80在液压挖掘机1中是用于对运算上述转动角α、β、γ及铲斗33的刃尖P的位置所需的作业装置参数进行校正的部分。
校正部80具备校正运算部83,与液压挖掘机1及外部计测装置84一起构成用于校正上述作业装置参数的校正装置。外部计测装置84是计测铲斗33的刃尖P的位置的装置,例如可以使用全站仪。另外,校正部80能够通过车内通信来与显示控制器72进行数据通信。
构成校正部80的后述计测值取得部83A能够通过车内通信来与外部计测装置84进行数据通信。
校正运算部83由CPU等构成,基于由外部计测装置84计测到的计测值进行作业装置参数的校正。作业装置参数的校正例如在液压挖掘机1的出厂时、维护后的初始设定中执行。
作业参数的校正结果显示于显示输入装置71的显示部71B,操作人员通过确认该校正结果,能够确认校正是否良好、是否必须再次进行校正。
具体而言,如图12的功能框图所示,校正运算部83具备计测值取得部83A、坐标系转换部85、作业装置参数取得部86和参数校正部87。
坐标系转换部85是将由外部计测装置84计测到的计测值转换成车体坐标系的部分。转换成车体坐标系的计测值被输出到参数校正部87,向车体坐标系的具体转换详见后述。
作业装置参数取得部86是将存储于显示控制器72的存储部72A中的默认的作业装置参数读取出来的部分,读取出来的作业装置参数被输出到参数校正部87。注意,默认的作业装置参数根据需要使用图面值、通过尺寸测定等方法得到的值、上一次的校正值。
参数校正部87是基于已在坐标系转换部85中转换成车体坐标系的计测值,对从作业装置参数取得部86输出的默认的作业装置参数进行校正的部分,具备第一校正部88及第二校正部89。
第一校正部88是对由作业装置参数取得部86取得的大臂31及小臂32的作业装置参数进行校正的部分。
第二校正部89是使用由第一校正部88校正过的大臂31及小臂32的作业装置参数,基于此对铲斗33的作业装置参数进行校正的部分。
参数校正部87的各校正部88、89向显示部71B输出经过校正的大臂31、小臂32及铲斗33的作业装置参数。
[5]校正部80的校正步骤
[5-1]外部计测装置84的计测
图13是表示计测人员在校正时所进行的作业步骤的流程图。
首先,计测人员在大臂销37的正侧面隔开规定距离地设置外部计测装置84(步骤S1)。
接下来,计测人员对表示铲斗33的外形轮廓点与铲斗连接位置(铲斗销39)的位置关系的角度等作业装置参数进行计测(步骤S2)。铲斗33的作业装置尺寸测定也可以使用外部计测装置84来进行计测,但即便不使用外部计测装置84,也可以利用计测用具等直接进行计测,计测人员从显示输入装置71的输入部71A手动地进行输入。
计测人员利用外部计测装置84进行回转面的测定(步骤S3)。在利用全站仪计测的情况下,在回转面的测定中,使回转体变化多个回转角(偏航角θ3)并计测回转体的位置。通过在液压挖掘机1的作业机械主体2后部的配重等上安装棱镜等标记,从全站仪射出光波,并检测棱镜的反射光,能够测定回转体的位置,测定回转轨道的三个部位即可计测回转面。
计测人员利用外部计测装置84计测图14所示的大臂销37的侧面中心位置P1(步骤S4)。
在大臂销37的侧面中心位置P1的计测结束之后,如图15所示,操作人员驱动大臂31和小臂32,变更为多个作业姿势。计测人员对小臂32的前端的铲斗销39的各个位置进行计测(步骤S5)。对铲斗销39位置的计测,是在使大臂31最大限度地上升的位置P2、使大臂31向作业方向伸出且使小臂32向作业方向伸出的位置P3、使大臂31向作业方向伸出且将小臂32拉近的位置P4这三个姿势下进行计测。注意,对铲斗销39位置的计测并不局限于三个姿势,可以任意地决定。
接下来,如图16所示,操作人员驱动铲斗33,变更为多个铲斗姿势。计测人员计测铲斗33的刃尖P的位置(步骤S6)。对铲斗33的刃尖P位置的计测,是在伸出铲斗33的位置P5和拉回铲斗33的位置P6这两个姿势下进行计测。注意,铲斗33的计测姿势并不局限于两个姿势,可以任意地决定。
最后,计测人员进行GPS位置的测定(步骤S7)。
注意,在以上说明的步骤S2~步骤S7中计测到的各计测值每当被计测时便输出到校正部80的计测值取得部83A,从外部计测装置84输入的各计测值依次通过坐标系转换部85进行从全局坐标系向车体坐标系的坐标转换。
[5-2]校正部80中的校正处理
接下来,基于图17所示的流程图对校正部80中的参数的校正处理进行说明。
作业装置参数取得部86从显示控制器72的存储部72A进行作业装置参数的读取,并将其输出到参数校正部87(步骤S8)。
从外部计测装置84输出的计测值被输入到计测值取得部83A(步骤S9)。坐标系转换部85将输入到计测值取得部83A的计测值转换成车体坐标系(步骤S10)。
在此,将计测值转换为车体坐标系的方法,是从图15所示的铲斗销39的计测位置P2~P4求出作业装置3的作业平面,求出作业平面的法线单位向量和重心坐标,将图14所示的大臂销37的计测位置P1投影到作业平面上。
接下来,求出回转面,并求出其法线单位向量。取回转面及作业平面的两个法线向量的外积,求出液压挖掘机1的前后方向的向量。
基于求出的前后方向的向量和求出的作业平面,求出上下方向的向量(与前后方向向量正交且作业平面内的向量)。另外,基于前后方向的向量和求出的回转面,求出左右方向的向量(与前后方向向量正交且回转面内的向量)。
基于这些前后、左右、上下方向,求出从计测值的坐标系转换成车体坐标系的旋转矩阵,并转换成以大臂销37为原点的车体坐标系的位置信息。
接下来,第一校正部88基于计测位置P2~P4的坐标和由姿势运算部72C运算出的此时的姿势,通过收敛运算,求出大臂31及小臂32的作业装置参数(步骤S11)。具体而言,如以下的数学式(8)所示,通过最小二乘法,进行作业装置参数的校正值的收敛运算。
[数学式8]
上述k的值相当于图15中的计测位置P2~P4。因此,n=3。(x1,z1)是计测位置P2在车体坐标系中的坐标。(x2,z2)是计测位置P3在车体坐标系中的坐标。(x3,z3)是计测位置P4在车体坐标系中的坐标。通过探索该数学式(8)的函数J1变为最小的点,运算出作业装置参数的校正值。
第一校正部88判定数学式(8)的值是否进入了规定的允许范围(步骤S12)。
在误差尚未进入规定的允许范围内的情况下,第一校正部88判定收敛运算是否在规定次数以内(步骤S13)。在收敛运算不足规定次数(N)的情况下,返回步骤S11。
在收敛运算达到规定次数(N)的情况下,在显示部71B上显示校正作业失败的意思,使计测人员及操作人员识别,不进入下一步骤(步骤S14)。
计测人员及操作人员返回步骤S8,重复步骤S8~步骤S11。
若第一校正部88判定为误差进入了规定的允许范围内,则在显示部71B上显示误差已落入允许范围内这一信息(步骤S14),使计测人员及操作人员识别,进行作业装置参数的修正(步骤S15),第一校正部88许可进入下一步骤。
第一校正部88将经过校正的大臂31及小臂32的作业装置参数输出到第二校正部89。
第二校正部89基于由第一校正部88校正过的作业装置参数、取计测位置P5、P6的多个作业装置姿势时的计测位置的计测值、和由姿势运算部72C运算出的此时的姿势,通过收敛运算,求出铲斗33的作业装置参数的校正值(步骤S16)。具体而言,第二校正部89利用取计测位置P5、计测位置P6的多个铲斗姿势时的计测位置的坐标、和此时的液压缸行程长度,通过收敛运算求出作业装置参数。具体而言,基于下述数学式(9),进行作业装置参数的校正值的收敛运算。
[数学式9]
在数学式(9)中,k的值是图16中的计测位置P5、P6。因此,n=2。(x4,y4)是计测位置P5在车体坐标系中的坐标。(x5,y5)是计测位置P6在车体坐标系中的坐标。通过探索数学式(9)的函数J2变为最小的点,运算出作业装置参数的校正值。
第二校正部89判定数学式(9)的J2是否进入了规定的允许范围内(步骤S17)。
在误差尚未进入规定的允许范围内的情况下,第二校正部89判定收敛运算是否在规定次数以内(步骤S18)。在收敛运算不足规定次数(N)的情况下,返回步骤S16。
在收敛运算达到规定次数(N)的情况下,在显示部71B上显示校正作业失败的意思,使计测人员及操作人员识别,不进入下一步骤(步骤S19)。
若第二校正部89判定为误差进入了规定的允许范围内,则在显示部71B上显示误差已落入允许范围内这一信息,使计测人员及操作人员识别(步骤S19)。
参数校正部87将经过校正的作业装置参数输出到显示控制器72,将其作为新的作业装置文件的参数写入显示控制器72的存储部72A(步骤S20)。
注意,在本实施方式中,利用第一校正部88设定的允许误差设定为比利用第二校正部89设定的允许误差小的误差。若这样设定允许误差,则作业装置尺寸相对于铲斗33大的第一驱动部(大臂31及小臂32)的误差作为铲斗33的刃尖P的误差的主要原因,贡献比第二驱动部(铲斗33)的误差大。能够通过减小第一驱动部的作业装置参数的误差来减小刃尖P的误差。
[6]实施方式的效果
如图18所示,在液压挖掘机1的作业装置3的工作范围内使铲斗33的刃尖P的位置变化,确认了外部计测装置84对刃尖P位置的计测值与基于作业装置参数运算出的刃尖P位置的推定值的误差。
在通过以往的方法在五个姿势下校正刃尖P位置的情况下,在铲斗33的下方位置和作业方向前端侧,推定位置和计测位置的误差大。
与此相对,根据本实施方式,通过利用第一校正部88,使用误差小的构成第一驱动部的部件的液压缸行程,对校正第一驱动部的部件的作业装置参数进行校正,能够高精度地对构成第一驱动部的部件的参数进行校正。通过使用构成第一驱动部的部件的高精度地校正过的作业装置参数,对构成第二驱动部的部件的作业装置参数进行校正,与以往相比,还能够高精度地对构成第二驱动部的部件的作业装置参数进行校正。其结果为,刃尖P位置的计测位置与运算出的刃尖P位置的推定值的误差也变小。
由此,在作业装置3的整个动作区域内,误差变小。特别是在作业装置3的尺寸变长的情况下,误差的改善显著。
[6]实施方式的变形
注意,本发明并不限定于前述的实施方式,能够达成本发明的目的的范围内的变形、改良等也都包含在本发明中。
例如,在所述实施方式中,将液压挖掘机1作为校正的对象,但本发明并不局限于此,也可以应用于轮式装载机或其他作业机械。
另外,在所述实施方式中进行的外部计测装置84的计测步骤并不局限于此,也可以是其他的顺序。
附图标记说明
1…液压挖掘机;2…作业机械主体;3…作业装置;4…下部行驶体;4A…行驶装置;4B…履带;5…上部回转体;6…驾驶室;31…大臂;32…小臂;33…铲斗;34…大臂缸;34A…大臂缸底销;34B…大臂缸顶销;35…小臂缸;35A…小臂缸底销;35B…小臂缸顶销;36…铲斗缸;36A…铲斗缸底销;36B…铲斗缸顶销;37…大臂销;38…小臂销;39…铲斗销;40…第一连杆部件;40A…第一连杆销;41…第二连杆部件;41A…第二连杆销;42…大臂缸行程传感器;42A…第一编码器;42A1…发光部;42A2…圆盘部;42A3…感光部;42A4…通孔;42A5…通孔;42A6…感光元件;43…小臂缸行程传感器;43A…第二编码器;44…铲斗缸行程传感器;44A…磁力传感器;44B、44C…传感器;44D…磁铁;45…位置检测部;46…基准天线;47…方向天线;48…位置运算器;49…IMU;51…操作装置;52…作业装置控制器;52A…存储部;52B…运算部;53…液压控制回路;54…液压泵;54A…发动机;55…作业装置操作杆;55L…左操作杆;55R…右操作杆;56…作业装置操作检测部;59…回转操作杆;60…回转操作检测部;61…液压马达;70…显示系统;71…显示输入装置;71A…输入部;71B…显示部;72…显示控制器;72A…存储部;72C…姿势运算部;72D…第一推定位置运算部;72E…第二推定位置运算部;80…校正装置;81…输入部;82…显示部;83…校正运算部;83A…计测值取得部;84…外部计测装置;85…坐标系转换部;86…作业装置参数取得部;87…参数校正部;88…第一校正部;89…第二校正部;341…缸筒;342…活塞;361…缸筒;362…活塞;P…刃尖;α…转动角;β…转动角;γ…转动角;θ1…侧倾角;θ2…俯仰角;θ3…偏航角。

Claims (10)

1.一种作业机械的校正装置,装备于作业机械,
所述作业机械具备:
作业机械主体;
作业装置,其具备第一驱动部及第二驱动部,所述第一驱动部转动自如地连接于所述作业机械主体,由设于所述作业机械主体的第一液压缸驱动,所述第二驱动部转动自如地连接于所述第一驱动部,由设于所述第一驱动部的第二液压缸驱动;
第一转动角检测部,其检测所述第一驱动部相对于所述作业机械主体的转动角信息;
第二转动角检测部,其检测所述第二驱动部相对于所述第一驱动部的转动角信息;
姿势运算部,其基于检测出的第一驱动部及第二驱动部的转动角信息,运算所述第一驱动部及所述第二驱动部的姿势;
推定位置运算部,其基于对构成所述第一驱动部及所述第二驱动部的部件设定的作业装置参数和由所述姿势运算部运算出的所述第一驱动部及所述第二驱动部的姿势,运算所述第一驱动部及所述第二驱动部的基准点的推定位置;
所述作业机械的校正装置校正所述作业装置参数,其特征在于,具备:
计测值取得部,其取得由外部计测装置计测到的所述作业机械主体、所述第一驱动部及所述第二驱动部的基准点的计测值;
作业装置参数取得部,其取得在所述推定位置运算部中使用的构成所述第一驱动部及所述第二驱动部的部件的作业装置参数;
第一校正部,其基于由所述计测值取得部计测到的所述作业机械主体的基准点的计测值及所述第一驱动部的基准点的计测值,对构成所述第一驱动部的部件的作业装置参数进行校正;
第二校正部,其基于由所述第一校正部校正过的构成所述第一驱动部的部件的作业装置参数和由所述计测值取得部取得的所述作业机械主体的基准点的计测值、所述第一驱动部的基准点的计测值及所述第二驱动部的基准点的计测值,对构成所述第二驱动部的部件的作业装置参数进行校正。
2.根据权利要求1所述的作业机械的校正装置,其特征在于,
所述第一转动角检测部及所述第二转动角检测部是设于所述第一液压缸及所述第二液压缸、检测各自的行程量的行程量检测部。
3.根据权利要求2所述的作业机械的校正装置,其特征在于,
所述作业机械具备检测所述第一驱动部相对于所述作业机械主体的转动角的编码器,
所述姿势运算部基于由所述编码器检测到的所述第一驱动部的转动角的基准位置,进行所述行程量检测部的基准位置的校正。
4.根据权利要求1所述的作业机械的校正装置,其特征在于,
所述第一校正部及所述第二校正部通过进行收敛运算来进行校正,直到数值解析式收敛于规定的误差范围,所述数值解析式包括构成所述第一驱动部及所述第二驱动部的部件的作业装置参数和所述第一驱动部及所述第二驱动部的基准点的计测值,
所述第二校正部的允许误差范围比所述第一校正部的允许误差范围大。
5.根据权利要求2所述的作业机械的校正装置,其特征在于,
所述第一校正部及所述第二校正部通过进行收敛运算来进行校正,直到数值解析式收敛于规定的误差范围,所述数值解析式包括构成所述第一驱动部及所述第二驱动部的部件的作业装置参数和所述第一驱动部及所述第二驱动部的基准点的计测值,
所述第二校正部的允许误差范围比所述第一校正部的允许误差范围大。
6.根据权利要求3所述的作业机械的校正装置,其特征在于,
所述第一校正部及所述第二校正部通过进行收敛运算来进行校正,直到数值解析式收敛于规定的误差范围,所述数值解析式包括构成所述第一驱动部及所述第二驱动部的部件的作业装置参数和所述第一驱动部及所述第二驱动部的基准点的计测值,
所述第二校正部的允许误差范围比所述第一校正部的允许误差范围大。
7.根据权利要求1至权利要求6中任意一项所述的作业机械的校正装置,其特征在于,
所述第一驱动部具备:
大臂,其经由销转动自如地连接于所述作业机械主体,由设于所述作业机械主体的大臂缸驱动;
小臂,其经由销转动自如地连接于所述大臂的前端,由设于所述大臂的小臂缸驱动;
所述第二驱动部是经由销连接于所述小臂的前端的铲斗,
所述第一驱动部的基准点是所述小臂的前端的销,
所述第二驱动部的基准点是所述铲斗的作业方向前端。
8.根据权利要求7所述的作业机械的校正装置,其特征在于,
所述第一校正部基于所述作业机械的三个姿势对构成所述第一驱动部的部件的作业装置参数进行校正,
所述第二校正部基于所述作业机械的两个姿势对构成所述第二驱动部的部件的作业装置参数进行校正。
9.一种作业机械的校正装置,装备于作业机械,
所述作业机械具备:
作业机械主体;
作业装置,其具备大臂、小臂及铲斗,所述大臂转动自如地连接于所述作业机械主体,由设于所述作业机械主体的大臂缸驱动,所述小臂转动自如地连接于所述大臂,由设于所述大臂的小臂缸驱动,所述铲斗转动自如地连接于所述小臂,由设于所述小臂的铲斗缸驱动;
大臂转动角检测部,其检测所述大臂相对于所述作业机械主体的转动角信息;
小臂转动角检测部,其检测所述小臂相对于所述大臂的转动角信息;
铲斗转动角检测部,其检测所述铲斗相对于所述小臂的转动角信息;
姿势运算部,其基于由所述大臂转动角检测部、所述小臂转动角检测部及所述铲斗转动角检测部检测到的各个转动角信息,运算所述大臂、所述小臂及所述铲斗的姿势;
推定位置运算部,其基于对所述大臂、所述小臂、所述铲斗设定的作业装置参数和由所述姿势运算部运算出的所述大臂、所述小臂及所述铲斗的姿势,运算所述铲斗的刃尖的推定位置;
所述作业机械的校正装置校正所述作业装置参数,其特征在于,具备:
计测值取得部,其取得由外部计测装置计测到的所述作业机械主体的基准点的计测值、所述大臂的基准点的计测值、所述小臂的基准点的计测值及所述铲斗的基准点的计测值;
作业装置参数取得部,其取得在所述推定位置运算部中使用的所述大臂、所述小臂及所述铲斗的作业装置参数;
第一校正部,其基于由所述计测值取得部取得的所述作业机械主体、所述大臂及所述小臂的基准点的计测值,对所述大臂及所述小臂的作业装置参数进行校正;
第二校正部,其基于由所述第一校正部校正过的所述大臂及所述小臂的作业装置参数、和由所述计测值取得部取得的所述作业机械主体、所述大臂、所述小臂及所述铲斗的基准点的计测值,校正所述铲斗的作业装置参数。
10.一种作业机械的作业装置参数的校正方法,在作业机械中实施,
所述作业机械具备:
作业机械主体;
作业装置,其具备第一驱动部及第二驱动部,所述第一驱动部转动自如地连接于所述作业机械主体,由设于所述作业机械主体的第一液压缸驱动,所述第二驱动部转动自如地连接于所述第一驱动部,由设于所述第一驱动部的第二液压缸驱动;
第一转动角检测部,其检测所述第一驱动部的相对于所述作业机械主体的转动角信息;
第二转动角检测部,其检测所述第二驱动部的相对于所述第一驱动部的转动角信息;
姿势运算部,其基于检测出的第一驱动部及第二驱动部的转动角信息,运算所述第一驱动部及所述第二驱动部的姿势;
推定位置运算部,其基于对构成所述第一驱动部及所述第二驱动部的部件设定的作业装置参数和由所述姿势运算部运算出的所述第一驱动部及所述第二驱动部的姿势,运算所述第一驱动部及所述第二驱动部的基准点的推定位置;
所述作业机械的作业装置参数的校正方法校正所述作业装置参数,其特征在于,实施:
取得对构成所述第一驱动部及所述第二驱动部的部件设定的作业装置参数的步骤;
取得使用外部计测装置计测到的所述作业机械主体、所述第一驱动部及所述第二驱动部的基准点的计测值的步骤;
基于所述作业机械主体及所述第一驱动部的基准点的计测值,对构成所述第一驱动部的部件的作业装置参数进行校正的步骤;
基于经过校正的构成所述第一驱动部的部件的作业装置参数、和所述作业机械主体、所述第一驱动部及所述第二驱动部的基准点的计测值,对构成所述第二驱动部的部件的作业装置参数进行校正的步骤。
CN201580000442.9A 2015-03-27 2015-03-27 作业机械的校正装置及作业机械的作业装置参数的校正方法 Active CN105121753B (zh)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2015/059789 WO2015137526A1 (ja) 2015-03-27 2015-03-27 作業機械の較正装置、及び作業機械の作業機パラメータの較正方法

Publications (2)

Publication Number Publication Date
CN105121753A CN105121753A (zh) 2015-12-02
CN105121753B true CN105121753B (zh) 2017-05-03

Family

ID=54071957

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201580000442.9A Active CN105121753B (zh) 2015-03-27 2015-03-27 作业机械的校正装置及作业机械的作业装置参数的校正方法

Country Status (6)

Country Link
US (1) US9481984B2 (zh)
JP (1) JP5841300B1 (zh)
KR (1) KR101711413B1 (zh)
CN (1) CN105121753B (zh)
DE (1) DE112015000027B4 (zh)
WO (1) WO2015137526A1 (zh)

Families Citing this family (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9944210B2 (en) * 2016-04-11 2018-04-17 Deere & Company Auto calibration for bin position sensor
CN109716058B (zh) * 2016-10-31 2021-05-14 株式会社小松制作所 测量系统、作业机械及测量方法
JP6714534B2 (ja) * 2017-03-29 2020-06-24 日立建機株式会社 建設機械
US10422111B2 (en) * 2017-07-13 2019-09-24 Komatsu Ltd. Hydraulic excavator and hydraulic excavator calibration method
JP6714549B2 (ja) * 2017-07-26 2020-06-24 日立建機株式会社 建設機械のセンサ搭載位置判定システム及び判定方法
JP7275498B2 (ja) * 2018-08-23 2023-05-18 コベルコ建機株式会社 作業機械
JP7178854B2 (ja) * 2018-09-28 2022-11-28 株式会社小松製作所 作業機械のためのシステム及び方法
JP7245581B2 (ja) * 2018-10-10 2023-03-24 株式会社小松製作所 運搬車両に素材を積み込む作業機械を制御するためのシステム及び方法
DE102018126809A1 (de) * 2018-10-26 2020-04-30 Liebherr-France Sas System und Verfahren zum Bestimmen der Masse einer von einem Arbeitsgerät bewegten Nutzlast
JP7095628B2 (ja) * 2019-03-07 2022-07-05 日本電信電話株式会社 座標系変換パラメータ推定装置、方法及びプログラム
JP7245099B2 (ja) 2019-03-29 2023-03-23 株式会社小松製作所 作業機械の校正方法、作業機械のコントローラ、および作業機械
JP7255364B2 (ja) * 2019-05-31 2023-04-11 セイコーエプソン株式会社 移動体、センサーモジュール及びセンサーモジュールの較正方法
CN111623803B (zh) * 2020-07-09 2022-05-03 北京天玛智控科技股份有限公司 一种综采工作面倾角传感器自动校准系统及方法
CN114485530A (zh) * 2021-10-29 2022-05-13 许继时代技术有限公司 基于实时动态rtk的缘斗臂车绝缘斗臂姿态测量装置和方法

Family Cites Families (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001515236A (ja) * 1997-09-04 2001-09-18 ダイナログ インコーポレイテッド ロボット検査システムを較正するための方法
JP3827480B2 (ja) * 1999-08-13 2006-09-27 日立建機株式会社 自動運転建設機械およびその位置計測手段の校正方法
US7162348B2 (en) * 2002-12-11 2007-01-09 Hemisphere Gps Llc Articulated equipment position control system and method
FR2928387B1 (fr) * 2008-03-10 2012-11-16 Westline Procede et systeme de calibration automatique des engins de terrassement
US8401744B2 (en) * 2008-07-22 2013-03-19 Trimble Navigation Limited System and method for configuring a guidance controller
JP5237409B2 (ja) 2011-03-24 2013-07-17 株式会社小松製作所 油圧ショベルの較正装置及び油圧ショベルの較正方法
JP5237408B2 (ja) 2011-03-24 2013-07-17 株式会社小松製作所 油圧ショベルの較正システム及び較正方法
JP5328830B2 (ja) * 2011-03-24 2013-10-30 株式会社小松製作所 油圧ショベルの較正装置及び油圧ショベルの較正方法
JP2012233353A (ja) 2011-05-02 2012-11-29 Komatsu Ltd 油圧ショベルの較正システム及び油圧ショベルの較正方法
JP2015068071A (ja) * 2013-09-30 2015-04-13 日立建機株式会社 建設機械

Also Published As

Publication number Publication date
JPWO2015137526A1 (ja) 2017-04-06
KR101711413B1 (ko) 2017-03-02
US9481984B2 (en) 2016-11-01
US20160281334A1 (en) 2016-09-29
JP5841300B1 (ja) 2016-01-13
DE112015000027B4 (de) 2017-02-16
KR20160115676A (ko) 2016-10-06
CN105121753A (zh) 2015-12-02
WO2015137526A1 (ja) 2015-09-17
DE112015000027T5 (de) 2015-12-10

Similar Documents

Publication Publication Date Title
CN105121753B (zh) 作业机械的校正装置及作业机械的作业装置参数的校正方法
CN106170596B (zh) 作业机械的校正装置及作业机械的作业装置参数的校正方法
CN105636658B (zh) 液压挖掘机的校正系统以及校正方法
US9976286B2 (en) Work machine and correction method of working equipment parameter for work machine
CN103097614B (zh) 液压挖掘机的校准装置及液压挖掘机的校准方法
CN103080426B (zh) 液压挖掘机的校准系统及校准方法
CN103080427B (zh) 液压挖掘机的校正装置及液压挖掘机的校正方法
CN105339759B (zh) 作业机械的控制系统以及作业机械的控制方法
EP3597831A1 (en) Construction machinery
CN104781478B (zh) 挖掘机械的显示系统以及挖掘机械
CN105518226B (zh) 作业机械的控制系统和作业机械
CN109496245A (zh) 液压挖掘机以及液压挖掘机的校正方法
CN109072587A (zh) 施工系统及施工方法
CN109496264A (zh) 测定工具以及液压挖掘机的校正方法
CN114729520B (zh) 用于作业机械的校准的方法以及系统

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