US9903096B2 - Blade control apparatus, work vehicle, and method of controlling a blade - Google Patents

Blade control apparatus, work vehicle, and method of controlling a blade Download PDF

Info

Publication number
US9903096B2
US9903096B2 US14/428,470 US201414428470A US9903096B2 US 9903096 B2 US9903096 B2 US 9903096B2 US 201414428470 A US201414428470 A US 201414428470A US 9903096 B2 US9903096 B2 US 9903096B2
Authority
US
United States
Prior art keywords
point
time
blade
height
target height
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, expires
Application number
US14/428,470
Other languages
English (en)
Other versions
US20160122969A1 (en
Inventor
Daichi Noborio
Masaya Tanaka
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
Assigned to KOMATSU LTD. reassignment KOMATSU LTD. ASSIGNMENT OF ASSIGNORS INTEREST (SEE DOCUMENT FOR DETAILS). Assignors: NOBORIO, DAICHI, TANAKA, MASAYA
Publication of US20160122969A1 publication Critical patent/US20160122969A1/en
Application granted granted Critical
Publication of US9903096B2 publication Critical patent/US9903096B2/en
Active legal-status Critical Current
Adjusted expiration legal-status Critical

Links

Images

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/76—Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
    • E02F3/80—Component parts
    • E02F3/84—Drives or control devices therefor, e.g. hydraulic drive systems
    • E02F3/844—Drives or control devices therefor, e.g. hydraulic drive systems for positioning the blade, e.g. hydraulically
    • 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/76—Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
    • E02F3/7609—Scraper blade mounted forwardly of the tractor on a pair of pivoting arms which are linked to the sides of the tractor, e.g. bulldozers
    • 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/76—Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
    • E02F3/7609—Scraper blade mounted forwardly of the tractor on a pair of pivoting arms which are linked to the sides of the tractor, e.g. bulldozers
    • E02F3/7613—Scraper blade mounted forwardly of the tractor on a pair of pivoting arms which are linked to the sides of the tractor, e.g. bulldozers with the scraper blade adjustable relative to the pivoting arms about a vertical axis, e.g. angle dozers
    • 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/76—Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
    • E02F3/7622—Scraper equipment with the scraper blade mounted on a frame to be hitched to the tractor by bars, arms, chains or the like, the frame having no ground supporting means of its own, e.g. drag scrapers
    • E02F3/7627—Scraper equipment with the scraper blade mounted on a frame to be hitched to the tractor by bars, arms, chains or the like, the frame having no ground supporting means of its own, e.g. drag scrapers with the scraper blade adjustable relative to the frame about a vertical axis
    • 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/76—Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
    • E02F3/7622—Scraper equipment with the scraper blade mounted on a frame to be hitched to the tractor by bars, arms, chains or the like, the frame having no ground supporting means of its own, e.g. drag scrapers
    • E02F3/7631—Scraper equipment with the scraper blade mounted on a frame to be hitched to the tractor by bars, arms, chains or the like, the frame having no ground supporting means of its own, e.g. drag scrapers with the scraper blade adjustable relative to the frame about a horizontal axis
    • 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/76—Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
    • E02F3/80—Component parts
    • E02F3/84—Drives or control devices therefor, e.g. hydraulic drive systems
    • E02F3/844—Drives or control devices therefor, e.g. hydraulic drive systems for positioning the blade, e.g. hydraulically
    • E02F3/847—Drives or control devices therefor, e.g. hydraulic drive systems for positioning the blade, e.g. hydraulically using electromagnetic, optical or acoustic beams to determine the blade position, e.g. laser beams
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26—Indicating devices
    • E02F9/261—Surveying the work-site to be treated
    • E02F9/262—Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42—Determining position
    • G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
    • G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled

Definitions

  • the present invention relates to a blade control apparatus, a work vehicle, and a method of controlling a blade.
  • a work vehicle with a blade is used for excavating the ground, leveling the land, transporting earth and sand, and the like.
  • An example of a work vehicle that controls a blade tip to follow a designed surface is disclosed in Patent Literature 1 and Patent Literature 2.
  • the designed surface is a three dimensionally designed profile of the ground targeted for the subject to be worked.
  • Patent Literature 1 JP-5161403
  • Patent Literature 2 JP-5285805
  • a blade is operated by a hydraulic system.
  • the hydraulic system is controlled by a control signal output from the blade control apparatus.
  • a blade controlled to be at a target height with high responsiveness might not follow the changes in a vehicle speed and a blade load.
  • An object of an aspect of the present invention is to provide a blade control apparatus, a work vehicle, and a method of controlling a blade to work the ground to form a desired profile by improving the controllability of the blade.
  • a blade control apparatus configured to control a height of a blade tip of a blade supported on a vehicle body of a work vehicle so as to move in an up-and-down direction
  • the apparatus comprises: a blade control unit configured to output an operation instruction to operate a hydraulic cylinder that can move the blade in an up-and-down direction; a target height generating unit configured to calculate a target height of the blade tip based on absolute position data representing an absolute position of the vehicle body, vehicle body inclination angle data representing an inclination angle of the vehicle body, and designed surface data representing a designed surface that is a three dimensionally designed ground profile forming a target profile of a ground to be excavated; a target height data acquisition unit configured to acquire target height data representing a target height at a first point of time calculated in the target height generating unit; an actual height calculation unit configured to calculate an actual height of the blade tip at the first point of time based on the absolute position data at the first point of time, the vehicle body inclination angle data
  • the actual height calculation unit can calculate the actual height for a predetermined cycle
  • the second point of time can include a point of time earlier than the first point of time by one cycle
  • the third point of time can include a point of time later than the first point of time by one cycle.
  • the operation instruction at the second point of time can include a target cylinder speed instruction to the hydraulic cylinder, and the estimation unit can estimate the estimated height based on an actual height at the first point of time or a point of time earlier than the first point of time, an operation instruction at the second point of time, and the cycle.
  • the blade control apparatus can further comprise a blade load data acquisition unit configured to acquire blade load data representing a load on the blade, wherein the estimation unit can adjust a gain to calculate the estimated height based on the blade load data.
  • the blade control apparatus can further comprise a determination unit configured to determine whether a first difference between the target height and the actual height at the first point of time is larger than a second difference between the target height and the actual height at the second point of time, wherein the blade control unit can output the first operation instruction when the first difference is determined to be smaller than the second difference, and the blade control unit can output a second operation instruction to reduce a difference between the actual height and the target height at the first point of time, when the first difference is determined to be larger than the second difference, based on the actual height at the first point of time and the target height at the first point of time.
  • the blade control apparatus can further comprise a target height correction unit configured to estimate the target height at the third point of time based on the target height which the target height data acquisition unit acquires from the target height generating unit at the first point of time and the target height which the target height data acquisition unit acquires from the target height generating unit at the second point of time, wherein the blade control unit can output a first operation instruction to reduce a difference between the estimated height and the target height at the first point of time based on the estimated height at the third point of time and the target height at the third point of time estimated in the target height correction unit.
  • a work vehicle comprises: a vehicle body; a blade including a blade tip supported on the vehicle body so as to move in an up-and-down direction; and the blade control apparatus according to the first embodiment.
  • a method of controlling a blade by controlling a height of a blade tip of a blade supported on a vehicle body of a work vehicle so as to move in an up-and-down direction comprises: outputting an operation instruction to operate a hydraulic cylinder that can move the blade in an up-and-down direction; calculating a target height of the blade tip based on absolute position data representing an absolute position of the vehicle body, vehicle body inclination angle data representing an inclination angle of the vehicle body, and designed surface data representing a designed surface that is a three dimensionally designed ground profile forming a target profile of a ground to be excavated; acquiring a target height data representing the target height at a first point of time; calculating an actual height of the blade tip at the first point of time based on the absolute position data at the first point of time, the vehicle body inclination angle data at the first point of time, and cylinder length data representing a stroke distance of the hydraulic cylinder at the first point of time; and estimating an
  • a blade control apparatus a work vehicle, and a method of controlling a blade to work the ground to form a desired profile by improving the controllability of the blade is provided.
  • FIG. 1 is an example of a work vehicle according to an embodiment.
  • FIG. 2 schematically illustrates the work vehicle according to the embodiment.
  • FIG. 3 is a block diagram illustrating an example of a blade control apparatus according to the embodiment.
  • FIG. 4 is a functional block diagram illustrating an example of a blade controller and a target height generating unit according to the embodiment.
  • FIG. 5 is a flowchart illustrating an example of a method of controlling a blade according to the embodiment.
  • FIG. 6 is a chart explaining an example of a target height according to the embodiment.
  • FIG. 7 is a chart explaining an example of a target height according to the embodiment.
  • FIG. 8 is a chart explaining an example of an estimated height according to the embodiment.
  • FIG. 9 is a chart explaining an example of the target height according to the embodiment.
  • FIG. 10 is a chart explaining an example of the blade tip height according to a comparative example and a blade tip height according to the embodiment.
  • FIG. 1 is an example of a work vehicle 100 according to the embodiment.
  • the work vehicle 100 which is exemplarily a bulldozer 100 , is described.
  • the work vehicle 100 may be, for example, a motor grader.
  • the bulldozer 100 includes a vehicle body 10 , a traveling apparatus 20 , a lift frame 30 , a blade 40 , a lift cylinder 50 , an angle cylinder 60 , a tilt cylinder 70 , a GPS receiver 80 , an inertial measurement unit (IMU) 90 , a sprocket 95 , a hydraulic pump 240 , a hydraulic motor 241 , a hydraulic pump 245 , and a hydraulic sensor 250 .
  • IMU inertial measurement unit
  • the bulldozer 100 further includes a blade control apparatus 200 .
  • the blade control apparatus 200 controls the height of a blade tip 40 P of the blade 40 .
  • the configuration and operation of the blade control apparatus 200 will be described later.
  • the vehicle body 10 includes a driver's room 11 and an engine room 12 .
  • a driver's seat is provided in the driver's room 11 .
  • Various manipulating devices are arranged in the driver's room 11 .
  • An operator sits in the driver's seat and can manipulate the manipulation devices.
  • the engine room 12 is arranged in front of the driver's room 11 .
  • the traveling apparatus 20 includes a crawler 21 .
  • the traveling apparatus 20 is arranged below the vehicle body 10 .
  • the sprocket 95 is driven to rotate the crawler 21 to drive the bulldozer 100 .
  • the lift frame 30 is arranged within the traveling apparatus 20 along the width direction (right-and-left direction) of the vehicle.
  • the vehicle body 10 supports the lift frame 30 , allowing the lift frame 30 to pivot in the up-and-down direction about the axis X which is parallel to the width direction of the vehicle.
  • the lift frame 30 supports the blade 40 via a ball joint 31 , a pitch support link 32 , and a supporting part 33 .
  • the vehicle body 10 supports the blade 40 movable in the up and down direction.
  • the vehicle body 10 supports the blade 40 via the lift frame 30 .
  • the blade 40 is arranged in front of the vehicle body 10 .
  • the blade 40 includes a universal joint 41 coupled to the ball joint 31 and a pitching joint 42 coupled to the pitch support link 32 .
  • the blade 40 ascends and descends along with the lift frame 30 pivoting in the up-and-down direction.
  • the blade 40 includes the blade tip 40 P.
  • the blade tip 40 P is arranged at the bottom end of the blade 40 .
  • the blade tip 40 P is inserted in the ground to work and excavate the ground.
  • the lift cylinder 50 is a hydraulic cylinder to move the blade 40 in the up-and-down direction (lifting direction).
  • the lift cylinder 50 is coupled to the vehicle body 10 and the lift frame 30 .
  • the lift cylinder 50 extends and contracts to make the lift frame 30 and the blade 40 pivot in the up-and-down direction about the axis X.
  • the angle cylinder 60 is a hydraulic cylinder to move the blade 40 in rotational direction (angle direction).
  • the angle cylinder 60 is coupled to the lift frame 30 and the blade 40 .
  • the angle cylinder 60 extracts and contracts to make the blade 40 pivot about the axis Y that intersects with each of the rotation axis of the universal joint 41 and the pitching joint 42 .
  • the tilt cylinder 70 is a hydraulic cylinder to move the blade 40 in the rotational direction (tilt direction).
  • the tilt cylinder 70 is coupled to the supporting part 33 of the lift frame 30 and the right upper portion of the blade 40 .
  • the tilt cylinder 70 extracts and contracts to tilt the blade 40 about the axis Z that intersects with the ball joint 31 and the bottom end of the pitch support link 32 .
  • the lift frame 30 , the blade 40 , the lift cylinder 50 , the angle cylinder 60 , and the tilt cylinder 70 are described as exemplary representations and are not limited to the configuration described above.
  • the GPS receiver 80 is arranged above the driver's room 11 .
  • the GPS receiver 80 is provided as an antenna for global positioning system (GPS).
  • GPS global positioning system
  • the GPS receiver 80 acquires GPS data (absolute position data) representing the absolute position of itself.
  • the inertial measurement unit (IMU 90 ) is an inertial measurement unit.
  • the IMU 90 acquires vehicle body inclination angle data representing the inclination angles in the front-and-rear and right-and-left directions of the vehicle body 10 .
  • the sprocket 95 is driven by the power of an engine (not shown) contained in the engine room 12 transmitted via a transmission.
  • the transmission coupled to the engine transmits the shaft power produced by the rotational motion in the engine to the sprocket 95 .
  • the sprocket 95 is thereby driven.
  • the sprocket 95 drives the traveling apparatus 20 to operate.
  • the hydraulic pump 240 serves as a hydraulic pump driving the traveling apparatus 20 (hydraulic pump for traveling).
  • the hydraulic pump 240 is coupled to the engine.
  • the hydraulic motor 241 serves as a hydraulic motor driving the traveling apparatus 20 (hydraulic motor for traveling).
  • the hydraulic motor 241 is coupled to the sprocket 95 .
  • the transmission includes a hydraulic static transmission (HST) including the hydraulic pump 240 coupled to the engine and the hydraulic motor 241 coupled to the sprocket 95 .
  • the hydraulic pump 240 supplies working fluid to the hydraulic motor 241 .
  • the hydraulic motor 241 thereby operates and drives the sprocket 95 .
  • the hydraulic pump 240 operates to supply the working fluid to the hydraulic motor 241 .
  • the hydraulic motor 241 produces power with the supplied working fluid.
  • the power produced by the hydraulic motor 241 is transmitted to the sprocket 95 coupled to the hydraulic motor 241 .
  • the transmission may not necessarily be the HST.
  • the transmission may be a torque converter or a diesel electric transmission including a generator and a motor in place of the hydraulic pump 240 and the hydraulic motor 241 .
  • a planetary gear mechanism may be combined with the aforementioned mechanism.
  • the hydraulic pump 245 serves as a hydraulic pump operating the blade 40 (hydraulic pump for work machine).
  • the hydraulic pump 245 supplies the working fluid to the lift cylinder 50 .
  • the lift cylinder 50 thereby operates.
  • the hydraulic pump 245 supplies the working fluid to the angle cylinder 60 .
  • the angle cylinder 60 thereby operates.
  • the hydraulic pump 245 supplies the working fluid to the tilt cylinder 70 .
  • the tilt cylinder 70 thereby operates.
  • the hydraulic sensor 250 detects the pressure of the working fluid supplied from the hydraulic pump 245 to the lift cylinder 50 .
  • the hydraulic sensor 250 acquires pressure data representing the working fluid pressure.
  • the pressure detected by the hydraulic sensor 250 changes according to the traction of the traveling apparatus 20 .
  • the load on the blade 40 (blade load) is calculated according to the pressure detected by the hydraulic sensor 250 .
  • the hydraulic sensor 250 functions as a blade load sensor for acquiring blade load data representing the load on the blade.
  • the hydraulic sensor 250 may be configured to detect the pressure of the working fluid supplied from the hydraulic pump 240 to the hydraulic motor 241 .
  • the hydraulic sensor 250 acquires pressure data representing the working fluid pressure.
  • the pressure detected by the hydraulic sensor 250 changes according to the load on the blade 40 .
  • the load on the blade 40 (blade load) is calculated according to the pressure detected by the hydraulic sensor 250 .
  • the hydraulic sensor 250 is configured to detect the pressure of the working fluid supplied to the lift cylinder 50 also functions as a blade load sensor for acquiring blade load data representing the load on the blade.
  • the blade load sensor may include a drive torque sensor for detecting the drive torque of the sprocket 95 .
  • the drive torque of the sprocket 95 changes according to the traction of the traveling apparatus 20 .
  • the blade load is calculated according to the drive torque detected by the drive torque sensor.
  • the blade load data may include drive torque data representing the drive torque of the sprocket 95 .
  • FIG. 2 schematically illustrates the bulldozer 100 according to the embodiment.
  • the original position of the lift frame 30 is shown in phantom lines in FIG. 2 .
  • the blade tip 40 P of the blade 40 touches the ground.
  • the bulldozer 100 includes a lift cylinder sensor 50 S.
  • the lift cylinder sensor 50 S includes a spin roller for detecting the position of the rod and a magnetic sensor used to return the rod to the original position.
  • the lift cylinder sensor 50 S detects the stroke distance L of the lift cylinder 50 .
  • the stroke distance L of the lift cylinder 50 is referred to as lift cylinder length L as required.
  • the lift cylinder sensor 50 S acquires lift cylinder length data representing the stroke distance (lift cylinder length) L of the lift cylinder 50 .
  • a lift angle ⁇ of the blade 40 is calculated according to the lift cylinder length data.
  • the lift angle ⁇ represents the lowering angle of the blade 40 from the original position which corresponds to the intrusion depth of the blade tip 40 P.
  • the bulldozer 100 travels forward with the blade 40 lowered from the original position to work and excavate the ground.
  • the bulldozer 100 further includes an angle cylinder sensor for detecting the stroke distance (angle cylinder length) of the angle cylinder 60 and a tilt cylinder sensor for detecting the stroke distance (tilt cylinder length) of the tilt cylinder 70 .
  • Each of the angle cylinder sensor and the tilt cylinder sensor includes a spin roller for detecting the position of the rod and a magnetic sensor used to return the rod to the original position.
  • the angle cylinder sensor acquires angle cylinder length data representing the angle cylinder length.
  • the tilt cylinder sensor acquires tilt cylinder length data representing the tilt cylinder length.
  • FIG. 3 is a block diagram illustrating an example of the blade control apparatus 200 according to the embodiment.
  • the blade control apparatus 200 includes the lift cylinder 50 , the sprocket 95 , a proportional control valve 230 , the hydraulic pump 240 , the hydraulic motor 241 , the hydraulic pump 245 , and an input unit 260 .
  • the blade control apparatus 200 includes the hydraulic sensor 250 , the lift cylinder sensor 50 S, the GPS receiver 80 , and the IMU 90 .
  • the blade control apparatus 200 includes a blade controller 210 and a target height generating unit 220 .
  • the hydraulic pump 240 serves as a hydraulic pump to drive the traveling apparatus 20 (hydraulic pump for traveling).
  • the hydraulic pump 240 is coupled to the engine.
  • the hydraulic motor 241 serves as a hydraulic motor driving the traveling apparatus 20 (hydraulic motor for traveling).
  • the hydraulic motor 241 is coupled to the sprocket 95 .
  • the transmission includes a hydraulic static transmission (HST) including the hydraulic pump 240 coupled to the engine and the hydraulic motor 241 coupled to the sprocket 95 .
  • the hydraulic pump 240 supplies working fluid to the hydraulic motor 241 .
  • the hydraulic motor 241 thereby operates and drives the sprocket 95 .
  • the hydraulic pump 240 operates to supply the working fluid to the hydraulic motor 241 .
  • the hydraulic motor 241 produces power with the supplied working fluid.
  • the power produced by the hydraulic motor 241 is transmitted to the sprocket 95 coupled to the hydraulic motor 241 .
  • the traveling apparatus 20 thereby travels.
  • the hydraulic pump 245 serves as a hydraulic pump operating the blade 40 (hydraulic pump for work machine).
  • the proportional control valve 230 is arranged between the lift cylinder 50 and the hydraulic pump 245 .
  • the hydraulic pump 245 supplies the working fluid to the lift cylinder 50 via the proportional control valve 230 .
  • the proportional control valve 230 controls the working fluid to operate the lift cylinder 50 .
  • the input unit 260 includes a manipulation lever and a deceleration pedal operated by an operator.
  • the blade controller 210 includes a computer system having a processor such as a CPU.
  • the target height generating unit 220 includes a computer system having a processor such as a CPU.
  • the blade controller 210 outputs an operation instruction to operate the lift cylinder 50 that can move the blade 40 in the up-and-down direction.
  • the blade controller 210 outputs a control signal based on the operation instruction to the proportional control valve 230 that controls the working fluid to be supplied to the lift cylinder 50 .
  • the blade controller 210 In response to the operation made to the manipulation lever of the input unit 260 , the blade controller 210 gives instruction to operate the blade and to swing by individually operating the right-and-left traveling apparatuses 20 . In response to the operation made to the deceleration pedal of the input unit 260 , the blade controller 210 controls the output of the transmission to change the vehicle speed.
  • the target height generating unit 220 calculates the target height data representing the target position of the blade tip 40 P.
  • the hydraulic sensor 250 transmits pressure data (blade load data) to the blade controller 210 .
  • the lift cylinder sensor 50 S transmits the lift cylinder length data representing the lift cylinder length L of the lift cylinder 50 to the blade controller 210 .
  • the GPS receiver 80 transmits the GPS data to the target height generating unit 220 .
  • the target height generating unit 220 transmits the GPS data to the blade controller 210 .
  • the GPS receiver 80 may be configured to transmit the GPS data to the blade controller 210 .
  • the IMU 90 transmits the vehicle body inclination angle data representing the inclination angle of the bulldozer 100 , such as a pitch angle and a roll angle in the absolute coordinate system, to the target height generating unit 220 .
  • the target height generating unit 220 transmits the vehicle body inclination angle data to the blade controller 210 .
  • the IMU 90 may be configured to transmit the vehicle body inclination angle data to the blade controller 210 .
  • the blade controller 210 acquires the blade load data (pressure data) from the hydraulic sensor 250 .
  • the blade controller 210 acquires the lift cylinder length data from the lift cylinder sensor 50 S.
  • the blade controller 210 acquires the GPS data from the GPS receiver 80 .
  • the blade controller 210 acquires the vehicle body inclination angle data from the IMU 90 .
  • the blade controller 210 calculates the GPS position (absolute position) of the GPS receiver 80 in the global coordinate system.
  • the global coordinate system is a coordinate system with its origin (absolute reference point) fixed on the earth.
  • the blade controller 210 calculates the lift angle ⁇ (see FIG. 2 ) of the blade 40 according to the lift cylinder length data.
  • the blade controller 210 performs coordinate transformation from the global coordinate system to the local coordinate system according to the lift angle ⁇ and the vehicle body dimensional data and then calculates the position (relative position) of the blade tip 40 P of the blade 40 with reference to the GPS receiver 80 in the local coordinate system.
  • the local coordinate system is a coordinate system with its origin (vehicle body reference point) fixed on the vehicle body 10 of the bulldozer 100 .
  • the local coordinate system may be referred to as vehicle main body coordinate system.
  • the vehicle body dimensional data is a known data and is stored in the blade controller 210 in advance.
  • the blade controller 210 calculates the position (actual height) of the blade tip 40 P in the global coordinate system according to the GPS data representing the absolute position of the GPS receiver 80 in the global coordinate system, the local position data representing the position of the blade tip 40 P relative to the GPS receiver 80 in the local coordinate system, and the vehicle body inclination angle data representing the inclination angle of the vehicle body 10 .
  • the blade controller 210 calculates the actual position (actual height) of the blade tip 40 P according to the GPS data (absolute position data) representing the GPS position (absolute position) of the vehicle body 10 , the vehicle body inclination angle data representing the inclination angle of the vehicle body 10 , and the lift cylinder length data representing the stroke distance of the lift cylinder 50 .
  • the target height generating unit 220 acquires the GPS data from the GPS receiver 80 .
  • the target height generating unit 220 acquires the vehicle body inclination angle data from the IMU 90 .
  • the target height generating unit 220 stores in advance the designed surface data representing the designed surface, that is, a three dimensionally designed ground profile forming a target profile of the ground to be excavated in the work area. According to the vehicle body dimensional data, the lift angle ⁇ calculated from the cylinder length data, the GPS data, the vehicle body inclination angle data, and the designed surface data, the target height generating unit 220 performs coordinate transformation from the global coordinate system to the local coordinate system to calculate the target position (target height) of the blade tip 40 P in the local coordinate system.
  • the target height generating unit 220 transmits the target height data representing the calculated target height to the blade controller 210 .
  • the blade controller 210 acquires the target height data.
  • the blade controller 210 outputs a control signal in response to an operation instruction to a proportional control valve 230 to reduce the difference between the estimated height and the target height.
  • the control signal includes a current.
  • the blade controller 210 outputs the control signal to the proportional control valve 230 , where the control signal is a current corresponding to the current obtained according to the actual height and the target height.
  • the blade controller 210 estimates the future height (estimated height) of the blade tip 40 P.
  • the blade controller 210 outputs a control signal in response to the operation instruction to the proportional control valve 230 to reduce the difference between the estimated height and the target height.
  • the control signal includes a current.
  • the blade controller 210 outputs the control signal to the proportional control valve 230 , where the control signal is a current corresponding to the current obtained according to the estimated height and the target height.
  • the rate of opening of the proportional control valve 230 is controlled with a current, or a control signal, output from the blade controller 210 .
  • the current, or the control signal, output from the blade controller 210 can be adjusted by the input unit 260 .
  • FIG. 4 is a functional block diagram illustrating an example of the blade controller 210 and the target height generating unit 220 according to the embodiment.
  • the blade controller 210 includes a vehicle data acquisition unit 211 , an actual height calculation unit 212 , a determination unit 213 , an estimation unit 214 , a filtering unit 215 , a target height data acquisition unit 216 , a target height correction unit 217 , a blade load data acquisition unit 218 , a blade control unit 219 , and a memory unit 300 .
  • the target height generating unit 220 includes a designed surface data storing unit 221 , a data acquisition unit 222 , and a target height calculation unit 223 .
  • the vehicle data acquisition unit 211 acquires the GPS data from the GPS receiver 80 .
  • the vehicle data acquisition unit 211 acquires the vehicle body inclination angle data from the IMU 90 .
  • the vehicle data acquisition unit 211 acquires the lift cylinder length data from the lift cylinder sensor 50 S.
  • the actual height calculation unit 212 calculates the actual height (actual elevation) of the blade tip 40 P according to the vehicle body dimensional data, the GPS data, the vehicle body inclination angle data, and the lift cylinder length data.
  • the determination unit 213 makes a predetermined determination according to the difference between the target height and the actual height of the blade tip 40 P.
  • the estimation unit 214 estimates the estimated future height of the blade tip 40 P according to the previously output operation instruction and the present actual height of the blade tip 40 P.
  • the filtering unit 215 filters the target height data representing the target height transmitted from the target height generating unit 220 .
  • the filtering unit 215 includes a Kalman filter.
  • the target height data acquisition unit 216 acquires the target height data representing the target height calculated in the target height generating unit 220 .
  • the target height data acquisition unit 216 acquires the target height data filtered in the filtering unit 215 .
  • the target height correction unit 217 estimates the future target height according to the past target height and the present target height.
  • the determination unit 213 makes a predetermined determination, which will be described later, according to the future target height of the blade tip 40 P estimated in the target height correction unit 217 and the present actual height of the blade tip 40 P calculated in the actual height calculation unit 212 .
  • the blade load data acquisition unit 218 acquires the blade load data representing the load on the blade 40 from the hydraulic sensor 250 .
  • the blade control unit 219 According to the future estimated height of the blade tip 40 P estimated in the estimation unit 214 and the present target height of the blade tip 40 P, the blade control unit 219 outputs a control signal in response to the operation instruction to the proportional control valve 230 to reduce the difference between the estimated height and the target height.
  • the memory unit 300 stores various maps used for control made by the blade controller 210 .
  • the memory unit 300 stores a map representing the relationship between a current, or a control signal, output to the proportional control valve 230 and the cylinder speed of the lift cylinder 50 at when the current is supplied to the proportional control valve 230 .
  • the designed surface data storing unit 221 stores in advance the designed surface data representing the designed surface, that is, the three dimensionally designed ground profile forming a target profile of the ground to be excavated.
  • the data acquisition unit 222 acquires the GPS data from the GPS receiver 80 .
  • the data acquisition unit 222 acquires the vehicle body inclination angle data from the IMU 90 .
  • the data acquisition unit 222 acquires the designed surface data from the designed surface data storing unit 221 .
  • the target height calculation unit 223 calculates the target height of the blade tip 40 P according to the GPS data representing the absolute position of the vehicle body 10 , the vehicle body inclination angle data representing the inclination angle of the vehicle body 10 , and the designed surface data representing the designed surface, that is, the three dimensionally designed ground profile forming a target profile of the ground to be excavated.
  • the target height calculation unit 223 transmits the target height data representing the calculated target height to the filtering unit 215 .
  • the estimation unit 214 estimates the estimated height of the blade tip 40 P at a third point of time (future point of time), which is later than the first point of time, according to the operation instruction output from the blade controller 210 at a second point of time (past point of time), which is earlier than the first point of time, and the actual height data representing the actual height of the blade tip 40 P at the first point of time.
  • the blade control unit 219 According to the estimated height at the third point of time and the target height at the first point of time, the blade control unit 219 outputs the operation instruction to reduce the difference between the estimated height and the target height at the first point of time.
  • the target height calculation unit 223 calculates the target height for a predetermined cycle (for example, at every 10 milliseconds).
  • the actual height calculation unit 212 calculates the target height for a predetermined cycle (for example, at every 10 milliseconds).
  • the second point of time (past point of time) is earlier than the first point of time (present point of time) by, for example, one cycle (a point of time 10 milliseconds earlier).
  • the third point of time is later than the first point of time (present point of time) by, for example, one cycle (a point of time 10 milliseconds later).
  • the blade control unit 219 When the difference between the actual height and the target height has a predetermined relationship, the blade control unit 219 outputs the operation instruction according to the estimated height and the target height. When the difference between the actual height and the target height does not have a predetermined relationship, the blade control unit 219 outputs the operation instruction according to the actual height and the target height.
  • the determination unit 213 determines whether the difference between the actual height and the target height has a predetermined relationship. In the embodiment, the determination unit 213 determines whether a first difference between the target height at the first point of time and the actual height at the first point of time is larger than a second difference between the target height at the second point of time and the actual height at the second point of time.
  • the blade control unit 219 When it is determined that the first difference is smaller than the second difference, the blade control unit 219 outputs the operation instruction to reduce the difference between the estimated height and the target height at the first point of time according to the estimated height at the third point of time and the target height at the first point of time.
  • the blade control unit 219 When it is determined that the first difference is larger than the second difference, the blade control unit 219 outputs the operation instruction to reduce the difference between the actual height and the target height at the first point of time according to the actual height at the first point of time and the target height at the first point of time.
  • the target height correction unit 217 estimates the target height at the third point of time (corrected target height) according to the target height which the target height data acquisition unit 216 acquires from the target height generating unit 220 at the first point of time and the target height which the target height data acquisition unit 216 acquires from the target height generating unit 220 at the second point of time.
  • the estimated target height (corrected target height) is used as the target height at the first point of time.
  • the determination unit 213 determines whether the first difference between the target height at the first point of time (corrected target height) and the actual height at the first point of time is larger than the second difference between the target height at the second point of time and the actual height at the second point of time.
  • the blade control unit 219 When the determination unit 213 determines that the first difference is smaller than the second difference, the blade control unit 219 outputs the operation instruction to reduce the difference between the estimated height and the target height at the first point of time according to the estimated height and the target height estimated in the target height correction unit 217 .
  • the blade control unit 219 When the determination unit 213 determines that the first difference is larger than the second difference, the blade control unit 219 outputs the operation instruction to reduce the difference between the actual height and the target height at the first point of time according to the actual height and the target height estimated in the target height correction unit 217 .
  • FIG. 5 is a flowchart illustrating an example of a method of controlling a blade according to the embodiment.
  • the vehicle data acquisition unit 211 acquires the GPS data, the vehicle body inclination angle data, and the lift cylinder length data.
  • the actual height calculation unit 212 calculates the actual height of the blade tip 40 P at the first point of time according to the GPS data at the first point of time, the vehicle body inclination angle data at the first point of time, and the cylinder length data at the first point of time (step SP 1 ). In the embodiment as described above, the actual height calculation unit 212 calculates the actual height of the blade tip 40 P for a predetermined cycle (for example, at every 10 milliseconds).
  • the data acquisition unit 222 acquires the GPS data, the vehicle body inclination angle data, and the designed surface data.
  • the target height calculation unit 223 calculates the target height of the blade tip 40 P according to the GPS data, the vehicle body inclination angle data, and the cylinder length data. In the embodiment as described above, the target height calculation unit 223 calculates the target height of the blade tip 40 P for a predetermined cycle (for example, at every 10 milliseconds).
  • the target height data representing the target height calculated in the target height calculation unit 223 is transmitted to the blade controller 210 for a predetermined cycle (at every 10 milliseconds).
  • the target height data acquisition unit 216 acquires the target height data representing the target height at the first point of time calculated in the target height generating unit 220 via the filtering unit 215 (step SP 2 ).
  • the blade controller 210 acquires the actual height data at the first point of time and the target height data at the first point of time.
  • the filtering unit 215 filters the target height data and the resulting target height data is acquired by the target height data acquisition unit 216 .
  • the filtering unit 215 it is desirable to select a filter with a small time lag such as a Kalman filter.
  • the inclination angle of the vehicle body 10 changes every second.
  • the target height data calculated in the target height calculation unit 223 also changes every second.
  • the blade 40 is controlled using the hydraulic system including the lift cylinder 50 and the proportional control valve 230 according to the target height data that changes every second, the blade 40 might fail to follow the change and result in uncontrolled state such as hunting.
  • the target height data is filtered and the filtered target height data is used to control the blade 40 . The occurrence of an uncontrolled state can thereby be suppressed.
  • FIG. 6 explains the effect of the filtering unit 215 .
  • the line LO represents the target height data output from the target height calculation unit 223 .
  • the target height data output from the target height calculation unit 223 also changes every second along with the change in the inclination angle of the vehicle body 10 .
  • the line LC represents the target height data filtered in the filtering unit 215 which may be a Kalman filter. That is, the line LC represents the target height data output from the filtering unit 215 to the target height data acquisition unit 216 .
  • the filtering unit 215 which may be a Kalman filter transforms the target height into a smooth data without causing a large delay.
  • the filtered target height data is used to control the blade 40 , thereby suppressing the occurrence of an uncontrolled state.
  • the target height data acquired by the target height data acquisition unit 216 is transmitted to the target height correction unit 217 .
  • the target height correction unit 217 corrects the target height data supplied from the target height data acquisition unit 216 (step SP 3 ).
  • a delay in calculating the target height in the target height generating unit 220 or a delay in the target height generating unit 220 transmitting the target height data to the blade controller 210 may occur.
  • the target height data is calculated according to the GPS data and the vehicle body inclination angle data or the like.
  • the blade controller 210 controls the blade 40 to reduce the deviation from the target height data according to the vehicle body inclination angle data at a point of time earlier by one cycle (at a point of time 10 milliseconds earlier).
  • the inclination angle of the vehicle body 10 changes every second.
  • the blade 40 might fail to properly follow the designed surface. For example, at a certain vehicle speed, the blade may ascend and descend (undulate) regardless of an intention of an operator.
  • the blade controller 210 corrects the target height data supplied from the target height generating unit 220 to generate the target height data (corrected target height data).
  • FIG. 7 is a chart explaining an example of the corrected target height.
  • the target height data acquisition unit 216 acquires the target height data Tm 1 from the target height generating unit 220 at the first point of time (present point of time) t 1 and the target height data acquisition unit 216 acquires the target height data Tm 2 from the target height generating unit 220 at the second point of time (past point of time) t 2 which is earlier than the first point of time t 1 .
  • the target height correction unit 217 estimates the target height data Tm 3 at the third point of time (future point of time) t 3 which is later than the first point of time t 1 .
  • the target height correction unit 217 performs the calculation expressed in Equation (1).
  • Tm 3 Tm 1+( Tm 1 ⁇ Tm 2) ⁇ G (1)
  • the variable G in Equation (1) indicates the gain.
  • the blade controller 210 uses the target height data (corrected target height data) Tm 3 to output the control signal in response to the operation instruction for controlling the blade 40 at the first point of time t 1 . That is, the blade controller 210 determines the target height data Tm 3 as the target height at the first point of time t 1 to perform control.
  • the target height at the future point of time (the third point of time) is determined from the target height data at the present point of time (the first point of time) and the target height data at the past point of time (the second point of time).
  • the target height at the future point of time may be determined from the target height data at a past point of time (for example, the second point of time) and the target height data at a past point of time earlier than the former past point of time.
  • the actual height data Tr 1 at the first point of time t 1 calculated in the actual height calculation unit 212 and the target height data Tm 3 at the first point of time t 1 corrected in the target height correction unit 217 are transmitted to the determination unit 213 .
  • the determination unit 213 compares a first difference ⁇ 1 between the target height data Tm 3 at the first point of time t 1 and the actual height data Tr 1 at the first point of time t 1 and a second difference ⁇ 2 between the target height data Tm 2 at the second point of time t 2 and the actual height data Tr 2 at the second point of time t 2 (step SP 4 ).
  • the determination unit 213 determines whether the first difference ⁇ 1 between the target height data Tm 3 at the first point of time t 1 and the actual height data Tr 1 at the first point of time t 1 is larger than the second difference ⁇ 2 between the target height data Tm 2 at the second point of time t 2 and the actual height data Tr 2 at the second point of time t 2 (step SP 5 ).
  • the estimation unit 214 estimates the estimated height (step SP 6 ).
  • the estimation unit 214 performs no estimation of the estimated height and the blade control unit 219 outputs the operation instruction, according to the actual height data Tr 1 at the first point of time t 1 and the target height data Tm 1 at the first point of time t 1 , to reduce the difference between the actual height data Tr 1 and the target height data Tm 1 at the first point of time t 1 (step SP 8 ).
  • the estimation of the estimated height of a blade tip 40 P performed in the estimation unit 214 will be described referring to FIG. 8 .
  • a typical hydraulic mechanism such as the lift cylinder 50 has a dead time occurring in a hydraulic system. If a dead time effecting the control signal exists in the hydraulic system, it may be difficult to make the blade tip 40 P of the blade 40 follow the designed surface. If a gain is increased to improve responsiveness, the dead time causes an overshoot, which may make the blade tip 40 P of the blade 40 difficult to follow the designed surface.
  • the estimated height data Tr 3 of the blade tip 40 P at the third point of time t 3 which is later than the first point of time t 1 , is estimated without using the actual height data Tr 1 of the blade tip 40 P at the first point of time t 1 .
  • the resulting estimated height data Tr 3 is used output the operation instruction to control the blade 40 .
  • the blade tip 40 P can be positioned close to the target height even when a dead time exists in the hydraulic system.
  • the actual height data Tr 1 of the blade tip 40 P at the first point of time t 1 is calculated.
  • the actual height data Tr 2 of the blade tip 40 P at the second point of time t 2 which is earlier than the first point of time t 1 , is calculated.
  • the blade control unit 219 outputs the operation instruction at the second point of time t 2 .
  • the estimation unit 214 estimates the estimated height data Tr 3 representing the estimated height of the blade tip 40 P at the third point of time t 3 , which is later than the first point of time t 1 , according to the operation instruction output from the blade control unit 219 at the second point of time t 2 and the actual height data Tr 1 representing the actual height of the blade tip 40 P at the first point of time t 1 .
  • the operation instruction includes the target cylinder speed instruction of the lift cylinder 50 .
  • the memory unit 300 stores a map representing the relationship between a current, or a control signal, output to the proportional control valve 230 and the cylinder speed of the lift cylinder 50 at when the current is supplied to the proportional control valve 230 .
  • the blade control unit 219 outputs the control signal (a current) to the proportional control valve 230 to operate the lift cylinder 50 at a target cylinder speed.
  • the operation instruction at the second point of time t 2 includes the target cylinder speed instruction of the lift cylinder 50 at the second point of time t 2 .
  • the estimation unit 214 estimates the estimated height data Tr 3 according to the actual height data Tr 1 at the first point of time t 1 , the target cylinder speed (instructed speed) Vr 2 at the second point of time t 2 , and a cycle ts (10 milliseconds in the embodiment).
  • the variable Vr 2 indicates the target cylinder speed (instructed speed) at the second point of time t 2 .
  • the variable ts indicates the cycle.
  • the variable G indicates the gain.
  • the blade controller 210 uses the estimated height data Tr 3 to output the control signal in response to the operation instruction for controlling the blade 40 at the first point of time t 1 .
  • An instructed speed Vr 2 at the second point of time t 2 which is earlier than the first point of time t 1 by one cycle (1 ⁇ 10 milliseconds earlier), is used in Equation (2).
  • an instructed speed Vr 23 at the point of time t 23 earlier by three cycles (3 ⁇ 10 milliseconds earlier) may be used. That is, the estimation unit 214 may perform the calculation expressed in Equation (3).
  • Tr 3 Tr 1+( Vr 2+ Vr 22+ . . . + Vr 2 n ) ⁇ ts ⁇ G (3)
  • the occurrence of an overshoot can be suppressed even when the gain G is increased to improve responsiveness.
  • the gain G can optionally be determined.
  • the gain G is adjusted according to the blade load data.
  • the blade controller 210 includes the blade load data acquisition unit 218 for acquiring the blade load data representing the load on the blade 40 .
  • the estimation unit 214 may be configured to adjust the gain G to calculate the estimated height data Tr 3 according to the blade load data. For example, the estimation unit 214 reduces the gain G when the blade load data is high. When the blade load is high, the estimated height data Tr 3 may largely deviate from a true value (true height of the blade tip 40 P at the first point of time t 1 ). When the blade load is high, the gain G is reduced to prevent significant deviation of the estimated height data Tr 3 from the true value.
  • the blade control unit 219 After estimating the estimated height data Tr 3 , the blade control unit 219 outputs the operation instruction to reduce the difference between the estimated height data Tm 3 and the target height data Tr 3 at the first point of time t 1 according to the estimated height data Tr 3 and the target height data Tm 3 (step SP 7 ). The deterioration in the performance of the blade 40 to follow the designed surface can thus be suppressed.
  • the blade control unit 219 outputs the operation instruction to reduce the difference between the estimated height data Tm 3 and the target height data Tr 3 using the sliding mode control. High responsiveness of the blade 40 can thus be achieved.
  • the blade control unit 219 may be configured to output the operation instruction to reduce the difference between the estimated height data Tm 3 and the target height data Tr 3 using the PID control.
  • the estimated height at the future point of time (the third point of time) is estimated from the actual height data at the present point of time (the first point of time) and the operation instruction at the past point of time (the second point of time).
  • the estimated height at a future point of time may be estimated from the actual height data at a past point of time (for example, the second point of time) and the operation instruction at a past point of time earlier than the former past point of time.
  • the estimated height of the blade tip 40 P at the third point of time t 3 which is later than the first point of time t 1 , may be estimated according to the operation instruction output from the blade control unit 219 at the second point of time t 2 , which is earlier than the first point of time t 1 , and the actual height data representing the actual height of the blade tip 40 P at the first point of time t 1 or a point of time earlier than the first point of time t 1 (for example, the point of time t 2 , the point of time t 22 , . . . , the point of time t 2 n ).
  • step SP 5 if it is determined in step SP 5 that the first difference ⁇ 1 is larger than the second difference ⁇ 2 , the first difference ⁇ 1 is equal to the second difference ⁇ 2 , or the first difference ⁇ 1 is equal to or larger than the predetermined threshold (YES: in step SP 5 ), the estimation unit 214 performs no estimation of the estimated height and the blade control unit 219 outputs the operation instruction, according to the actual height data Tr 1 at the first point of time t 1 and the target height data Tm 1 at the first point of time t 1 , to reduce the difference between the actual height data Tr 1 and the target height data Tm 1 at the first point of time t 1 (step SP 8 ).
  • the operation instruction is output without using the estimated height data Tr 3 but using the actual height data Tr 1 at the first point of time t 1 .
  • a process may be made to set the gain G to zero in Equation (2) and in Equation (3), that is, to swap the estimated height data Tr 3 for the actual height data Tr 1 .
  • the estimated height data Tr 3 When the estimated height data Tr 3 is used, the occurrence of an overshoot can be suppressed. However, when the estimated height data Tr 3 is used, the output of the operation instruction is likely to be suppressed. When a motion is made so as the actual height to gradually deviate from the target height or when the difference between the actual height and the target height is significantly larger than the predetermined threshold, it may be difficult to rapidly change the actual height to be close to the target height.
  • the blade control unit 219 outputs the operation instruction, according to the actual height data Tr 1 at the first point of time t 1 and the target height data Tm 1 at the first point of time t 1 , to reduce the difference between the actual height data Tr 1 and the target height data Tm 1 at the first point of time t 1 .
  • the actual height can rapidly change to be close to the target height.
  • FIG. 9 illustrates an effect of the correction of the target height made by the target height correction unit 217 .
  • the corrected target height is close to an ideal target height compared to the target height before correction.
  • the ideal target height is the target height calculated according to the detected actual behavior of the vehicle body 10 .
  • the blade behaves to be closer to the ideal target height than the target height before correction. In this manner, the delay time between the output of the operation instruction and the start of the actual operation of the blade can be reduced. Thus, troubles such as the blade ascending and descending (undulating) relatively to the target height can be eliminated.
  • FIG. 10 illustrates an example of the height of the blade tip 40 P where the blade 40 is controlled without using the estimated height but using the actual height and an example of the height of the blade tip 40 P where the estimated height is used to control the blade 40 .
  • the target height changes stepwise while the bulldozer 100 is working the ground using the blade 40 , in other words, the traveling apparatus 20 of the bulldozer 100 is traveling with a predetermined load on the blade 40 .
  • FIG. 10 illustrates the height of the blade tip 40 P, where the actual height is used to control the blade 40 , and the height of the blade tip 40 P, where the estimated height is used to control the blade 40 .
  • the target height calculated in the target height generating unit 220 changes stepwise as illustrated in FIG. 10 .
  • the blade 40 When the blade 40 is controlled using the actual height as in the comparative example, the blade 40 overshoots as illustrated in FIG. 10 . During an operation of working the ground where the load on the blade 40 and the vehicle speed of the traveling apparatus 20 are likely to change, an overshoot may occur and cause unstable control of the blade 40 . As a result, the bulldozer 100 may not be able to work the ground to form the desired profile.
  • the blade 40 is controlled using the estimated height and thereby the overshoot of the blade 40 is suppressed as illustrated in FIG. 10 .
  • the blade 40 is adjusted to be at the target height without causing an overshoot. In this manner, the bulldozer 100 can work the ground to form the desired profile.
  • the estimated height data Tr 3 representing the estimated height of the blade tip 40 P at the third point of time t 3 , which is later than the first point of time t 1 is estimated according to the operation instruction output from the blade control unit 219 at the second point of time t 2 , which is earlier than the first point of time t 1 , and the actual height data Tr 1 representing the actual height of the blade tip 40 P at the first point of time t 1 .
  • the operation instruction is output according to the estimated height data Tr 3 and the target height data Tm 1 . In this manner, even when a dead time exists in the hydraulic system, the responsiveness of the blade 40 can be improved by increasing the gain while suppressing the occurrence of an overshoot.
  • the occurrence of an overshoot can be suppressed even under a large gain. Accordingly, the blade tip of the blade 40 can precisely follow the designed surface with high responsiveness. The bulldozer 100 can therefore work the ground to form the desired profile.
  • the blade control unit 219 controls the blade 40 with the sliding mode control which is a modern control theory.
  • the sliding mode control may provide higher responsiveness than the PID control.
  • the dead time in the hydraulic system may cause an overshoot in certain loads and traveling conditions.
  • the blade 40 is controlled using the estimated height data Tr 3 to suppress an occurrence of an overshoot or the like, thereby improving controllability.
  • the target height calculation unit 223 calculates the target height and the actual height calculation unit 212 calculates the actual height for a predetermined cycle ts.
  • the first point of time t 1 , the second point of time t 2 , and the third point of time t 3 are determined according to the cycle ts. Therefore, the ground can be worked to form the desired profile using the blade 40 .
  • the gain G used for calculating the estimated height data Tr 3 is adjusted according to the blade load data. This suppresses a large deviation of the estimated height data Tr 3 from the true value caused by the change in the blade load, thereby suppressing deterioration in accuracy of the estimated height data Tr 3 .
  • the operation instruction is output without using the estimated height data Tr 3 but using the actual height data Tr 1 at the first point of time t 1 .
  • the actual height can rapidly changes to be close to the target height.
  • the target height data Tm 3 at the third point of time t 3 is estimated according to the target height data Tm 1 at the first point of time t 1 and the target height data Tm 2 at the second point of time t 2 .
  • the blade 40 is controlled so as the target height data Tm 3 and the estimated height data Tr 3 to be close to each other.
  • the process in the target height generating unit 220 including calculation and output
  • the blade 40 is controlled to cancel the delay. Therefore, even when the blade is controlled according to the actual height, the method can be applied and the bulldozer 100 can therefore work the ground to form the desired profile.
  • the work vehicle 100 which is exemplarily the bulldozer 100 , is described.
  • the work vehicle 100 may be a motor grader including the blade mechanism.

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Acoustics & Sound (AREA)
  • Electromagnetism (AREA)
  • Optics & Photonics (AREA)
  • Operation Control Of Excavators (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
US14/428,470 2014-10-30 2014-10-30 Blade control apparatus, work vehicle, and method of controlling a blade Active 2034-11-26 US9903096B2 (en)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2014/078977 WO2015083469A1 (ja) 2014-10-30 2014-10-30 ブレード制御装置、作業車両、及びブレード制御方法

Publications (2)

Publication Number Publication Date
US20160122969A1 US20160122969A1 (en) 2016-05-05
US9903096B2 true US9903096B2 (en) 2018-02-27

Family

ID=53273242

Family Applications (1)

Application Number Title Priority Date Filing Date
US14/428,470 Active 2034-11-26 US9903096B2 (en) 2014-10-30 2014-10-30 Blade control apparatus, work vehicle, and method of controlling a blade

Country Status (4)

Country Link
US (1) US9903096B2 (ja)
JP (1) JP5807128B1 (ja)
CN (1) CN105745379B (ja)
WO (1) WO2015083469A1 (ja)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10392774B2 (en) * 2017-10-30 2019-08-27 Deere & Company Position control system and method for an implement of a work vehicle
US10533301B1 (en) * 2018-12-20 2020-01-14 David Armas GPS and laser grading control
US12031291B2 (en) 2018-05-31 2024-07-09 Komatsu Ltd. Blade control device and blade control method

Families Citing this family (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20170096794A1 (en) * 2015-10-02 2017-04-06 Caterpillar Inc. Blade assembly having socket support plate
US10066370B2 (en) * 2015-10-19 2018-09-04 Caterpillar Inc. Sensor fusion for implement position estimation and control
US9598844B1 (en) * 2015-12-22 2017-03-21 Caterpillar Trimble Control Technologies Llc Implement control based on surface-based cost function and noise values
JP6861485B2 (ja) * 2016-07-26 2021-04-21 株式会社小松製作所 作業車両の制御システム、制御方法、及び作業車両
JPWO2017119517A1 (ja) * 2017-01-13 2018-01-11 株式会社小松製作所 作業機械の制御システム、作業機械、作業機械の制御方法、及びナビゲーションコントローラ
CN106888588A (zh) * 2017-03-08 2017-06-27 徐州迪惠尔工程机械有限公司 一种高效可调节的平地机
CN110114535B (zh) * 2017-03-30 2021-04-20 株式会社小松制作所 作业车辆的控制系统、工作装置的轨迹设定方法以及作业车辆
JP7050051B2 (ja) * 2017-03-30 2022-04-07 株式会社小松製作所 作業車両の制御システム、作業機の軌跡設定方法、及び作業車両
CA3063687A1 (en) * 2017-08-29 2019-12-06 Komatsu Ltd. Control system for work vehicle, method, and work vehicle
CN110945189A (zh) * 2017-09-07 2020-03-31 住友建机株式会社 挖土机
JP6827123B2 (ja) * 2018-03-12 2021-02-10 日立建機株式会社 作業機械
JP7152170B2 (ja) * 2018-03-28 2022-10-12 株式会社小松製作所 作業車両の制御システム、方法、及び作業車両
JP7092557B2 (ja) 2018-05-29 2022-06-28 株式会社小松製作所 ブレード制御装置及びブレード制御方法
JP7175107B2 (ja) * 2018-05-31 2022-11-18 株式会社小松製作所 ブレード制御装置及びブレード制御方法
JP2020033789A (ja) * 2018-08-31 2020-03-05 株式会社神戸製鋼所 作業機械のブレード制御装置
US10883248B2 (en) 2018-10-22 2021-01-05 Deere & Company Road maintenance using stored maintenance passes
JP7025364B2 (ja) * 2019-03-20 2022-02-24 ヤンマーパワーテクノロジー株式会社 作業車両のブレード制御システム
WO2020203804A1 (ja) * 2019-03-29 2020-10-08 株式会社小松製作所 作業車両、作業車両の制御装置、および作業車両の方向特定方法
CN115210667A (zh) * 2020-03-09 2022-10-18 丹佛斯公司 用于控制重型机械的系统和方法
CN111576514B (zh) * 2020-05-28 2022-03-15 江苏徐工工程机械研究院有限公司 找平控制方法及系统、控制器、平地机
US20230383496A1 (en) * 2022-05-27 2023-11-30 Caterpillar Inc. Systems and methods for determining poor implement penetration

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20090069987A1 (en) * 2007-09-12 2009-03-12 Topcon Positioning Systems, Inc. Automatic Blade Control System with Integrated Global Navigation Satellite System and Inertial Sensors
JP5161403B1 (ja) 2011-09-30 2013-03-13 株式会社小松製作所 ブレード制御システムおよび建設機械
JP5285805B1 (ja) 2012-10-26 2013-09-11 株式会社小松製作所 ブレード制御装置、作業機械及びブレード制御方法
CN103874804A (zh) 2013-03-08 2014-06-18 株式会社小松制作所 推土机及推土铲控制方法
US20140277956A1 (en) * 2013-03-15 2014-09-18 Novatel Inc. System and method for heavy equipment navigation and working edge positioning
JP2014173321A (ja) 2013-03-08 2014-09-22 Komatsu Ltd ブルドーザ及びブレード制御方法
US20140345889A1 (en) * 2012-08-06 2014-11-27 Komatsu Ltd. Work machine and automatic control method for blade of work machine

Patent Citations (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20090069987A1 (en) * 2007-09-12 2009-03-12 Topcon Positioning Systems, Inc. Automatic Blade Control System with Integrated Global Navigation Satellite System and Inertial Sensors
JP2010539478A (ja) 2007-09-12 2010-12-16 トプコン ポジショニング システムズ， インク． 統合された全地球的航法衛星システム・センサおよび慣性センサを有する自動ブレード制御システム
US20120130602A1 (en) 2007-09-12 2012-05-24 Topcon Positioning Systems, Inc. Automatic Blade Control System with Integrated Global Navigation Satellite System and Inertial Sensors
JP5161403B1 (ja) 2011-09-30 2013-03-13 株式会社小松製作所 ブレード制御システムおよび建設機械
US8655556B2 (en) * 2011-09-30 2014-02-18 Komatsu Ltd. Blade control system and construction machine
US20140345889A1 (en) * 2012-08-06 2014-11-27 Komatsu Ltd. Work machine and automatic control method for blade of work machine
JP2014084683A (ja) 2012-10-26 2014-05-12 Komatsu Ltd ブレード制御装置、作業機械及びブレード制御方法
CN103906877A (zh) 2012-10-26 2014-07-02 株式会社小松制作所 推土铲控制装置、作业机械及推土铲控制方法
JP5285805B1 (ja) 2012-10-26 2013-09-11 株式会社小松製作所 ブレード制御装置、作業機械及びブレード制御方法
US20150019086A1 (en) * 2012-10-26 2015-01-15 Komatsu Ltd. Blade control device, working machine and blade control method
US9026319B2 (en) 2012-10-26 2015-05-05 Komatsu Ltd. Blade control device, working machine and blade control method
CN103874804A (zh) 2013-03-08 2014-06-18 株式会社小松制作所 推土机及推土铲控制方法
US20140257646A1 (en) * 2013-03-08 2014-09-11 Komatsu Ltd. Bulldozer and blade control method
JP2014173321A (ja) 2013-03-08 2014-09-22 Komatsu Ltd ブルドーザ及びブレード制御方法
US20140277956A1 (en) * 2013-03-15 2014-09-18 Novatel Inc. System and method for heavy equipment navigation and working edge positioning

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
International Search Report and Written Opinion dated Feb. 3, 2015, issued for corresponding International Patent Application No. PCT/JP2014/078977.

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10392774B2 (en) * 2017-10-30 2019-08-27 Deere & Company Position control system and method for an implement of a work vehicle
US12031291B2 (en) 2018-05-31 2024-07-09 Komatsu Ltd. Blade control device and blade control method
US10533301B1 (en) * 2018-12-20 2020-01-14 David Armas GPS and laser grading control

Also Published As

Publication number Publication date
US20160122969A1 (en) 2016-05-05
JP5807128B1 (ja) 2015-11-10
CN105745379B (zh) 2018-02-27
JPWO2015083469A1 (ja) 2017-03-16
WO2015083469A1 (ja) 2015-06-11
CN105745379A (zh) 2016-07-06

Similar Documents

Publication Publication Date Title
US9903096B2 (en) Blade control apparatus, work vehicle, and method of controlling a blade
US9026319B2 (en) Blade control device, working machine and blade control method
US9222236B2 (en) Bulldozer and blade control method
CN109099033B (zh) 利用传感器融合反馈在机器中控制流体压力的方法和系统
US10822771B2 (en) System for controlling work vehicle, method for controlling work vehicle, and work vehicle
US11041289B2 (en) System for controlling work vehicle, method for controlling work vehicle, and work vehicle
JP5391345B1 (ja) ブルドーザ及びブレード制御方法
US11661724B2 (en) Control system for work vehicle, method, and work vehicle
US11174619B2 (en) System for controlling work vehicle, method for controlling work vehicle, and work vehicle
US10671074B2 (en) Control system for work vehicle, method, and work vehicle
US11371218B2 (en) Control system for work vehicle, control mei'hod, and work vehicle
US11643789B2 (en) Control system for work vehicle, method, and work vehicle
US11454007B2 (en) Control system for work vehicle, method, and work vehicle
EP4143388A1 (en) Hystat swing motion actuation, monitoring, and control system
US9617710B2 (en) Work vehicle and method for controlling work vehicle
US11608611B2 (en) Control system for work vehicle, method, and work vehicle
US11136742B2 (en) System for controlling work vehicle, method for controlling work vehicle, and work vehicle
US11149412B2 (en) Control system for work machine, method, and work machine
US20200370281A1 (en) Control system for work vehicle, method, and work vehicle
KR102428131B1 (ko) 작업 기계
US20240044104A1 (en) Work machine and method for controlling work machine
US20230383495A1 (en) System and method for controlling work machine, and work machine

Legal Events

Date Code Title Description
AS Assignment

Owner name: KOMATSU LTD., JAPAN

Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNORS:NOBORIO, DAICHI;TANAKA, MASAYA;REEL/FRAME:035172/0141

Effective date: 20150220

STCF Information on status: patent grant

Free format text: PATENTED CASE

MAFP Maintenance fee payment

Free format text: PAYMENT OF MAINTENANCE FEE, 4TH YEAR, LARGE ENTITY (ORIGINAL EVENT CODE: M1551); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY

Year of fee payment: 4