WO2018030220A1 - 建設機械の制御システム、建設機械、及び建設機械の制御方法 - Google Patents

建設機械の制御システム、建設機械、及び建設機械の制御方法 Download PDF

Info

Publication number
WO2018030220A1
WO2018030220A1 PCT/JP2017/027910 JP2017027910W WO2018030220A1 WO 2018030220 A1 WO2018030220 A1 WO 2018030220A1 JP 2017027910 W JP2017027910 W JP 2017027910W WO 2018030220 A1 WO2018030220 A1 WO 2018030220A1
Authority
WO
WIPO (PCT)
Prior art keywords
bucket
tilt
angle
target
axis
Prior art date
Application number
PCT/JP2017/027910
Other languages
English (en)
French (fr)
Inventor
和生 竹原
市原 将志
吉朗 岩崎
Original Assignee
株式会社小松製作所
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 株式会社小松製作所 filed Critical 株式会社小松製作所
Priority to KR1020187033137A priority Critical patent/KR102165663B1/ko
Priority to CN201780031792.0A priority patent/CN109154150B/zh
Priority to US16/301,503 priority patent/US20190292747A1/en
Priority to DE112017002603.2T priority patent/DE112017002603T5/de
Priority to JP2018532960A priority patent/JP7129907B2/ja
Publication of WO2018030220A1 publication Critical patent/WO2018030220A1/ja

Links

Images

Classifications

    • 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/43Control of dipper or bucket position; Control of sequence of drive operations
    • 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/422Drive systems for bucket-arms, front-end loaders, dumpers or the like
    • 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/3604Devices to connect tools to arms, booms or the like
    • E02F3/3677Devices to connect tools to arms, booms or the like allowing movement, e.g. rotation or translation, of the tool around or along another axis as the movement implied by the boom or arms, e.g. for tilting buckets
    • 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/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/431Control of dipper or bucket position; Control of sequence of drive operations for bucket-arms, front-end loaders, dumpers or the like
    • E02F3/432Control of dipper or bucket position; Control of sequence of drive operations for bucket-arms, front-end loaders, dumpers or the like for keeping the bucket in a predetermined position or attitude
    • 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/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • 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/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • E02F3/437Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like providing automatic sequences of movements, e.g. linear excavation, keeping dipper angle constant
    • 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
    • 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/2025Particular purposes of control systems not otherwise provided for
    • E02F9/2033Limiting the movement of frames or implements, e.g. to avoid collision between implements and the cabin
    • 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/261Surveying the work-site to be treated
    • E02F9/262Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller
    • 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)
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60YINDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2200/00Type of vehicle
    • B60Y2200/40Special vehicles
    • B60Y2200/41Construction vehicles, e.g. graders, excavators
    • B60Y2200/412Excavators
    • 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/02Travelling-gear, e.g. associated with slewing gears

Definitions

  • the present invention relates to a construction machine control system, a construction machine, and a construction machine control method.
  • Patent Document 1 A construction machine having a working machine having a tilt bucket as disclosed in Patent Document 1 is known.
  • intervention control In the technical field related to construction machine control, a technique for controlling a work machine in preference to operation of an operation device by a construction machine operator is known. In this specification, controlling the work machine in preference to the operation of the operating device by the operator of the construction machine is referred to as intervention control.
  • the position or posture of at least one of the boom, the arm, and the bucket of the work machine is controlled with respect to the target construction landform indicating the target shape of the excavation target.
  • the construction according to the target construction topography is carried out.
  • the work efficiency of the construction machine is lowered unless the control specific to the tilt bucket is performed in addition to the existing intervention control.
  • aspects of the present invention provide a construction machine control system, a construction machine, and a construction machine control method capable of suppressing a decrease in work efficiency in a construction machine including a work machine having a tilt bucket.
  • control of a construction machine including an arm, and a working machine including a bucket shaft and a bucket that is rotatable with respect to the arm about each of a tilt shaft orthogonal to the bucket shaft.
  • a tilt angle indicating an angle of the specific part of the bucket with the tilt axis as a center is determined so that a target construction topography indicating a target shape of an excavation target and the specific part of the bucket are parallel to each other.
  • a construction machine control system comprising: an angle determination unit that controls the tilt cylinder that rotates the bucket around the tilt axis based on the tilt angle determined by the angle determination unit Is provided.
  • an upper swing body a lower traveling body that supports the upper swing body, the arm and the bucket, and a work implement supported by the upper swing body
  • a construction machine comprising the construction machine control system according to one aspect.
  • control of a construction machine including an arm and a working machine including a bucket shaft and a bucket that is rotatable with respect to the arm about each of a tilt shaft orthogonal to the bucket shaft.
  • a tilt angle indicating an angle of the specific part of the bucket with the tilt axis as a center is determined so that a target construction topography indicating a target shape of an excavation target and the specific part of the bucket are parallel to each other.
  • a control method for the construction machine including: controlling a tilt cylinder that rotates the bucket about the tilt axis based on the tilt angle determined by the angle determination unit.
  • a construction machine control system capable of suppressing a decrease in work efficiency in a construction machine including a work machine having a tilt bucket.
  • FIG. 1 is a perspective view illustrating an example of a construction machine according to the present embodiment.
  • FIG. 2 is a side sectional view showing an example of the bucket according to the present embodiment.
  • FIG. 3 is a front view showing an example of the bucket according to the present embodiment.
  • FIG. 4 is a side view schematically showing the hydraulic excavator according to the present embodiment.
  • FIG. 5 is a rear view schematically showing the hydraulic excavator according to the present embodiment.
  • FIG. 6 is a plan view schematically showing the hydraulic excavator according to the present embodiment.
  • FIG. 7 is a side view schematically showing the bucket according to the present embodiment.
  • FIG. 8 is a front view schematically showing the bucket according to the present embodiment.
  • FIG. 1 is a perspective view illustrating an example of a construction machine according to the present embodiment.
  • FIG. 2 is a side sectional view showing an example of the bucket according to the present embodiment.
  • FIG. 3 is a front view showing an example of the bucket according to the
  • FIG. 9 is a schematic diagram illustrating an example of a hydraulic system according to the present embodiment.
  • FIG. 10 is a schematic diagram illustrating an example of a hydraulic system according to the present embodiment.
  • FIG. 11 is a functional block diagram illustrating an example of a control system according to the present embodiment.
  • FIG. 12 is a diagram schematically illustrating an example of the specified points set in the bucket according to the present embodiment.
  • FIG. 13 is a schematic diagram illustrating an example of target construction data according to the present embodiment.
  • FIG. 14 is a schematic diagram showing an example of the target construction landform according to the present embodiment.
  • FIG. 15 is a schematic diagram illustrating an example of a tilt operation plane according to the present embodiment.
  • FIG. 16 is a schematic diagram illustrating an example of a tilt operation plane according to the present embodiment.
  • FIG. 17 is a diagram schematically illustrating the relationship between the cutting edge of the bucket and the target construction landform according to the present embodiment.
  • FIG. 18 is a schematic diagram for explaining the intervention control for the tilt rotation according to the present embodiment.
  • FIG. 19 is a diagram illustrating an example of the relationship between the operating distance and the target speed according to the present embodiment.
  • FIG. 20 is a flowchart illustrating an example of a method for adjusting the tilt angle of the bucket according to the present embodiment.
  • FIG. 21 is a schematic diagram for explaining an example of a method for adjusting the tilt angle of the bucket according to the present embodiment.
  • FIG. 22 is a diagram schematically illustrating an example of the operation of the work machine according to the present embodiment.
  • FIG. 23 is a diagram schematically illustrating an example of the operation of the work machine according to the present embodiment.
  • FIG. 24 is a flowchart illustrating an example of a method for adjusting the tilt angle of the bucket according to the present embodiment.
  • FIG. 25 is a schematic diagram for explaining an example of a method for adjusting the tilt angle of the bucket according to the present embodiment.
  • FIG. 26 is a schematic diagram for explaining an example of a method for adjusting the tilt angle of the bucket according to the present embodiment.
  • a three-dimensional global coordinate system (Xg, Yg, Zg) and a three-dimensional vehicle body coordinate system (Xm, Ym, Zm) are defined, and the positional relationship of each part will be described.
  • the global coordinate system is a coordinate system based on the origin fixed on the earth.
  • the global coordinate system is a coordinate system defined by GNSS (Global Navigation Satellite System).
  • GNSS refers to the global navigation satellite system.
  • GPS Global Positioning System
  • the GNSS has a plurality of positioning satellites. The GNSS detects a position defined by latitude, longitude, and altitude coordinate data.
  • the global coordinate system is defined by the Xg axis in the horizontal plane, the Yg axis orthogonal to the Xg axis in the horizontal plane, and the Zg axis orthogonal to the Xg axis and the Yg axis.
  • the direction parallel to the Xg axis is the Xg axis direction
  • the direction parallel to the Yg axis is the Yg axis direction
  • the direction parallel to the Zg axis is the Zg axis direction.
  • the rotation or tilt direction around the Xg axis is the ⁇ Xg direction
  • the rotation or tilt direction around the Yg axis is the ⁇ Yg direction
  • the rotation or tilt direction around the Zg axis is the ⁇ Zg direction.
  • the Zg axis direction is the vertical direction.
  • the vehicle body coordinate system is a coordinate system based on the origin fixed to the construction machine.
  • the vehicle body coordinate system is defined by an Xm axis extending in one direction with respect to the origin fixed to the vehicle body of the construction machine, a Ym axis orthogonal to the Xm axis, and a Zm axis orthogonal to the Xm axis and the Ym axis.
  • the direction parallel to the Xm axis is the Xm axis direction
  • the direction parallel to the Ym axis is the Ym axis direction
  • the direction parallel to the Zm axis is the Zm axis direction.
  • the rotation or tilt direction around the Xm axis is taken as the ⁇ Xm direction
  • the rotation or tilt direction around the Ym axis is taken as the ⁇ Ym direction
  • the rotation or tilt direction around the Zm axis is taken as the ⁇ Zm direction.
  • the Xm-axis direction is the longitudinal direction of the construction machine
  • the Ym-axis direction is the vehicle width direction of the construction machine
  • the Zm-axis direction is the vertical direction of the construction machine.
  • FIG. 1 is a perspective view showing an example of a construction machine 100 according to the present embodiment.
  • the construction machine 100 is a hydraulic excavator
  • the construction machine 100 is appropriately referred to as a hydraulic excavator 100.
  • a hydraulic excavator 100 includes a working machine 1 that is operated by hydraulic pressure, an upper swing body 2 that is a vehicle body that supports the work machine 1, and a lower traveling body that is a traveling device that supports the upper swing body 2. 3, an operating device 30 for operating the work machine 1, and a control device 50 for controlling the work machine 1.
  • the upper swing body 2 can swing around the swing axis RX while being supported by the lower traveling body 3.
  • the upper swing body 2 has a cab 4 in which an operator is boarded, and a machine room 5 in which an engine and a hydraulic pump are accommodated.
  • the cab 4 has a driver's seat 4S on which an operator is seated.
  • the machine room 5 is disposed behind the cab 4.
  • the lower traveling body 3 has a pair of crawler belts 3C.
  • the excavator 100 travels by the rotation of the crawler belt 3C.
  • the lower traveling body 3 may have a tire.
  • the work machine 1 is supported by the upper swing body 2.
  • the work machine 1 includes a boom 6 connected to the upper swing body 2 via a boom pin, an arm 7 connected to the boom 6 via an arm pin, and a bucket 8 connected to the arm 7 via a bucket pin and a tilt pin. And have.
  • the bucket 8 has a cutting edge 9.
  • the blade edge 9 of the bucket 8 is the tip of a straight blade provided on the bucket 8.
  • the blade edge 9 of the bucket 8 may be a tip of a convex blade provided on the bucket 8.
  • the boom 6 can be rotated with respect to the upper swing body 2 around a boom axis AX1 which is a rotation axis.
  • the arm 7 is rotatable with respect to the boom 6 around an arm axis AX2 that is a rotation axis.
  • the bucket 8 is rotatable with respect to the arm 7 around a bucket axis AX3 that is a rotation axis and a tilt axis AX4 that is a rotation axis orthogonal to the bucket axis AX3.
  • the rotation axis AX1, the rotation axis AX2, and the rotation axis AX3 are parallel to each other.
  • the rotation axes AX1, AX2, AX3 and the axis parallel to the turning axis RX are orthogonal to each other.
  • the rotation axes AX1, AX2, AX3 are parallel to the Ym axis of the vehicle body coordinate system.
  • the turning axis RX is parallel to the Zm axis of the vehicle body coordinate system.
  • the direction parallel to the rotation axes AX1, AX2, AX3 indicates the vehicle width direction of the upper swing body 2.
  • the direction parallel to the turning axis RX indicates the vertical direction of the upper turning body 2.
  • the direction orthogonal to both the rotation axes AX1, AX2, AX3 and the turning axis RX indicates the front-rear direction of the upper turning body 2.
  • the direction in which the work implement 1 is present is based on the operator seated on the driver's seat 4S.
  • the work machine 1 is operated by the power generated by the hydraulic cylinder 10.
  • the hydraulic cylinder 10 includes a boom cylinder 11 that operates the boom 6, an arm cylinder 12 that operates the arm 7, and a bucket cylinder 13 and a tilt cylinder 14 that operate the bucket 8.
  • the boom cylinder 11 can generate power for rotating the boom 6 around the boom axis AX1.
  • the arm cylinder 12 can generate power for rotating the arm 7 about the arm axis AX2.
  • the bucket cylinder 13 can generate power for rotating the bucket 8 about the bucket shaft AX3.
  • the tilt cylinder 14 can generate power for rotating the bucket 8 about the tilt axis AX4.
  • the rotation of the bucket 8 around the bucket axis AX3 is appropriately referred to as bucket rotation
  • the rotation of the bucket 8 around the tilt axis AX4 is appropriately referred to as tilt rotation.
  • the work machine 1 includes a boom stroke sensor 16 that detects a boom stroke that indicates the drive amount of the boom cylinder 11, an arm stroke sensor 17 that detects an arm stroke that indicates the drive amount of the arm cylinder 12, and the drive of the bucket cylinder 13.
  • a bucket stroke sensor 18 that detects a bucket stroke indicating the amount and a tilt stroke sensor 19 that detects a tilt stroke indicating the drive amount of the tilt cylinder 14 are provided.
  • the boom stroke sensor 16 is disposed in the boom cylinder 11.
  • the arm stroke sensor 17 is disposed in the arm cylinder 12.
  • the bucket stroke sensor 18 is disposed in the bucket cylinder 13.
  • the tilt stroke sensor 19 is disposed on the tilt cylinder 14.
  • the operating device 30 is arranged in the cab 4.
  • the operation device 30 includes an operation member that is operated by an operator of the excavator 100.
  • the operator operates the operating device 30 to activate the work machine 1.
  • the operation device 30 includes a right work machine operation lever 30R, a left work machine operation lever 30L, a tilt operation lever 30T, and an operation pedal 30F.
  • the relationship between the operation direction of the right work machine operation lever 30R and the left work machine operation lever 30L, the operation direction of the work machine 1, and the turning direction of the upper swing body 2 may not be the above-described relation.
  • the control device 50 includes a computer system.
  • the control device 50 includes a processor such as a CPU (Central Processing Unit), a non-volatile memory such as a ROM (Read Only Memory) and a volatile memory such as a RAM (Random Access Memory), and an input / output And an interface device.
  • a processor such as a CPU (Central Processing Unit)
  • a non-volatile memory such as a ROM (Read Only Memory)
  • a volatile memory such as a RAM (Random Access Memory)
  • FIG. 2 is a side sectional view showing an example of the bucket 8 according to the present embodiment.
  • FIG. 3 is a front view showing an example of the bucket 8 according to the present embodiment.
  • the bucket 8 is a tilt type bucket.
  • the work machine 1 has a bucket 8 that can rotate with respect to the arm 7 around a bucket axis AX3 and a tilt axis AX4 orthogonal to the bucket axis AX3.
  • Bucket 8 is rotatably connected to arm 7 via bucket pin 8B.
  • the bucket 8 is rotatably supported by the arm 7 via a tilt pin 8T.
  • the bucket 8 is connected to the tip of the arm 7 via the connection member 90.
  • the bucket pin 8 ⁇ / b> B connects the arm 7 and the connection member 90.
  • the tilt pin 8T connects the connecting member 90 and the bucket 8 together.
  • the bucket 8 is rotatably connected to the arm 7 via a connection member 90.
  • the bucket 8 includes a bottom plate 81, a back plate 82, an upper plate 83, a side plate 84, and a side plate 85.
  • the opening 86 of the bucket 8 is defined by the bottom plate 81, the upper plate 83, the side plate 84, and the side plate 85.
  • the cutting edge 9 is provided on the bottom plate 81.
  • the bottom plate 81 has a flat floor surface 89 connected to the cutting edge 9.
  • the floor surface 89 is the bottom surface of the bottom plate 81.
  • the floor surface 89 is substantially flat.
  • the bucket 8 has a bracket 87 provided on the upper part of the upper plate 83.
  • the bracket 87 is installed at the front and rear positions of the upper plate 83.
  • the bracket 87 is coupled to the connection member 90 and the tilt pin 8T.
  • the connecting member 90 includes a plate member 91, a bracket 92 provided on the upper surface of the plate member 91, and a bracket 93 provided on the lower surface of the plate member 91.
  • the bracket 92 is connected to the arm 7 and the second link pin 95P.
  • the bracket 93 is installed on the upper portion of the bracket 87 and connected to the tilt pin 8T and the bracket 87.
  • the bucket pin 8B connects the bracket 92 of the connection member 90 and the tip of the arm 7 together.
  • the tilt pin 8T connects the bracket 93 of the connection member 90 and the bracket 87 of the bucket 8 together.
  • the connecting member 90 and the bucket 8 are rotatable about the bucket axis AX3 with respect to the arm 7.
  • the bucket 8 is rotatable about the tilt axis AX4 with respect to the connection member 90.
  • the work machine 1 includes a first link member 94 that is rotatably connected to the arm 7 via the first link pin 94P, and a second link member that is rotatably connected to the bracket 92 via the second link pin 95P. 95.
  • the base end portion of the first link member 94 is connected to the arm 7 via the first link pin 94P.
  • the base end portion of the second link member 95 is connected to the bracket 92 via the second link pin 95P.
  • the distal end portion of the first link member 94 and the distal end portion of the second link member 95 are connected via a bucket cylinder top pin 96.
  • the tip of the bucket cylinder 13 is rotatably connected to the tip of the first link member 94 and the tip of the second link member 95 via the bucket cylinder top pin 96.
  • the connecting member 90 rotates about the bucket axis AX3 together with the bucket 8.
  • the tilt cylinder 14 is connected to each of a bracket 97 provided on the connection member 90 and a bracket 88 provided on the bucket 8.
  • the rod of the tilt cylinder 14 is connected to the bracket 97 via a pin.
  • the main body of the tilt cylinder 14 is connected to the bracket 88 via a pin.
  • the bucket 8 rotates around the bucket axis AX3 by the operation of the bucket cylinder 13.
  • the bucket 8 rotates around the tilt axis AX4 by the operation of the tilt cylinder 14.
  • the tilt pin 8T rotates together with the bucket 8.
  • FIG. 4 is a side view schematically showing the excavator 100 according to the present embodiment.
  • FIG. 5 is a rear view schematically showing the excavator 100 according to the present embodiment.
  • FIG. 6 is a plan view schematically showing the excavator 100 according to the present embodiment.
  • FIG. 7 is a side view schematically showing the bucket 8 according to the present embodiment.
  • FIG. 8 is a front view schematically showing the bucket 8 according to the present embodiment.
  • the detection system 400 includes a position calculation device 20 that calculates the position of the upper swing body 2, and a work machine angle calculation device 24 that calculates the angle of the work machine 1. Have.
  • the position calculator 20 includes a vehicle body position calculator 21 that detects the position of the upper swing body 2, an attitude calculator 22 that detects the attitude of the upper swing body 2, and an orientation calculator 23 that detects the orientation of the upper swing body 2. Including.
  • the vehicle body position calculator 21 includes a GPS receiver.
  • the vehicle body position calculator 21 is provided on the upper swing body 2.
  • the vehicle body position calculator 21 detects the absolute position Pg of the upper swing body 2 defined by the global coordinate system.
  • the absolute position Pg of the upper swing body 2 includes coordinate data in the Xg axis direction, coordinate data in the Yg axis direction, and coordinate data in the Zg axis direction.
  • a plurality of GPS antennas 21 ⁇ / b> A are provided on the upper swing body 2.
  • the GPS antenna 21 ⁇ / b> A receives a radio wave from a GPS satellite and outputs a signal generated based on the received radio wave to the vehicle body position calculator 21.
  • the vehicle body position calculator 21 detects the position Pr where the GPS antenna 21A defined by the global coordinate system is installed based on the signal supplied from the GPS antenna 21A.
  • the vehicle body position calculator 21 detects the absolute position Pg of the upper swing body 2 based on the position Pr where the GPS antenna 21A is installed.
  • the vehicle body position calculator 21 detects a position Pra where one GPS antenna 21A is installed and a position Prb where the other GPS antenna 21A is installed.
  • the vehicle body position calculator 21A performs an arithmetic process based on at least one of the position Pra and the position Prb, and calculates the absolute position Pg of the upper swing body 2.
  • the absolute position Pg of the upper swing body 2 is the position Pra.
  • the absolute position Pg of the upper swing body 2 may be the position Prb or a position between the position Pra and the position Prb.
  • the attitude calculator 22 includes an inertial measurement unit (Inertial Measurement Unit: IMU).
  • IMU Inertial Measurement Unit
  • the posture calculator 22 is provided in the upper swing body 2.
  • the posture calculator 22 calculates an inclination angle of the upper swing body 2 with respect to a horizontal plane (XgYg plane) defined by the global coordinate system.
  • the tilt angle of the upper swing body 2 with respect to the horizontal plane includes a roll angle ⁇ 1 that indicates the tilt angle of the upper swing body 2 in the vehicle width direction and a pitch angle ⁇ 2 that indicates the tilt angle of the upper swing body 2 in the front-rear direction.
  • the azimuth calculator 23 is based on the position Pra where one GPS antenna 21A is installed and the position Prb where the other GPS antenna 21A is installed. Is calculated.
  • the reference orientation is, for example, north.
  • the azimuth calculator 23 performs a calculation process based on the position Pra and the position Prb, and calculates the azimuth of the upper swing body 2 with respect to the reference azimuth.
  • the azimuth calculator 23 calculates a straight line connecting the position Pra and the position Prb, and calculates the azimuth of the upper swing body 2 with respect to the reference azimuth based on the angle formed by the calculated straight line and the reference azimuth.
  • the azimuth of the upper swing body 2 with respect to the reference azimuth includes a yaw angle ⁇ 3 indicating an angle formed by the reference azimuth and the azimuth of the upper swing body 2.
  • the work machine angle calculation device 24 indicates the tilt angle of the boom 6 with respect to the Zm axis of the vehicle body coordinate system based on the boom stroke detected by the boom stroke sensor 16.
  • the boom angle ⁇ is calculated.
  • the work machine angle calculation device 24 calculates an arm angle ⁇ indicating an inclination angle of the arm 7 with respect to the boom 6.
  • the work machine angle calculation device 24 calculates a bucket angle ⁇ indicating the inclination angle of the blade edge 9 of the bucket 8 with respect to the arm 7 based on the bucket stroke detected by the bucket stroke sensor 18.
  • the work machine angle calculation device 24 calculates a tilt angle ⁇ indicating the tilt angle of the bucket 8 with respect to the XmYm plane of the vehicle body coordinate system.
  • the work machine angle calculation device 24 uses the boom stroke detected by the boom stroke sensor 16, the arm stroke detected by the arm stroke sensor 17, and the tilt stroke detected by the bucket stroke sensor 18 in the XmYm of the vehicle body coordinate system.
  • a tilt axis angle ⁇ indicating the tilt angle of the tilt axis AX4 with respect to the plane is calculated.
  • the boom angle ⁇ , the arm angle ⁇ , the bucket angle ⁇ , the tilt angle ⁇ , and the tilt axis angle ⁇ may be detected by, for example, an angle sensor provided in the work implement 10 without using the stroke sensor. Further, the angle of the work machine 10 is optically detected by a stereo camera or a laser scanner, and the boom angle ⁇ , arm angle ⁇ , bucket angle ⁇ , tilt angle ⁇ , and tilt axis angle ⁇ are calculated using the detection results. May be.
  • FIGS. 9 and 10 are schematic diagrams illustrating an example of a hydraulic system 300 according to the present embodiment.
  • the hydraulic cylinder 10 including the boom cylinder 11, the arm cylinder 12, the bucket cylinder 13, and the tilt cylinder 14 is driven by a hydraulic system 300.
  • the hydraulic system 300 supplies hydraulic oil to the hydraulic cylinder 10 to drive the hydraulic cylinder 10.
  • the hydraulic system 300 has a flow control valve 25.
  • the flow control valve 25 controls the amount of hydraulic oil supplied to the hydraulic cylinder 10 and the direction in which the hydraulic oil flows.
  • the hydraulic cylinder 10 has a cap side oil chamber 10A and a rod side oil chamber 10B.
  • the cap side oil chamber 10A is a space between the cylinder head cover and the piston.
  • the rod side oil chamber 10B is a space in which the piston rod is disposed.
  • FIG. 9 is a schematic diagram showing an example of a hydraulic system 300 that operates the arm cylinder 12.
  • the hydraulic system 300 is disposed in a variable displacement main hydraulic pump 31 that supplies hydraulic oil, a pilot pressure pump 32 that supplies pilot oil, oil passages 33A and 33B through which pilot oil flows, and oil passages 33A and 33B.
  • right work machine operation lever 30R and left work machine operation lever 30L for adjusting the pilot pressure for the flow rate control valve 25.
  • Including an operating device 30 and a control device 50 The right working machine operating lever 30R and the left working machine operating lever 30L of the operating device 30 are pilot hydraulic operating devices.
  • the hydraulic oil supplied from the main hydraulic pump 31 is supplied to the arm cylinder 12 via the flow control valve 25.
  • the flow rate control valve 25 is a slide spool type flow rate control valve that switches a direction in which hydraulic oil flows by moving a rod-shaped spool in the axial direction. As the spool moves in the axial direction, the supply of hydraulic oil to the cap-side oil chamber 10A of the arm cylinder 12 and the supply of hydraulic oil to the rod-side oil chamber 10B are switched. Further, the amount of hydraulic oil supplied per unit time to the arm cylinder 12 is adjusted by moving the spool in the axial direction. The cylinder speed is adjusted by adjusting the amount of hydraulic oil supplied to the arm cylinder 12.
  • the flow control valve 25 is operated by the operating device 30. Pilot oil sent from the pilot pressure pump 32 is supplied to the operating device 30. Pilot oil sent from the main hydraulic pump 31 and decompressed by the pressure reducing valve may be supplied to the operating device 30.
  • the operating device 30 includes a pilot pressure adjustment valve. Based on the operation amount of the operating device 30, the control valves 37A and 37B are operated, and the pilot pressure acting on the spool of the flow control valve 25 is adjusted. The flow control valve 25 is driven by the pilot pressure. By adjusting the pilot pressure by the operating device 30, the moving amount, moving speed, and moving direction of the spool in the axial direction are adjusted.
  • the flow control valve 25 has a first pressure receiving chamber and a second pressure receiving chamber.
  • the left work implement operation lever 30L When the left work implement operation lever 30L is operated to tilt to one side from the neutral position and the spool moves due to the pilot pressure in the oil passage 33A, the hydraulic oil from the main hydraulic pump 31 is supplied to the first pressure receiving chamber, The hydraulic oil is supplied to the cap side oil chamber 10A through the path 35A.
  • the left work implement operating lever 30L is operated so as to tilt from the neutral position to the other side and the spool is moved by the pilot pressure in the oil passage 33B, the hydraulic oil from the main hydraulic pump 31 is supplied to the second pressure receiving chamber, The hydraulic oil is supplied to the rod side oil chamber 10B through the path 35B.
  • the pressure sensor 34A detects the pilot pressure in the oil passage 33A.
  • the pressure sensor 34B detects the pilot pressure in the oil passage 33B. Detection signals from the pressure sensors 33A and 33B are output to the control device 50. When performing the intervention control, the control device 50 adjusts the pilot pressure by outputting a control signal to the control valves 37A and 37B.
  • the hydraulic system 300 that operates the boom cylinder 11 and the bucket cylinder 13 has the same configuration as the hydraulic system 300 that operates the arm cylinder 12. A detailed description of the hydraulic system 300 that operates the boom cylinder 11 and the bucket cylinder 13 is omitted.
  • an intervention control valve that intervenes in the raising operation of the boom 6 may be connected to the oil passage 33 ⁇ / b> A connected to the boom cylinder 11.
  • the right work machine operation lever 30R and the left work machine operation lever 30L of the operation device 30 may not be of a pilot hydraulic system.
  • the right work machine operation lever 30R and the left work machine operation lever 30L output an electrical signal to the control device 50 based on the operation amount (tilt angle) of the right work machine operation lever 30R and the left work machine operation lever 30L, and control them.
  • An electronic lever system that directly controls the flow control valve 25 based on a control signal of the device 50 may be used.
  • FIG. 10 is a diagram schematically illustrating an example of a hydraulic system 300 that operates the tilt cylinder 14.
  • the hydraulic system 300 includes a flow control valve 25 that adjusts the amount of hydraulic oil supplied to the tilt cylinder 14, control valves 37A and 37B that adjust pilot pressure acting on the flow control valve 25, a pilot pressure pump 32, and an operation pedal 30F.
  • the operation pedal 30F of the operation device 30 is a pilot hydraulic operation device.
  • the tilt operation lever 30T of the operation device 30 is an electronic lever type operation device.
  • the tilt operation lever 30T includes operation buttons provided on the right work machine operation lever 30R and the left work machine operation lever 30L.
  • the operating pedal 30F of the operating device 30 is connected to the pilot pressure pump 32.
  • the operation pedal 30F is connected to an oil passage 38A through which pilot oil sent from the control valve 37A flows through a shuttle valve 36A.
  • the operation pedal 30F is connected to an oil passage 38B through which pilot oil sent from the control valve 37B flows through a shuttle valve 36B.
  • an operation signal generated by the operation of the tilt operation lever 30T is output to the control device 50.
  • the control device 50 generates a control signal based on the operation signal output from the tilt operation lever 30T, and controls the control valves 37A and 37B.
  • the control valves 37A and 37B are electromagnetic proportional control valves.
  • the control valve 37A opens and closes the oil passage 38A based on the control signal.
  • the control valve 37B opens and closes the oil passage 38B based on the control signal.
  • the pilot pressure is adjusted based on the operation amount of the operation device 30.
  • the control device 50 outputs a control signal to the control valves 37A and 37B to adjust the pilot pressure.
  • FIG. 11 is a functional block diagram illustrating an example of the control system 200 according to the present embodiment.
  • the control system 200 includes a control device 50 that controls the work implement 1, a position calculation device 20, a work implement angle calculation device 24, a control valve 37 (37A, 37B), and target construction data. And a generation device 70.
  • the position calculation device 20 includes a vehicle body position calculator 21, an attitude calculator 22, and an azimuth calculator 23.
  • the position calculation device 20 detects the absolute position Pg of the upper swing body 2, the posture of the upper swing body 2 including the roll angle ⁇ 1 and the pitch angle ⁇ 2, and the orientation of the upper swing body 2 including the yaw angle ⁇ 3.
  • the work machine angle calculation device 24 detects angles of the work machine 1 including the boom angle ⁇ , the arm angle ⁇ , the bucket angle ⁇ , the tilt angle ⁇ , and the tilt axis angle ⁇ .
  • the control valve 37 (37A, 37B) adjusts the amount of hydraulic oil supplied to the tilt cylinder 14.
  • the control valve 37 operates based on a control signal from the control device 50.
  • the target construction data generation device 70 includes a computer system.
  • the target construction data generation device 70 generates target construction data indicating the target topography that is the target shape of the construction area.
  • the target construction data indicates a three-dimensional target shape obtained after construction by the work machine 1.
  • the target construction data generation device 70 is provided at a remote location of the excavator 100.
  • the target construction data generation device 70 is installed in equipment of a construction management company, for example.
  • the target construction data generation device 70 may be owned by a manufacturer or a rental company of the excavator 100.
  • the target construction data generation device 70 and the control device 50 can communicate wirelessly.
  • the target construction data generated by the target construction data generation device 70 is transmitted to the control device 50 wirelessly.
  • the target construction data generation device 70 and the control device 50 may be connected by wire, and the target construction data may be transmitted from the target construction data generation device 70 to the control device 50.
  • the target construction data generation device 70 may include a recording medium that stores the target construction data
  • the control device 50 may include a device that can read the target construction data from the recording medium.
  • the target construction data generation device 70 may be provided in the excavator 100.
  • the target construction data may be supplied to the target construction data generation device 70 of the excavator 100 by wire or wireless from an external management device that manages the construction, and the target construction data supplied by the target construction data generation device 70 may be stored. .
  • the control device 50 includes a vehicle body position data acquisition unit 51, a work machine angle data acquisition unit 52, a specified point position data calculation unit 53, a target construction landform generation unit 54, a tilt data calculation unit 55, and a tilt target landform calculation.
  • the functions of the control unit 58 and the target speed determination unit 59 are exhibited by the processor of the control device 50.
  • the function of the storage unit 60 is performed by the storage device of the control device 50.
  • the function of the input / output unit 61 is performed by the input / output interface device of the control device 50.
  • the input / output unit 61 is connected to the position calculation device 20, the work machine angle calculation device 24, the control valve 37, and the target construction data generation device 70, and includes a vehicle body position data acquisition unit 51, a work machine angle data acquisition unit 52, a specified point.
  • the storage unit 60 stores specification data of the excavator 100 including work implement data.
  • the vehicle body position data acquisition unit 51 acquires vehicle body position data from the position calculation device 20 via the input / output unit 61.
  • the vehicle body position data includes the absolute position Pg of the upper swing body 2 defined by the global coordinate system, the attitude of the upper swing body 2 including the roll angle ⁇ 1 and the pitch angle ⁇ 2, and the orientation of the upper swing body 2 including the yaw angle ⁇ 3. Including.
  • the work machine angle data acquisition unit 52 acquires the work machine angle data from the work machine angle calculation device 24 via the input / output unit 61.
  • the work machine angle data detects angles of the work machine 1 including a boom angle ⁇ , an arm angle ⁇ , a bucket angle ⁇ , a tilt angle ⁇ , and a tilt axis angle ⁇ .
  • the specified point position data calculation unit 53 includes vehicle body position data acquired by the vehicle body position data acquisition unit 51, work machine angle data acquired by the work machine angle data acquisition unit 52, and work stored in the storage unit 60. Based on the machine data, the position data of the specified point RP set in the bucket 8 is calculated.
  • the work implement data includes a boom length L1, an arm length L2, a bucket length L3, a tilt length L4, and a bucket width L5.
  • the boom length L1 is a distance between the boom axis AX1 and the arm axis AX2.
  • the arm length L2 is a distance between the arm axis AX2 and the bucket axis AX3.
  • Bucket length L3 is the distance between bucket axis AX3 and blade edge 9 of bucket 8.
  • the tilt length L4 is a distance between the bucket axis AX3 and the tilt axis AX4.
  • the bucket width L5 is a distance between the side plate 84 and the side plate 85.
  • FIG. 12 is a diagram schematically illustrating an example of the specified point RP set in the bucket 8 according to the present embodiment.
  • a plurality of specified points RP used for tilt bucket control are set in the bucket 8.
  • the specified point RP is set on the outer surface of the bucket 8 including the blade edge 9 and the floor surface 89 of the bucket 8.
  • a plurality of prescribed points RP are set in the bucket width direction at the blade edge 9.
  • a plurality of specified points RP are set on the outer surface of the bucket 8 including the floor surface 89.
  • the work machine data includes bucket outer shape data indicating the shape and dimensions of the bucket 8.
  • the bucket outer shape data includes the width data of the bucket 8 indicating the bucket width L5. Further, the bucket outer shape data includes outer surface data of the bucket 8 including contour data of the outer surface of the bucket 8. Further, the bucket outer shape data includes coordinate data of a plurality of specified points RP of the bucket 8 with the cutting edge 9 of the bucket 8 as a reference.
  • the specified point position data calculation unit 53 calculates the position data of the specified point RP.
  • the specified point position data calculation unit 53 calculates the relative position of each of the specified points RP with respect to the reference position P0 of the upper-part turning body 2 in the vehicle body coordinate system.
  • the specified point position data calculation unit 53 calculates the absolute position of each of the plurality of specified points RP in the global coordinate system.
  • the specified point position data calculation unit 53 includes work implement data including a boom length L1, an arm length L2, a bucket length L3, a tilt length L4, and bucket outer shape data, a boom angle ⁇ , an arm angle ⁇ , and a bucket angle. calculating the relative position of each of the plurality of specified points RP of the bucket 8 with respect to the reference position P0 of the upper-part turning body 2 in the vehicle body coordinate system, based on work implement angle data including ⁇ , tilt angle ⁇ , and tilt axis angle ⁇ . Can do. As shown in FIG. 4, the reference position P ⁇ b> 0 of the upper swing body 2 is set to the swing axis RX of the upper swing body 2. The reference position P0 of the upper swing body 2 may be set to the boom axis AX1.
  • the specified point position data calculation unit 53 is based on the absolute position Pg of the upper swing body 2 detected by the position calculation device 20 and the relative position between the reference position P0 of the upper swing body 2 and the bucket 8.
  • the absolute position Pa of the bucket 8 in the coordinate system can be calculated.
  • the relative position between the absolute position Pg and the reference position P0 is known data derived from the specification data of the excavator 100.
  • the specified point position data calculation unit 53 includes vehicle body position data including the absolute position Pg of the upper swing body 2, the relative position between the reference position P0 of the upper swing body 2 and the bucket 8, work implement data, and work implement angle data. Based on the above, the absolute position of each of the plurality of defined points RP of the bucket 8 in the global coordinate system can be calculated.
  • the target construction landform generation unit 54 generates the target construction landform CS indicating the target shape of the excavation target based on the target construction data supplied from the target construction data generation device 70 and stored in the storage unit 60.
  • the target construction data generation device 70 may supply the target construction topography generation unit 54 with the three-dimensional target topography data as the target construction data, or a plurality of line data or a plurality of point data indicating a part of the target shape. You may supply to the target construction topography production
  • FIG. 13 is a schematic diagram showing an example of the target construction data CD according to the present embodiment.
  • the target construction data CD indicates the target topography of the construction area.
  • the target landform includes a plurality of target construction landforms CS each represented by a triangular polygon.
  • Each of the plurality of target construction terrain CS indicates a target shape to be excavated by the work machine 1.
  • a point AP that is closest to the bucket 8 in the target construction topography CS is defined.
  • a work machine operation plane WP that passes through the point AP and the bucket 8 and is orthogonal to the bucket axis AX3 is defined.
  • the work machine operation plane WP is an operation plane in which the blade edge 9 of the bucket 8 is moved by at least one operation of the boom cylinder 11, the arm cylinder 12, and the bucket cylinder 13, and is parallel to the XZ plane.
  • the specified point position data calculation unit 53 calculates the position data of the specified point RP whose vertical distance is specified closest to the point AP of the target construction landform CS based on the target construction landform CS and the outer shape data of the bucket 8. To do.
  • the specified point RP at least data related to the width of the bucket 8 may be used. Further, the specified point RP may be designated by the operator.
  • the target construction landform generation unit 54 acquires a line LX that is an intersection line between the work machine operation plane WP and the target construction landform CS. In addition, the target construction landform generation unit 54 acquires a line LY that passes through the point AP and is orthogonal to the line LX in the target construction landform CS. A line LY indicates an intersection line between the lateral motion plane VP and the target construction landform CS.
  • the lateral motion plane VP is a plane that is orthogonal to the work implement motion plane WP and passes through the point AP.
  • FIG. 14 is a schematic diagram showing an example of the target construction landform CS according to the present embodiment.
  • the target construction landform generation unit 54 acquires the line LX and the line LY, and generates the target construction landform CS indicating the target shape of the excavation target based on the line LX and the line LY.
  • the control device 50 moves the bucket 8 along a line LX that is an intersection line between the work machine operation plane WP passing through the bucket 8 and the target construction landform CS.
  • the tilt data calculation unit 55 calculates a tilt operation plane TP that passes through the specified point RP of the bucket 8 and is orthogonal to the tilt axis AX4 as tilt data.
  • FIG. 15 and 16 are schematic views showing an example of the tilt operation plane TP according to the present embodiment.
  • FIG. 15 shows a tilt operation plane TP when the tilt axis AX4 is parallel to the target construction landform CS.
  • FIG. 16 shows a tilt operation plane TP when the tilt axis AX4 is not parallel to the target construction landform CS.
  • the tilt operation plane TP refers to an operation plane that passes through a specified point RPr selected from a plurality of specified points RP specified in the bucket 8 and is orthogonal to the tilt axis AX4. As the specified point RPr, the specified point RP that is closest to the target construction landform CS among the plurality of specified points RP is selected.
  • the tilt operation plane TP is an operation plane in which the specified point RPr (the blade edge 9) of the bucket 8 is moved by the operation of the tilt cylinder 14.
  • the tilt of the tilt operation plane TP also changes.
  • the work machine angle calculation device 24 can calculate the tilt axis angle ⁇ indicating the tilt angle of the tilt axis AX4 with respect to the XY plane.
  • the tilt axis angle ⁇ is acquired by the work machine angle data acquisition unit 52.
  • the position data of the specified point RPr is calculated by the specified point position data calculating unit 53.
  • the tilt data calculating unit 55 performs tilting based on the tilt axis angle ⁇ of the tilt axis AX4 acquired by the work implement angle data acquiring unit 52 and the position of the specified point RPr calculated by the specified point position data calculating unit 53.
  • An operation plane TP can be calculated.
  • the tilt target landform calculator 56 extends in the lateral direction of the bucket 8 in the target construction landform CS based on the position data of the specified point RPr selected from the plurality of specified points RP, the target construction landform CS, and the tilt data.
  • the tilt target landform ST to be calculated is calculated.
  • the tilt target landform calculator 56 calculates the tilt target landform ST defined by the intersection of the target construction landform CS and the tilt operation plane TP. As shown in FIGS. 15 and 16, the tilt target landform ST is represented by an intersection line between the target construction landform CS and the tilt operation plane TP.
  • the angle determination unit 57 determines the tilt angle ⁇ indicating the angle of the specific part of the bucket 8 around the tilt axis AX4 so that the target construction landform CS and the specific part of the bucket 8 are parallel to each other.
  • the specific part of the bucket 8 is the cutting edge 9 of the bucket 8.
  • FIG. 17 is a diagram schematically showing the relationship between the cutting edge 9 of the bucket 8 and the target construction landform CS according to the present embodiment.
  • FIG. 17A is a view of the bucket 8 as seen from the ⁇ Xm side.
  • FIG. 17B is a view of the bucket 8 as viewed from the + Ym side.
  • the angle determination unit 57 includes a tilt angle ⁇ r indicating an angle of the blade edge 9 of the bucket 8 around the tilt axis AX4 so that the target construction landform CS and the blade edge 9 of the bucket 8 are parallel to each other. To decide. That is, the angle determination unit 57 determines the tilt rotation angle ⁇ r of the blade edge 9 of the bucket 8 in the tilt rotation direction so that the blade edge 9 of the bucket 8 is parallel to the target construction landform CS.
  • the angle determination unit 57 determines the tilt angle ⁇ r of the blade edge of the bucket 8 so that the tilt target landform ST and the blade edge 9 of the bucket 8 are parallel to each other.
  • the work machine control unit 58 outputs a control signal for controlling the hydraulic cylinder 10.
  • the work implement control unit 58 controls the tilt cylinder 14 based on the tilt angle ⁇ r determined by the angle determination unit 57 so that the target construction landform CS and the blade edge 9 of the bucket 8 are parallel.
  • the work implement control unit 58 is centered on the tilt axis AX4 so that the bucket 8 does not exceed the target construction landform CS based on the operating distance Da indicating the distance between the specified point RPr of the bucket 8 and the tilt target landform ST.
  • the tilt rotation of the bucket 8 is stopped. That is, the work implement control unit 58 stops the bucket 8 at the tilt target landform ST so that the bucket 8 that rotates by tilt does not exceed the tilt target landform ST.
  • the tilt target landform ST and the line LY substantially coincide. Therefore, the intervention control for the tilt rotation based on the tilt target landform ST and the intervention control for the tilt rotation based on the line LY are substantially the same.
  • the work machine control unit 58 performs intervention control for tilt rotation based on the specified point RPr having the shortest operating distance Da among the plurality of specified points RP set in the bucket 8. That is, the work implement control unit 58 is closest to the tilt target landform ST so that the specified point RPr closest to the tilt target landform ST among the plurality of specified points RP set in the bucket 8 does not exceed the tilt target landform ST. Based on the operating distance Da between the specified point RPr and the tilt target landform ST, intervention control for tilt rotation is performed.
  • the target speed determination unit 59 determines the target speed U for the tilt rotation speed of the bucket 8 based on the operating distance Da.
  • the target speed determination unit 59 limits the tilt rotation speed when the operating distance Da is equal to or less than the threshold line distance H.
  • FIG. 18 is a schematic diagram for explaining the intervention control for the tilt rotation according to the present embodiment.
  • a target construction landform CS is defined, and a speed limit intervention line IL is defined.
  • the speed limit intervention line IL is parallel to the tilt axis AX4 and is defined at a position separated from the tilt target landform ST by the line distance H.
  • the line distance H is desirably set so as not to impair the operator's operational feeling.
  • the work machine control unit 58 limits the tilt rotation speed of the bucket 8 when at least a part of the bucket 8 that rotates by tilt exceeds the speed limit intervention line IL and the operating distance Da becomes equal to or less than the line distance H.
  • the target speed determination unit 59 determines a target speed U for the tilt rotation speed of the bucket 8 that exceeds the speed limit intervention line IL.
  • the tilt rotation speed is limited.
  • the target speed determination unit 59 obtains an operation distance Da between the specified point RPr and the tilt target landform ST in a direction parallel to the tilt operation plane TP. In addition, the target speed determination unit 59 acquires a target speed U corresponding to the operating distance Da. When it is determined that the operation distance Da is equal to or less than the line distance H, the work machine control unit 58 limits the tilt rotation speed.
  • FIG. 19 is a diagram showing an example of the relationship between the operating distance Da and the target speed U according to the present embodiment.
  • FIG. 19 shows an example of the relationship between the operating distance Da and the target speed U for stopping the tilt rotation of the bucket 8 based on the operating distance Da.
  • the target speed U is a speed that is uniformly determined according to the operating distance Da.
  • the target speed U is not set when the operating distance Da is larger than the line distance H, and is set when the operating distance Da is equal to or less than the line distance H.
  • the target speed U decreases.
  • the target speed U decreases.
  • the direction approaching the target construction landform CS is represented as a negative direction.
  • the target speed determination unit 59 calculates a moving speed Vr when the specified point RP moves toward the target construction landform CS (tilt target landform ST) based on the operation amount of the tilt operation lever 30T of the operation device 30.
  • the moving speed Vr is a moving speed of the specified point RPr in a plane parallel to the tilt operation plane TP.
  • the moving speed Vr is calculated for each of the plurality of specified points RP.
  • the moving speed Vr is calculated based on the current value output from the tilt operation lever 30T.
  • a current corresponding to the operation amount of the tilt operation lever 30T is output from the tilt operation lever 30T.
  • the storage unit 60 can store the cylinder speed of the tilt cylinder 14 corresponding to the operation amount of the tilt operation lever 30T.
  • the cylinder speed may be obtained from detection by a cylinder stroke sensor.
  • the target speed determination unit 59 converts the cylinder speed of the tilt cylinder 14 into moving speeds Vr of the plurality of specified points RP of the bucket 8 using a Jacobian determinant.
  • the work machine control unit 58 When it is determined that the operating distance Da is equal to or less than the line distance H, the work machine control unit 58 performs speed limitation that limits the moving speed Vr of the specified point RPr with respect to the target construction landform CS to the target speed U.
  • the work implement control unit 58 outputs a control signal to the control valve 37 in order to suppress the moving speed Vr of the specified point RPr of the bucket 8.
  • the work machine control unit 58 outputs a control signal to the control valve 37 so that the moving speed Vr of the specified point RPr of the bucket 8 becomes the target speed U corresponding to the operating distance Da.
  • the moving speed RP of the specified point RPr of the bucket 8 that rotates by tilting becomes slower as the specified point RPr approaches the target construction landform CS (tilt target landform ST), and the specified point RPr (cutting edge 9) becomes the target construction landform CD When it reaches, it becomes zero.
  • FIG. 20 is a flowchart showing an example of a method for adjusting the tilt angle ⁇ of the bucket 8 according to this embodiment.
  • FIG. 21 is a schematic diagram for explaining an example of a method for adjusting the tilt angle ⁇ of the bucket 8 according to the present embodiment.
  • the specified point position data calculation unit 53 calculates the position data of the specified point RPa and the position data of the specified point RPb specified in the cutting edge 9 (step SA10).
  • the specified point RPa and the specified point RPb are specified points on both sides in the width direction of the bucket 8 at the cutting edge 9.
  • the specified point position data calculation unit 53 calculates position data of the specified point RPa and position data of the specified point RPb in the vehicle body coordinate system.
  • the specified point position data calculation unit 53 calculates a direction vector Vec_ab connecting the specified point RPa and the specified point RPb based on the position data of the specified point RPa and the position data of the specified point RPb.
  • the direction vector Vec_ab is defined by the following equation (1).
  • the target construction landform generation unit 54 calculates the normal vector Nd of the target construction landform CS (Step SA20).
  • the angle determination unit 57 calculates an intersection vector STr between the tilt operation plane TP and the target construction landform CS (step SA30).
  • the angle determination unit 57 calculates the tilt angle ⁇ r of the blade edge 9 of the bucket 8 for making the blade edge 9 of the bucket 8 parallel to the target construction landform CS (step SA40).
  • the angle determination unit 57 calculates the tilt angle ⁇ r by calculating the following equation (2).
  • the work implement control unit 58 controls the tilt cylinder 14 based on the tilt angle ⁇ r determined by the angle determination unit 57 so that the target construction landform CS and the blade edge 9 of the bucket 8 are in parallel (step SA50). .
  • the target construction landform CS and the blade edge 9 of the bucket 8 are parallel based on the relative angle of the blade edge 9 of the bucket 8 to the target construction landform CS.
  • the angle determination unit 57 determines the tilt angle ⁇ r of the blade edge 9 of the bucket 8 around the tilt axis AX4.
  • the work implement control unit 58 controls the tilt cylinder 14 that rotates the bucket 8 about the tilt axis AX4 based on the tilt angle ⁇ r determined by the angle determination unit 57.
  • the blade edge 9 of the bucket 8 and the target construction landform CS can be made parallel in the tilt rotation direction. Therefore, the burden on the operation of the driver of the hydraulic excavator 1 during construction is reduced, and a high-quality construction result that does not depend on the skill level of the driver can be obtained.
  • 22 and 23 are diagrams schematically illustrating an example of the operation of the work machine 1 according to the present embodiment. 22 and 23 show an example in which the construction is performed based on the target construction landform CS tilted using the working machine 1 having the tilt type bucket 8.
  • FIG. 22 there is a case where it is desired to carry out the construction while moving the arm 7 in a state where the blade edge 9 of the bucket 8 and the target construction landform CS are parallel and the blade edge 9 and the target construction landform CS coincide with each other. . Further, as shown in FIG. 23, the construction is carried out while moving the arm 7 with the floor surface 89 of the bucket 8 and the target construction landform CS parallel to each other, and the floor surface 89 and the target construction landform CS are aligned. You may want to
  • the work implement control unit 58 is installed in the tilt cylinder so that at least one of the cutting edge 9 and the floor surface 89 of the bucket 8 and the target construction landform CS are maintained in parallel with the arm 7 operating.
  • An example of controlling at least one of 14 and the bucket cylinder 13 will be described.
  • FIG. 24 is a flowchart showing an example of a method for adjusting the angle of the bucket 8 according to the present embodiment.
  • 25 and 26 are schematic views for explaining an example of the method for adjusting the angle of the bucket 8 according to the present embodiment.
  • FIG. 25 schematically illustrates an example of a method for adjusting the angle of the bucket 8 when the cutting edge 9 of the bucket 8 and the target construction landform CS are parallel to each other.
  • FIG. 26 schematically illustrates an example of a method for adjusting the angle of the bucket 8 when the floor surface 89 of the bucket 8 and the target construction landform CS are parallel to each other.
  • the blade edge 9 and the floor surface 89 of the bucket 8 are collectively referred to as a specific part of the bucket 8 as appropriate.
  • the specified point position data calculation unit 53 calculates the position data of the specified point RPa and the position data of the specified point RPb specified for the cutting edge 9 and the position data of the specified point RPc specified for the floor surface 89 ( Step SB10).
  • the specified point RPa and the specified point RPb are specified points on both sides of the bucket 8 in the width direction of the bucket 8.
  • the specified point position data calculation unit 53 calculates position data of the specified point RPa and position data of the specified point RPb in the vehicle body coordinate system.
  • the specified point RPc is a specified point of a part of the flat floor surface 89.
  • the coordinates of the specified point RPa and the coordinates of the specified point RPc are equal.
  • the specified point RPa is defined at one end of the bottom plate 81
  • the defined point RPc is defined at the other end of the bottom plate 81.
  • the specified point position data calculation unit 53 calculates a direction vector Vec_ab connecting the specified point RPa and the specified point RPb based on the position data of the specified point RPa and the position data of the specified point RPb.
  • the specified point position data calculation unit 53 calculates a direction vector Vec_ac that connects the specified point RPa and the specified point RPc based on the position data of the specified point RPa and the position data of the specified point RPc.
  • the specified point position data calculation unit 53 calculates a normal vector Vec_tilt of the tilt axis AX4.
  • the angle determination unit 57 calculates a target normal vector Nref of a specific part of the bucket 8 that is parallel to the target construction landform CS (step SB20).
  • the angle determination unit 57 sets the blade edge 9 of the bucket 8 orthogonal to the direction vector Vec_ab of the blade edge 9 of the bucket 8 as shown in FIG.
  • a target normal vector Nref is calculated.
  • the target normal vector Nref of the blade edge 9 of the bucket 8 is defined to be orthogonal to the direction vector Vec_ab of the blade edge 9 of the bucket 8 in the tilt operation plane TP.
  • the target normal vector Nref of the blade edge 9 of the bucket 8 is also orthogonal to the normal vector Vec_tilt of the tilt axis AX4.
  • the angle determination unit 57 performs the flooring of the bucket 8 orthogonal to the direction vector Vec_ac of the floor surface 89 of the bucket 8 as shown in FIG. A target normal vector Nref of the surface 89 is calculated.
  • the floor surface 89 is substantially flat. Therefore, the target normal vector Nref of the floor surface 89 of the bucket 8 is uniquely determined.
  • the direction vector Vec_ab is defined by the above equation (1).
  • the direction vector Vec_ac is defined by the following equation (3).
  • the target normal vector Nref of the blade edge 9 of the bucket 8 is defined by the following equation (4).
  • the target normal vector Nref of the floor surface 89 of the bucket 8 is defined by the following equation (5).
  • the target construction landform generation unit 54 calculates the normal vector Nd of the target construction landform CS (Step SB30).
  • the angle detection unit 57 calculates the evaluation function Q (step SB40).
  • the evaluation function Q is the sum of an evaluation function Q1 indicating a parallel error between the target normal vector Nref and the normal vector Nd, and an evaluation function Q2 indicating a distance Da between the cutting edge 9 and the target construction landform CS. That is, the following expressions (6), (7), and (8) are established.
  • the angle detection unit 57 performs calculation processing by a predetermined numerical calculation method so that the evaluation function Q of (8) is minimized.
  • arithmetic processing for example, a Newton method, a Powell method, a simplex method, or the like can be used.
  • the angle detection unit 57 determines whether or not the evaluation function Q is minimized (step SB50). That is, the angle detection unit 57 performs a calculation process by a predetermined numerical calculation method to determine whether or not the evaluation function has become substantially zero.
  • step SB50 When it is determined in step SB50 that the evaluation function Q is the minimum (step SB50: Yes), the angle detection unit 57 specifies the specific part of the bucket 8 for making the specific part of the bucket 8 and the target construction landform CS parallel to each other.
  • the tilt angle ⁇ r and the bucket angle ⁇ r are calculated (step SB60). That is, the angle detector 57 determines the tilt angle ⁇ r and the bucket angle ⁇ r that minimize the evaluation function Q.
  • the tilt angle ⁇ r indicates the angle of the specific part of the bucket 8 with the tilt axis AX4 as the center for making the target construction landform CS and the specific part of the bucket 8 parallel to each other.
  • the bucket angle ⁇ r indicates an angle of a specific part of the bucket 8 around the bucket axis AX3.
  • the work implement control unit 58 sets the tilt cylinder 14 and the bucket cylinder so that the target construction landform CS and the specific part of the bucket 8 are parallel to each other. 13 is controlled (step SB70).
  • step SB50 when it is determined that the evaluation function Q is not the minimum (step SB50: No), the angle detection unit 57 updates the tilt angle ⁇ r or the bucket angle ⁇ r (step SB80), and returns to the process of step SB40.
  • the evaluation function Q may be weighted to the evaluation function Q1 and the evaluation function Q2.
  • the construction machine 100 is a hydraulic excavator.
  • the components described in the above-described embodiments can be applied to a construction machine having a work machine other than the hydraulic excavator.
  • the upper swing body 2 may be rotated by hydraulic pressure, or may be rotated by power generated by the electric actuator. Further, the work implement 1 may be operated not by the hydraulic cylinder 10 but by the power generated by the electric actuator.

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • General Life Sciences & Earth Sciences (AREA)
  • Paleontology (AREA)
  • Operation Control Of Excavators (AREA)

Abstract

アームと、バケット軸及びバケット軸と直交するチルト軸のそれぞれを中心にアームに対して回転可能なバケットとを含む作業機を備える建設機械の制御システムは、掘削対象の目標形状を示す目標施工地形とバケットの特定部位とが平行となるように、チルト軸を中心とするバケットの特定部位の角度を示すチルト角度を決定する角度決定部と、角度決定部で決定されたチルト角度に基づいて、チルト軸を中心にバケットを回転させるチルトシリンダを制御する作業機制御部と、を備える。

Description

建設機械の制御システム、建設機械、及び建設機械の制御方法
 本発明は、建設機械の制御システム、建設機械、及び建設機械の制御方法に関する。
 特許文献1に開示されているような、チルト式バケットを有する作業機を備える建設機械が知られている。
国際公開第2015/186179号
 建設機械の制御に係る技術分野において、建設機械の運転者による操作装置の操作よりも優先して作業機を制御する技術が知られている。本明細書においては、建設機械の運転者による操作装置の操作よりも優先して作業機を制御することを、介入制御、と呼ぶこととする。
 介入制御においては、掘削対象の目標形状を示す目標施工地形に対して、作業機のうちブーム、アーム、及びバケットの少なくとも一つの位置又は姿勢が制御される。介入制御が実施されることにより、目標施工地形に則った施工が実施される。
 チルト式バケットを有する建設機械においては、既存の介入制御に加えてチルト式バケットに固有の制御を実施しなければ、建設機械の作業効率が低下する。
 本発明の態様は、チルト式バケットを有する作業機を備える建設機械において、作業効率の低下を抑制できる建設機械の制御システム、建設機械、及び建設機械の制御方法を提供する。
 本発明の第1の態様に従えば、アームと、バケット軸及び前記バケット軸と直交するチルト軸のそれぞれを中心に前記アームに対して回転可能なバケットとを含む作業機を備える建設機械の制御システムであって、掘削対象の目標形状を示す目標施工地形と前記バケットの特定部位とが平行となるように、前記チルト軸を中心とする前記バケットの前記特定部位の角度を示すチルト角度を決定する角度決定部と、前記角度決定部で決定された前記チルト角度に基づいて、前記チルト軸を中心に前記バケットを回転させるチルトシリンダを制御する作業機制御部と、を備える建設機械の制御システムが提供される。
 本発明の第2の態様に従えば、上部旋回体と、前記上部旋回体を支持する下部走行体と、前記アームと前記バケットとを含み、前記上部旋回体に支持される作業機と、第1の態様の建設機械の制御システムと、を備える建設機械が提供される。
 本発明の第3の態様に従えば、アームと、バケット軸及び前記バケット軸と直交するチルト軸のそれぞれを中心に前記アームに対して回転可能なバケットとを含む作業機を備える建設機械の制御方法であって、掘削対象の目標形状を示す目標施工地形と前記バケットの特定部位とが平行となるように、前記チルト軸を中心とする前記バケットの前記特定部位の角度を示すチルト角度を決定することと、前記角度決定部で決定された前記チルト角度に基づいて、前記チルト軸を中心に前記バケットを回転させるチルトシリンダを制御することと、を含む建設機械の制御方法が提供される。
 本発明の態様によれば、チルト式バケットを有する作業機を備える建設機械において、作業効率の低下を抑制できる建設機械の制御システム、建設機械、及び建設機械の制御方法が提供される。
図1は、本実施形態に係る建設機械の一例を示す斜視図である。 図2は、本実施形態に係るバケットの一例を示す側断面図である。 図3は、本実施形態に係るバケットの一例を示す正面図である。 図4は、本実施形態に係る油圧ショベルを模式的に示す側面図である。 図5は、本実施形態に係る油圧ショベルを模式的に示す背面図である。 図6は、本実施形態に係る油圧ショベルを模式的に示す平面図である。 図7は、本実施形態に係るバケットを模式的に示す側面図である。 図8は、本実施形態に係るバケットを模式的に示す正面図である。 図9は、本実施形態に係る油圧システムの一例を示す模式図である。 図10は、本実施形態に係る油圧システムの一例を示す模式図である。 図11は、本実施形態に係る制御システムの一例を示す機能ブロック図である。 図12は、本実施形態に係るバケットに設定される規定点の一例を模式的に示す図である。 図13は、本実施形態に係る目標施工データの一例を示す模式図である。 図14は、本実施形態に係る目標施工地形の一例を示す模式図である。 図15は、本実施形態に係るチルト動作平面の一例を示す模式図である。 図16は、本実施形態に係るチルト動作平面の一例を示す模式図である。 図17は、本実施形態に係るバケットの刃先と目標施工地形との関係を模式的に示す図である。 図18は、本実施形態に係るチルト回転についての介入制御を説明するための模式図である。 図19は、本実施形態に係る動作距離と目標速度との関係の一例を示す図である。 図20は、本実施形態に係るバケットのチルト角度の調整方法の一例を示すフローチャートである。 図21は、本実施形態に係るバケットのチルト角度の調整方法の一例を説明するための模式図である。 図22は、本実施形態に係る作業機の動作の一例を模式的に示す図である。 図23は、本実施形態に係る作業機の動作の一例を模式的に示す図である。 図24は、本実施形態に係るバケットのチルト角度の調整方法の一例を示すフローチャートである。 図25は、本実施形態に係るバケットのチルト角度の調整方法の一例を説明するための模式図である。 図26は、本実施形態に係るバケットのチルト角度の調整方法の一例を説明するための模式図である。
 以下、本発明に係る実施形態について図面を参照しながら説明するが、本発明はこれに限定されない。以下で説明する各実施形態の構成要素は適宜組み合わせることができる。また、一部の構成要素を用いない場合もある。
 以下の説明においては、3次元のグローバル座標系(Xg,Yg,Zg)、及び3次元の車体座標系(Xm,Ym,Zm)を規定して、各部の位置関係について説明する。
 グローバル座標系とは、地球に固定された原点を基準とする座標系をいう。グローバル座標系は、GNSS(Global Navigation Satellite System)によって規定される座標系である。GNSSとは、全地球航法衛星システムをいう。全地球航法衛星システムの一例として、GPS(Global Positioning System)が挙げられる。GNSSは、複数の測位衛星を有する。GNSSは、緯度、経度、及び高度の座標データで規定される位置を検出する。
 グローバル座標系は、水平面内のXg軸と、水平面内においてXg軸と直交するYg軸と、Xg軸及びYg軸と直交するZg軸とによって規定される。Xg軸と平行な方向をXg軸方向とし、Yg軸と平行な方向をYg軸方向とし、Zg軸と平行な方向をZg軸方向とする。また、Xg軸を中心とする回転又は傾斜方向をθXg方向とし、Yg軸を中心とする回転又は傾斜方向をθYg方向とし、Zg軸を中心とする回転又は傾斜方向をθZg方向とする。Zg軸方向は鉛直方向である。
 車体座標系とは、建設機械に固定された原点を基準とする座標系をいう。
 車体座標系は、建設機械の車体に固定された原点を基準として一方向に延在するXm軸と、Xm軸と直交するYm軸と、Xm軸及びYm軸と直交するZm軸とによって規定される。Xm軸と平行な方向をXm軸方向とし、Ym軸と平行な方向をYm軸方向とし、Zm軸と平行な方向をZm軸方向とする。また、Xm軸を中心とする回転又は傾斜方向をθXm方向とし、Ym軸を中心とする回転又は傾斜方向をθYm方向とし、Zm軸を中心とする回転又は傾斜方向をθZm方向とする。Xm軸方向は建設機械の前後方向であり、Ym軸方向は建設機械の車幅方向であり、Zm軸方向は建設機械の上下方向である。
第1実施形態.
[建設機械]
 図1は、本実施形態に係る建設機械100の一例を示す斜視図である。本実施形態においては、建設機械100が油圧ショベルである例について説明する。以下の説明においては、建設機械100を適宜、油圧ショベル100、と称する。
 図1に示すように、油圧ショベル100は、油圧により作動する作業機1と、作業機1を支持する車体である上部旋回体2と、上部旋回体2を支持する走行装置である下部走行体3と、作業機1を操作するための操作装置30と、作業機1を制御する制御装置50とを備える。上部旋回体2は、下部走行体3に支持された状態で旋回軸RXを中心に旋回可能である。
 上部旋回体2は、オペレータが搭乗する運転室4と、エンジン及び油圧ポンプが収容される機械室5とを有する。運転室4は、オペレータが着座する運転席4Sを有する。機械室5は、運転室4の後方に配置される。
 下部走行体3は、一対の履帯3Cを有する。履帯3Cの回転により、油圧ショベル100が走行する。なお、下部走行体3がタイヤを有してもよい。
 作業機1は、上部旋回体2に支持される。作業機1は、ブームピンを介して上部旋回体2に連結されるブーム6と、アームピンを介してブーム6に連結されるアーム7と、バケットピン及びチルトピンを介してアーム7に連結されるバケット8とを有する。バケット8は、刃先9を有する。本実施形態において、バケット8の刃先9は、バケット8に設けられたストレート形状の刃の先端部である。なお、バケット8の刃先9は、バケット8に設けられた凸形状の刃の先端部でもよい。
 ブーム6は、回転軸であるブーム軸AX1を中心に上部旋回体2に対して回転可能である。アーム7は、回転軸であるアーム軸AX2を中心にブーム6に対して回転可能である。バケット8は、回転軸であるバケット軸AX3及びバケット軸AX3と直交する回転軸であるチルト軸AX4のそれぞれを中心にアーム7に対して回転可能である。回転軸AX1と回転軸AX2と回転軸AX3とは平行である。回転軸AX1,AX2,AX3と旋回軸RXと平行な軸とは直交する。回転軸AX1,AX2,AX3は、車体座標系のYm軸と平行である。旋回軸RXは、車体座標系のZm軸と平行である。回転軸AX1,AX2,AX3と平行な方向は、上部旋回体2の車幅方向を示す。旋回軸RXと平行な方向は、上部旋回体2の上下方向を示す。回転軸AX1,AX2,AX3及び旋回軸RXの両方と直交する方向は、上部旋回体2の前後方向を示す。運転席4Sに着座したオペレータを基準として作業機1が存在する方向が前方である。
 作業機1は、油圧シリンダ10が発生する動力により作動する。油圧シリンダ10は、ブーム6を作動させるブームシリンダ11と、アーム7を作動させるアームシリンダ12と、バケット8を作動させるバケットシリンダ13及びチルトシリンダ14とを含む。ブームシリンダ11は、ブーム軸AX1を中心にブーム6を回転させる動力を発生可能である。アームシリンダ12は、アーム軸AX2を中心にアーム7を回転させる動力を発生可能である。バケットシリンダ13は、バケット軸AX3を中心にバケット8を回転させる動力を発生可能である。チルトシリンダ14は、チルト軸AX4を中心にバケット8を回転させる動力を発生可能である。
 以下の説明においては、バケット軸AX3を中心とするバケット8の回転を適宜、バケット回転、と称し、チルト軸AX4を中心とするバケット8の回転を適宜、チルト回転、と称する。
 また、作業機1は、ブームシリンダ11の駆動量を示すブームストロークを検出するブームストロークセンサ16と、アームシリンダ12の駆動量を示すアームストロークを検出するアームストロークセンサ17と、バケットシリンダ13の駆動量を示すバケットストロークを検出するバケットストロークセンサ18と、チルトシリンダ14の駆動量を示すチルトストロークを検出するチルトストロークセンサ19とを有する。ブームストロークセンサ16は、ブームシリンダ11に配置される。アームストロークセンサ17は、アームシリンダ12に配置される。バケットストロークセンサ18は、バケットシリンダ13に配置される。チルトストロークセンサ19は、チルトシリンダ14に配置される。
 操作装置30は、運転室4に配置される。操作装置30は、油圧ショベル100のオペレータに操作される操作部材を含む。オペレータは、操作装置30を操作して、作業機1を作動させる。本実施形態において、操作装置30は、右作業機操作レバー30Rと、左作業機操作レバー30Lと、チルト操作レバー30Tと、操作ペダル30Fとを含む。
 中立位置にある右作業機操作レバー30Rが前方に操作されると、ブーム6が下げ動作し、後方に操作されると、ブーム6が上げ動作する。中立位置にある右作業機操作レバー30Rが右方に操作されると、バケット8がダンプし、左方に操作されると、バケット8が掘削する。
 中立位置にある左作業機操作レバー30Lが前方に操作されると、アーム7がダンプし、後方に操作されると、アーム7が掘削する。中立位置にある左作業機操作レバー30Lが右方に操作されると、上部旋回体2が右旋回し、左方に操作されると、上部旋回体2が左旋回する。
 なお、右作業機操作レバー30R及び左作業機操作レバー30Lの操作方向と、作業機1の動作方向及び上部旋回体2の旋回方向との関係は、上述の関係でなくてもよい。
 制御装置50は、コンピュータシステムを含む。制御装置50は、CPU(Central Processing Unit)のようなプロセッサと、ROM(Read Only Memory)のような不揮発性メモリ及びRAM(Random Access Memory)のような揮発性メモリを含む記憶装置と、入出力インターフェース装置とを有する。
[バケット]
 次に、本実施形態に係るバケット8について説明する。図2は、本実施形態に係るバケット8の一例を示す側断面図である。図3は、本実施形態に係るバケット8の一例を示す正面図である。本実施形態において、バケット8は、チルト式バケットである。
 図2及び図3に示すように、作業機1は、バケット軸AX3及びバケット軸AX3と直交するチルト軸AX4のそれぞれを中心にアーム7に対して回転可能なバケット8を有する。バケット8は、バケットピン8Bを介してアーム7に回転可能に連結される。また、バケット8は、チルトピン8Tを介してアーム7に回転可能に支持される。
 バケット8は、接続部材90を介して、アーム7の先端部に接続される。バケットピン8Bは、アーム7と接続部材90とを連結する。チルトピン8Tは、接続部材90とバケット8とを連結する。バケット8は、接続部材90を介して、アーム7に回転可能に接続される。
 バケット8は、底板81と、背板82と、上板83と、側板84と、側板85とを含む。バケット8の開口部86は、底板81と上板83と側板84と側板85とによって規定される。刃先9は、底板81に設けられる。底板81は、刃先9と接続される平坦な床面89を有する。床面89は、底板81の底面である。床面89は、実質的に平面である。
 バケット8は、上板83の上部に設けられたブラケット87を有する。ブラケット87は、上板83の前後位置に設置される。ブラケット87は、接続部材90及びチルトピン8Tと連結される。
 接続部材90は、プレート部材91と、プレート部材91の上面に設けられたブラケット92と、プレート部材91の下面に設けられたブラケット93とを有する。ブラケット92は、アーム7及び第2リンクピン95Pと連結される。ブラケット93はブラケット87の上部に設置され、チルトピン8T及びブラケット87と連結される。
 バケットピン8Bは、接続部材90のブラケット92とアーム7の先端部とを連結する。チルトピン8Tは、接続部材90のブラケット93とバケット8のブラケット87とを連結する。接続部材90及びバケット8は、アーム7に対してバケット軸AX3を中心に回転可能である。バケット8は、接続部材90に対してチルト軸AX4を中心に回転可能である。
 作業機1は、第1リンクピン94Pを介してアーム7に回転可能に接続される第1リンク部材94と、第2リンクピン95Pを介してブラケット92に回転可能に接続される第2リンク部材95とを有する。第1リンク部材94の基端部が第1リンクピン94Pを介してアーム7に接続される。第2リンク部材95の基端部が第2リンクピン95Pを介してブラケット92に接続される。第1リンク部材94の先端部と第2リンク部材95の先端部とが、バケットシリンダトップピン96を介して連結される。
 バケットシリンダ13の先端部は、バケットシリンダトップピン96を介して、第1リンク部材94の先端部及び第2リンク部材95の先端部と回転可能に接続される。バケットシリンダ13が伸縮するように作動すると、接続部材90はバケット8と一緒にバケット軸AX3を中心に回転する。
 チルトシリンダ14は、接続部材90に設けられたブラケット97及びバケット8に設けられたブラケット88のそれぞれに接続される。チルトシリンダ14のロッドがピンを介してブラケット97に接続される。チルトシリンダ14の本体部がピンを介してブラケット88に接続される。チルトシリンダ14が伸縮するように作動すると、バケット8はチルト軸AX4を中心に回転する。なお、本実施形態に係るチルトシリンダ14の接続構造は一例でありこれに限定されない。
 このように、バケット8は、バケットシリンダ13の作動により、バケット軸AX3を中心に回転する。バケット8は、チルトシリンダ14の作動により、チルト軸AX4を中心に回転する。バケット8がバケット軸AX3を中心に回転すると、チルトピン8Tはバケット8と一緒に回転する。
[検出システム]
 次に、本実施形態に係る油圧ショベル100の検出システム400について説明する。図4は、本実施形態に係る油圧ショベル100を模式的に示す側面図である。図5は、本実施形態に係る油圧ショベル100を模式的に示す背面図である。図6は、本実施形態に係る油圧ショベル100を模式的に示す平面図である。図7は、本実施形態に係るバケット8を模式的に示す側面図である。図8は、本実施形態に係るバケット8を模式的に示す正面図である。
 図4、図5、及び図6に示すように、検出システム400は、上部旋回体2の位置を算出する位置演算装置20と、作業機1の角度を算出する作業機角度演算装置24とを有する。
 位置演算装置20は、上部旋回体2の位置を検出する車体位置演算器21と、上部旋回体2の姿勢を検出する姿勢演算器22と、上部旋回体2の方位を検出する方位演算器23とを含む。
 車体位置演算器21は、GPS受信機を含む。車体位置演算器21は、上部旋回体2に設けられる。車体位置演算器21は、グローバル座標系で規定される上部旋回体2の絶対位置Pgを検出する。上部旋回体2の絶対位置Pgは、Xg軸方向の座標データ、Yg軸方向の座標データ、及びZg軸方向の座標データを含む。
 上部旋回体2に複数のGPSアンテナ21Aが設けられる。GPSアンテナ21Aは、GPS衛星から電波を受信して、受信した電波に基づいて生成した信号を車体位置演算器21に出力する。車体位置演算器21は、GPSアンテナ21Aから供給された信号に基づいて、グローバル座標系で規定されるGPSアンテナ21Aが設置されている位置Prを検出する。車体位置演算器21は、GPSアンテナ21Aが設置されている位置Prに基づいて、上部旋回体2の絶対位置Pgを検出する。
 GPSアンテナ21Aは、車幅方向に2つ設けられる。車体位置演算器21は、一方のGPSアンテナ21Aが設置されている位置Pra及び他方のGPSアンテナ21Aが設置されている位置Prbのそれぞれを検出する。車体位置演算器21Aは、位置Pra及び位置Prbの少なくとも一方に基づいて演算処理を実施して、上部旋回体2の絶対位置Pgを算出する。本実施形態において、上部旋回体2の絶対位置Pgは、位置Praである。なお、上部旋回体2の絶対位置Pgは、位置Prbでもよいし、位置Praと位置Prbとの間の位置でもよい。
 姿勢演算器22は、慣性計測装置(Inertial Measurement Unit:IMU)を含む。姿勢演算器22は、上部旋回体2に設けられる。姿勢演算器22は、グローバル座標系で規定される水平面(XgYg平面)に対する上部旋回体2の傾斜角度を算出する。水平面に対する上部旋回体2の傾斜角度は、車幅方向における上部旋回体2の傾斜角度を示すロール角度θ1と、前後方向における上部旋回体2の傾斜角度を示すピッチ角度θ2とを含む。
 方位演算器23は、一方のGPSアンテナ21Aが設置されている位置Praと他方のGPSアンテナ21Aが設置されている位置Prbとに基づいて、グローバル座標系で規定される基準方位に対する上部旋回体2の方位を算出する。基準方位は、例えば北である。方位演算器23は、位置Praと位置Prbとに基づいて演算処理を実施して、基準方位に対する上部旋回体2の方位を算出する。方位演算器23は、位置Praと位置Prbとを結ぶ直線を算出し、算出した直線と基準方位とがなす角度に基づいて、基準方位に対する上部旋回体2の方位を算出する。基準方位に対する上部旋回体2の方位は、基準方位と上部旋回体2の方位とがなす角度を示すヨー角度θ3を含む。
 図4、図7、及び図8に示すように、作業機角度演算装置24は、ブームストロークセンサ16で検出されたブームストロークに基づいて、車体座標系のZm軸に対するブーム6の傾斜角度を示すブーム角度αを算出する。作業機角度演算装置24は、アームストロークセンサ17で検出されたアームストロークに基づいて、ブーム6に対するアーム7の傾斜角度を示すアーム角度βを算出する。作業機角度演算装置24は、バケットストロークセンサ18で検出されたバケットストロークに基づいて、アーム7に対するバケット8の刃先9の傾斜角度を示すバケット角度γを算出する。作業機角度演算装置24は、チルトストロークセンサ19で検出されたチルトストロークに基づいて、車体座標系のXmYm平面に対するバケット8の傾斜角度を示すチルト角度δを算出する。作業機角度演算装置24は、ブームストロークセンサ16で検出されたブームストローク、アームストロークセンサ17で検出されたアームストローク、及びバケットストロークセンサ18で検出されたチルトストロークに基づいて、車体座標系のXmYm平面に対するチルト軸AX4の傾斜角度を示すチルト軸角度εを算出する。
 なお、ブーム角度α、アーム角度β、バケット角度γ、チルト角度δ、及びチルト軸角度εは、ストロークセンサを用いずに、例えば、作業機10に設けられた角度センサにより検出されてもよい。また、ステレオカメラ又はレーザスキャナで作業機10の角度が光学的に検出され、その検出結果を使って、ブーム角度α、アーム角度β、バケット角度γ、チルト角度δ、及びチルト軸角度εが算出されてもよい。
[油圧システム]
 次に、本実施形態に係る油圧ショベル100の油圧システム300の一例について説明する。図9及び図10は、本実施形態に係る油圧システム300の一例を示す模式図である。ブームシリンダ11、アームシリンダ12、バケットシリンダ13、及びチルトシリンダ14を含む油圧シリンダ10は、油圧システム300により駆動する。油圧システム300は、油圧シリンダ10に作動油を供給して、油圧シリンダ10を駆動する。油圧システム300は、流量制御弁25を有する。流量制御弁25は、油圧シリンダ10に対する作動油の供給量及び作動油が流れる方向を制御する。油圧シリンダ10は、キャップ側油室10A及びロッド側油室10Bを有する。キャップ側油室10Aは、シリンダヘッドカバーとピストンとの間の空間である。ロッド側油室10Bは、ピストンロッドが配置される空間である。油路35Aを介してキャップ側油室10Aに作動油が供給されることにより、油圧シリンダ10が伸びる。油路35Bを介してロッド側油室10Bに作動油が供給されることにより、油圧シリンダ10が縮む。
 図9は、アームシリンダ12を作動する油圧システム300の一例を示す模式図である。油圧システム300は、作動油を供給する可変容量型のメイン油圧ポンプ31と、パイロット油を供給するパイロット圧ポンプ32と、パイロット油が流れる油路33A,33Bと、油路33A,33Bに配置された圧力センサ34A,34Bと、流量制御弁25に作用するパイロット圧を調整する制御弁37A,37Bと、流量制御弁25に対するパイロット圧を調整する右作業機操作レバー30R及び左作業機操作レバー30Lを含む操作装置30と、制御装置50とを備える。操作装置30の右作業機操作レバー30R及び左作業機操作レバー30Lは、パイロット油圧方式の操作装置である。
 メイン油圧ポンプ31から供給された作動油は、流量制御弁25を介して、アームシリンダ12に供給される。流量制御弁25は、ロッド状のスプールを軸方向に移動して作動油が流れる方向を切り替えるスライドスプール方式の流量制御弁である。スプールが軸方向に移動することにより、アームシリンダ12のキャップ側油室10Aに対する作動油の供給と、ロッド側油室10Bに対する作動油の供給とが切り替わる。また、スプールが軸方向に移動することにより、アームシリンダ12に対する単位時間当たりの作動油の供給量が調整される。アームシリンダ12に対する作動油の供給量が調整されることにより、シリンダ速度が調整される。
 流量制御弁25は、操作装置30によって操作される。パイロット圧ポンプ32から送出されたパイロット油が操作装置30に供給される。なお、メイン油圧ポンプ31から送出され、減圧弁によって減圧されたパイロット油が操作装置30に供給されてもよい。操作装置30は、パイロット圧調整弁を含む。操作装置30の操作量に基づいて制御弁37A,37Bが作動され、流量制御弁25のスプールに作用するパイロット圧が調整される。パイロット圧によって、流量制御弁25が駆動される。操作装置30によりパイロット圧が調整されることによって、軸方向におけるスプールの移動量、移動速度、及び移動方向が調整される。
 流量制御弁25は、第1受圧室及び第2受圧室を有する。左作業機操作レバー30Lが中立位置より一方側に傾動するように操作され、油路33Aのパイロット圧によってスプールが移動すると、メイン油圧ポンプ31からの作動油が第1受圧室に供給され、油路35Aを介してキャップ側油室10Aに作動油が供給される。左作業機操作レバー30Lが中立位置より他方側に傾動するように操作され、油路33Bのパイロット圧によってスプールが移動すると、メイン油圧ポンプ31からの作動油が第2受圧室に供給され、油路35Bを介してロッド側油室10Bに作動油が供給される。
 圧力センサ34Aは、油路33Aのパイロット圧を検出する。圧力センサ34Bは、油路33Bのパイロット圧を検出する。圧力センサ33A,33Bの検出信号は、制御装置50に出力される。介入制御を実施するとき、制御装置50は、制御弁37A,37Bに制御信号を出力して、パイロット圧を調整する。
 ブームシリンダ11及びバケットシリンダ13を作動する油圧システム300は、アームシリンダ12を作動する油圧システム300と同様の構成である。ブームシリンダ11及びバケットシリンダ13を作動する油圧システム300についての詳細な説明は省略する。なお、ブーム6について介入制御を実施するために、ブームシリンダ11に接続される油路33Aに、ブーム6の上げ動作に介入する介入用制御弁が接続されてもよい。
 なお、操作装置30の右作業機操作レバー30R及び左作業機操作レバー30Lは、パイロット油圧方式でなくてもよい。右作業機操作レバー30R及び左作業機操作レバー30Lは、右作業機操作レバー30R及び左作業機操作レバー30Lの操作量(傾動角)に基づいて電気信号を制御装置50に出力して、制御装置50の制御信号に基づいて流量制御弁25を直接的に制御する電子レバー方式でもよい。
 図10は、チルトシリンダ14を作動する油圧システム300の一例を模式的に示す図である。油圧システム300は、チルトシリンダ14に対する作動油の供給量を調整する流量制御弁25と、流量制御弁25に作用するパイロット圧を調整する制御弁37A,37Bと、パイロット圧ポンプ32と操作ペダル30Fとの間に配置される制御弁39と、操作装置30のチルト操作レバー30T及び操作ペダル30Fと、制御装置50とを備える。本実施形態において、操作装置30の操作ペダル30Fは、パイロット油圧方式の操作装置である。操作装置30のチルト操作レバー30Tは、電子レバー方式の操作装置である。チルト操作レバー30Tは、右作業機操作レバー30R及び左作業機操作レバー30Lに設けられた操作ボタンを含む。
 操作装置30の操作ペダル30Fは、パイロット圧ポンプ32に接続される。また、操作ペダル30Fは、制御弁37Aから送出されるパイロット油が流れる油路38Aにシャトル弁36Aを介して接続される。また、操作ペダル30Fは、制御弁37Bから送出されるパイロット油が流れる油路38Bにシャトル弁36Bを介して接続される。操作ペダル30Fが操作されることにより、操作ペダル30Fとシャトル弁36Aとの間の油路33Aの圧力、及び操作ペダル30Fとシャトル弁36Bとの間の油路33Bの圧力が調整される。
 チルト操作レバー30Tが操作されることにより、チルト操作レバー30Tの操作により生成された操作信号が制御装置50に出力される。制御装置50は、チルト操作レバー30Tから出力された操作信号に基づいて制御信号を生成し、制御弁37A,37Bを制御する。制御弁37A,37Bは、電磁比例制御弁である。制御弁37Aは、制御信号に基づいて、油路38Aを開閉する。制御弁37Bは、制御信号に基づいて、油路38Bを開閉する。
 バケット8のチルト回転について介入制御を実施しないとき、操作装置30の操作量に基づいて、パイロット圧が調整される。バケット8のチルト回転について介入制御を実施するとき、制御装置50は、制御弁37A,37Bに制御信号を出力して、パイロット圧を調整する。
[制御システム]
 次に、本実施形態に係る油圧ショベル100の制御システム200について説明する。図11は、本実施形態に係る制御システム200の一例を示す機能ブロック図である。
 図11に示すように、制御システム200は、作業機1を制御する制御装置50と、位置演算装置20と、作業機角度演算装置24と、制御弁37(37A,37B)と、目標施工データ生成装置70とを備える。
 位置演算装置20は、車体位置演算器21と、姿勢演算器22と、方位演算器23とを有する。位置演算装置20は、上部旋回体2の絶対位置Pg、ロール角度θ1及びピッチ角度θ2を含む上部旋回体2の姿勢、及びヨー角度θ3を含む上部旋回体2の方位を検出する。
 作業機角度演算装置24は、ブーム角度α、アーム角度β、バケット角度γ、チルト角度δ、及びチルト軸角度εを含む作業機1の角度を検出する。
 制御弁37(37A,37B)は、チルトシリンダ14に対する作動油の供給量を調整する。制御弁37は、制御装置50からの制御信号に基づいて作動する。
 目標施工データ生成装置70は、コンピュータシステムを含む。目標施工データ生成装置70は、施工エリアの目標形状である目標地形を示す目標施工データを生成する。目標施工データは、作業機1による施工後に得られる3次元の目標形状を示す。
 目標施工データ生成装置70は、油圧ショベル100の遠隔地に設けられる。目標施工データ生成装置70は、例えば施工管理会社の設備に設置される。なお、目標施工データ生成装置70は、油圧ショベル100の製造会社又はレンタル会社に保有されてもよい。目標施工データ生成装置70と制御装置50とは無線通信可能である。目標施工データ生成装置70で生成された目標施工データは、無線で制御装置50に送信される。
 なお、目標施工データ生成装置70と制御装置50とが有線で接続され、目標施工データ生成装置70から制御装置50に目標施工データが送信されてもよい。なお、目標施工データ生成装置70が目標施工データを記憶した記録媒体を含み、制御装置50が、記録媒体から目標施工データを読み込み可能な装置を有してもよい。
 なお、目標施工データ生成装置70は、油圧ショベル100に設けられてもよい。施工を管理する外部の管理装置から目標施工データが有線又は無線で油圧ショベル100の目標施工データ生成装置70に供給され、目標施工データ生成装置70が供給された目標施工データを記憶してもよい。
 制御装置50は、車体位置データ取得部51と、作業機角度データ取得部52と、規定点位置データ算出部53と、目標施工地形生成部54と、チルトデータ算出部55と、チルト目標地形算出部56と、角度決定部57と、作業機制御部58と、目標速度決定部59と、記憶部60と、入出力部61とを有する。
 車体位置データ取得部51、作業機角度データ取得部52、規定点位置データ算出部53、目標施工地形生成部54、チルトデータ算出部55、チルト目標地形算出部56、角度決定部57、作業機制御部58、及び目標速度決定部59のそれぞれの機能は、制御装置50のプロセッサによって発揮される。記憶部60の機能は、制御装置50の記憶装置によって果たされる。入出力部61の機能は、制御装置50の入出力インターフェース装置によって果たされる。入出力部61は、位置演算装置20、作業機角度演算装置24、制御弁37、及び目標施工データ生成装置70と接続され、車体位置データ取得部51、作業機角度データ取得部52、規定点位置データ算出部53、目標施工地形生成部54、チルトデータ算出部55、チルト目標地形算出部56、角度決定部57、作業機制御部58、目標速度決定部59、及び記憶部60との間でデータ通信する。
 記憶部60は、作業機データを含む油圧ショベル100の諸元データを記憶する。
 車体位置データ取得部51は、位置演算装置20から入出力部61を介して車体位置データを取得する。車体位置データは、グローバル座標系で規定される上部旋回体2の絶対位置Pg、ロール角度θ1及びピッチ角度θ2を含む上部旋回体2の姿勢、及びヨー角度θ3を含む上部旋回体2の方位を含む。
 作業機角度データ取得部52は、作業機角度演算装置24から入出力部61を介して作業機角度データを取得する。作業機角度データは、ブーム角度α、アーム角度β、バケット角度γ、チルト角度δ、及びチルト軸角度εを含む作業機1の角度を検出する。
 規定点位置データ算出部53は、車体位置データ取得部51で取得された車体位置データと、作業機角度データ取得部52で取得された作業機角度データと、記憶部60に記憶されている作業機データとに基づいて、バケット8に設定される規定点RPの位置データを算出する。
 図4及び図7に示すように、作業機データは、ブーム長さL1、アーム長さL2、バケット長さL3、チルト長さL4、及びバケット幅L5を含む。ブーム長さL1は、ブーム軸AX1とアーム軸AX2との距離である。アーム長さL2は、アーム軸AX2とバケット軸AX3との距離である。バケット長さL3は、バケット軸AX3とバケット8の刃先9との距離である。チルト長さL4は、バケット軸AX3とチルト軸AX4との距離である。バケット幅L5は、側板84と側板85との距離である。
 図12は、本実施形態に係るバケット8に設定される規定点RPの一例を模式的に示す図である。図12に示すように、バケット8には、チルトバケット制御に使用される規定点RPが複数設定される。規定点RPは、バケット8の刃先9及び床面89を含むバケット8の外面に設定される。規定点RPは、刃先9においてバケット幅方向に複数設定される。また、規定点RPは、床面89を含むバケット8の外面において複数設定される。
 また、作業機データは、バケット8の形状及び寸法を示すバケット外形データを含む。バケット外形データは、バケット幅L5を示すバケット8の幅データを含む。また、バケット外形データは、バケット8の外面の輪郭データを含むバケット8の外面データを含む。また、バケット外形データは、バケット8の刃先9を基準としたバケット8の複数の規定点RPの座標データを含む。
 規定点位置データ算出部53は、規定点RPの位置データを算出する。規定点位置データ算出部53は、車体座標系における上部旋回体2の基準位置P0に対する複数の規定点RPそれぞれの相対位置を算出する。また、規定点位置データ算出部53は、グローバル座標系における複数の規定点RPそれぞれの絶対位置を算出する。
 規定点位置データ算出部53は、ブーム長さL1、アーム長さL2、バケット長さL3、チルト長さL4、及びバケット外形データを含む作業機データと、ブーム角度α、アーム角度β、バケット角度γ、チルト角度δ、及びチルト軸角度εを含む作業機角度データに基づいて、車体座標系における上部旋回体2の基準位置P0に対するバケット8の複数の規定点RPそれぞれの相対位置を算出することができる。図4に示すように、上部旋回体2の基準位置P0は、上部旋回体2の旋回軸RXに設定される。なお、上部旋回体2の基準位置P0は、ブーム軸AX1に設定されてもよい。
 また、規定点位置データ算出部53は、位置演算装置20で検出された上部旋回体2の絶対位置Pgと、上部旋回体2の基準位置P0とバケット8との相対位置とに基づいて、グローバル座標系におけるバケット8の絶対位置Paを算出可能である。絶対位置Pgと基準位置P0との相対位置は、油圧ショベル100の諸元データから導出される既知データである。規定点位置データ算出部53は、上部旋回体2の絶対位置Pgを含む車体位置データと、上部旋回体2の基準位置P0とバケット8との相対位置と、作業機データと、作業機角度データとに基づいて、グローバル座標系におけるバケット8の複数の規定点RPそれぞれの絶対位置を算出することができる。
 目標施工地形生成部54は、目標施工データ生成装置70から供給され記憶部60に記憶された目標施工データに基づいて、掘削対象の目標形状を示す目標施工地形CSを生成する。目標施工データ生成装置70は、目標施工データとして、3次元目標地形データを目標施工地形生成部54に供給してもよいし、目標形状の一部を示す複数のラインデータ又は複数のポイントデータを目標施工地形生成部54に供給してもよい。本実施形態においては、目標施工データ生成装置70は、目標施工データとして、目標形状の一部を示すラインデータを目標施工地形生成部54に供給することとする。
 図13は、本実施形態に係る目標施工データCDの一例を示す模式図である。図13に示すように、目標施工データCDは、施工エリアの目標地形を示す。目標地形は、三角形ポリゴンによってそれぞれ表現される複数の目標施工地形CSを含む。複数の目標施工地形CSのそれぞれは、作業機1による掘削対象の目標形状を示す。目標施工データCDにおいて、目標施工地形CSのうちバケット8との垂直距離が最も近い点APが規定される。また、目標施工データCDにおいて、点AP及びバケット8を通りバケット軸AX3と直交する作業機動作平面WPが規定される。作業機動作平面WPは、ブームシリンダ11、アームシリンダ12、及びバケットシリンダ13の少なくとも一つの作動によりバケット8の刃先9が移動する動作平面であり、XZ平面と平行である。規定点位置データ算出部53は、目標施工地形CS及びバケット8の外形データに基づいて、目標施工地形CSの点APに対して垂直距離が最も近くに規定される規定点RPの位置データを算出する。規定点RPを求めるとき、少なくともバケット8の幅に関係するデータが使用されればよい。また、規定点RPはオペレータより指定されてもよい。
 目標施工地形生成部54は、作業機動作平面WPと目標施工地形CSとの交線であるラインLXを取得する。また、目標施工地形生成部54は、点APを通り目標施工地形CSにおいてラインLXと直交するラインLYを取得する。ラインLYは、横動作平面VPと目標施工地形CSとの交線を示す。横動作平面VPとは、作業機動作平面WPと直交し、点APを通過する平面である。
 図14は、本実施形態に係る目標施工地形CSの一例を示す模式図である。目標施工地形生成部54は、ラインLX及びラインLYを取得して、ラインLX及びラインLYに基づいて、掘削対象の目標形状を示す目標施工地形CSを生成する。目標施工地形CSをバケット8で掘削する場合、制御装置50は、バケット8を通る作業機動作平面WPと目標施工地形CSとの交線であるラインLXに沿ってバケット8を移動させる。
 チルトデータ算出部55は、チルトデータとして、バケット8の規定点RPを通りチルト軸AX4と直交するチルト動作平面TPを算出する。
 図15及び図16は、本実施形態に係るチルト動作平面TPの一例を示す模式図である。図15は、チルト軸AX4が目標施工地形CSと平行であるときのチルト動作平面TPを示す。図16は、チルト軸AX4が目標施工地形CSと非平行であるときのチルト動作平面TPを示す。
 図15及び図16に示すように、チルト動作平面TPとは、バケット8に規定されている複数の規定点RPから選択された規定点RPrを通りチルト軸AX4と直交する動作平面をいう。規定点RPrとして、複数の規定点RPのうち、目標施工地形CSとの距離が最も近い規定点RPが選択される。
 図15及び図16は、一例として、刃先9に設定された規定点RPrを通るチルト動作平面TPを示す。チルト動作平面TPは、チルトシリンダ14の作動によりバケット8の規定点RPr(刃先9)が移動する動作平面である。ブームシリンダ11、アームシリンダ12、及びバケットシリンダ13の少なくとも一つが作動し、チルト軸AX4の向きを示すチルト軸角度εが変化すると、チルト動作平面TPの傾きも変化する。
 上述のように、作業機角度演算装置24は、XY平面に対するチルト軸AX4の傾斜角度を示すチルト軸角度εを算出可能である。チルト軸角度εは、作業機角度データ取得部52に取得される。また、規定点RPrの位置データは、規定点位置データ算出部53によって算出される。チルトデータ算出部55は、作業機角度データ取得部52で取得されたチルト軸AX4のチルト軸角度εと、規定点位置データ算出部53によって算出された規定点RPrの位置とに基づいて、チルト動作平面TPを算出することができる。
 チルト目標地形算出部56は、複数の規定点RPから選択された規定点RPrの位置データと目標施工地形CSとチルトデータとに基づいて、目標施工地形CSにおいてバケット8の側方方向に延在するチルト目標地形STを算出する。チルト目標地形算出部56は、目標施工地形CSとチルト動作平面TPとの交差部により規定されるチルト目標地形STを算出する。図15及び図16に示すように、チルト目標地形STは、目標施工地形CSとチルト動作平面TPとの交線によって表される。チルト軸AX4の向きであるチルト軸角度εが変化すると、チルト目標地形STの位置が変化する。
 角度決定部57は、目標施工地形CSとバケット8の特定部位とが平行となるように、チルト軸AX4を中心とするバケット8の特定部位の角度を示すチルト角度δを決定する。本実施形態において、バケット8の特定部位は、バケット8の刃先9である。
 図17は、本実施形態に係るバケット8の刃先9と目標施工地形CSとの関係を模式的に示す図である。図17(A)は、バケット8を-Xm側から見た図である。図17(B)は、バケット8を+Ym側から見た図である。図17に示すように、角度決定部57は、目標施工地形CSとバケット8の刃先9とが平行となるように、チルト軸AX4を中心とするバケット8の刃先9の角度を示すチルト角度δrを決定する。すなわち、角度決定部57は、バケット8の刃先9を目標施工地形CSと平行にするための、チルト回転方向におけるバケット8の刃先9のチルト回転角度δrを決定する。
 本実施形態においては、角度決定部57は、チルト目標地形STとバケット8の刃先9とが平行となるように、バケット8の刃先のチルト角度δrを決定する。
 作業機制御部58は、油圧シリンダ10を制御するための制御信号を出力する。作業機制御部58は、角度決定部57で決定されたチルト角度δrに基づいて、目標施工地形CSとバケット8の刃先9とが平行となるように、チルトシリンダ14を制御する。
 また、作業機制御部58は、バケット8の規定点RPrとチルト目標地形STとの距離を示す動作距離Daに基づいて、バケット8が目標施工地形CSを超えないように、チルト軸AX4を中心とするバケット8のチルト回転を停止させる。すなわち、作業機制御部58は、チルト回転するバケット8がチルト目標地形STを超えないように、チルト目標地形STでバケット8を停止させる。
 図15に示すように、チルト軸AX4が目標施工地形CSと平行であるとき、チルト目標地形STとラインLYとはほぼ一致する。したがって、チルト目標地形STを基準としたチルト回転についての介入制御とラインLYを基準としたチルト回転についての介入制御とは、実質的に同一である。
 作業機制御部58は、バケット8に設定された複数の規定点RPのうち動作距離Daが最も短い規定点RPrに基づいて、チルト回転についての介入制御を実施する。すなわち、作業機制御部58は、バケット8に設定された複数の規定点RPのうちチルト目標地形STに最も近い規定点RPrがチルト目標地形STを超えないように、チルト目標地形STに最も近い規定点RPrとチルト目標地形STとの動作距離Daに基づいて、チルト回転についての介入制御を実施する。
 目標速度決定部59は、動作距離Daに基づいて、バケット8のチルト回転速度についての目標速度Uを決定する。目標速度決定部59は、動作距離Daが閾値であるライン距離H以下のときに、チルト回転速度を制限する。
 図18は、本実施形態に係るチルト回転についての介入制御を説明するための模式図である。図18に示すように、目標施工地形CSが規定されるとともに、速度制限介入ラインILが規定される。速度制限介入ラインILは、チルト軸AX4と平行であり、チルト目標地形STからライン距離Hだけ離れた位置に規定される。ライン距離Hは、オペレータの操作感が損なわれないように設定されることが望ましい。作業機制御部58は、チルト回転するバケット8の少なくとも一部が速度制限介入ラインILを超え、動作距離Daがライン距離H以下になったとき、バケット8のチルト回転速度を制限する。目標速度決定部59は、速度制限介入ラインILを超えたバケット8のチルト回転速度についての目標速度Uを決定する。図18に示す例では、バケット8の一部が速度制限介入ラインILを超え、動作距離Daがライン距離Hよりも小さいため、チルト回転速度が制限される。
 目標速度決定部59は、チルト動作平面TPと平行な方向における規定点RPrとチルト目標地形STとの動作距離Daを取得する。また、目標速度決定部59は、動作距離Daに応じた目標速度Uを取得する。作業機制御部58は、動作距離Daがライン距離H以下であると判定された場合、チルト回転速度を制限する。
 図19は、本実施形態に係る動作距離Daと目標速度Uとの関係の一例を示す図である。図19は、バケット8のチルト回転を動作距離Daに基づいて停止させるための動作距離Daと目標速度Uとの関係の一例を示す。図19に示すように、目標速度Uは、動作距離Daに応じて画一的に決められている速度である。目標速度Uは、動作距離Daがライン距離Hよりも大きいときには設定されず、動作距離Daがライン距離H以下のときに設定される。動作距離Daが小さくなるほど、目標速度Uは小さくなり、動作距離Daが零になると、目標速度Uも零になる。なお、図19では、目標施工地形CSに近付く方向を負の方向として表している。
 目標速度決定部59は、操作装置30のチルト操作レバー30Tの操作量に基づいて、規定点RPが目標施工地形CS(チルト目標地形ST)に向かって移動するときの移動速度Vrを算出する。移動速度Vrは、チルト動作平面TPと平行な面内における規定点RPrの移動速度である。移動速度Vrは、複数の規定点RPのそれぞれについて算出される。
 本実施形態においては、チルト操作レバー30Tが操作された場合、チルト操作レバー30Tから出力された電流値に基づいて、移動速度Vrが算出される。チルト操作レバー30Tが操作されると、チルト操作レバー30Tの操作量に応じた電流がチルト操作レバー30Tから出力される。記憶部60には、チルト操作レバー30Tの操作量に応じたチルトシリンダ14のシリンダ速度を記憶することができる。なお、シリンダ速度は、シリンダストロークセンサの検出から求められてもよい。チルトシリンダ14のシリンダ速度が算出された後、目標速度決定部59は、ヤコビアン行列式を使って、チルトシリンダ14のシリンダ速度をバケット8の複数の規定点RPそれぞれの移動速度Vrに変換する。
 作業機制御部58は、動作距離Daがライン距離H以下であると判定された場合、目標施工地形CSに対する規定点RPrの移動速度Vrを目標速度Uに制限する速度制限を実施する。作業機制御部58は、バケット8の規定点RPrの移動速度Vrを抑えるために、制御弁37に制御信号を出力する。作業機制御部58は、バケット8の規定点RPrの移動速度Vrが動作距離Daに応じた目標速度Uになるように、制御弁37に制御信号を出力する。これにより、チルト回転するバケット8の規定点RPrの移動速度RPは、規定点RPrが目標施工地形CS(チルト目標地形ST)に近付くほど遅くなり、規定点RPr(刃先9)が目標施工地形CDに到達したときに零になる。
[角度調整方法]
 次に、本実施形態に係るバケット8のチルト角度δの調整方法について説明する。図20は、本実施形態に係るバケット8のチルト角度δの調整方法の一例を示すフローチャートである。図21は、本実施形態に係るバケット8のチルト角度δの調整方法の一例を説明するための模式図である。
 規定点位置データ算出部53は、刃先9に規定されている規定点RPaの位置データ及び規定点RPbの位置データを算出する(ステップSA10)。
 図21に示すように、規定点RPa及び規定点RPbは、刃先9におけるバケット8の幅方向両側の規定点である。規定点位置データ算出部53は、車体座標系における規定点RPaの位置データ及び規定点RPbの位置データを算出する。
 また、規定点位置データ算出部53は、規定点RPaの位置データ及び規定点RPbの位置データに基づいて、規定点RPaと規定点RPbとを結ぶ方向ベクトルVec_abを算出する。方向ベクトルVec_abは、以下の(1)式で規定される。
Figure JPOXMLDOC01-appb-M000001
 目標施工地形生成部54は、目標施工地形CSの法線ベクトルNdを算出する(ステップSA20)。
 角度決定部57は、チルト動作平面TPと目標施工地形CSとの交線ベクトルSTrを算出する(ステップSA30)。
 角度決定部57は、バケット8の刃先9と目標施工地形CSとを平行にするためのバケット8の刃先9のチルト角度δrを算出する(ステップSA40)。
 本実施形態において、角度決定部57は、以下の(2)式を演算処理して、チルト角度δrを算出する。
Figure JPOXMLDOC01-appb-M000002
 作業機制御部58は、角度決定部57で決定されたチルト角度δrに基づいて、目標施工地形CSとバケット8の刃先9とが平行となるように、チルトシリンダ14を制御する(ステップSA50)。
[効果]
 以上説明したように、本実施形態によれば、チルト式バケットにおいて、目標施工地形CSに対するバケット8の刃先9の相対角度に基づいて、目標施工地形CSとバケット8の刃先9とが平行となるように、角度決定部57においてチルト軸AX4を中心とするバケット8の刃先9のチルト角度δrが決定される。作業機制御部58は、角度決定部57で決定されたチルト角度δrに基づいて、チルト軸AX4を中心にバケット8を回転させるチルトシリンダ14を制御する。これにより、チルト回転方向においてバケット8の刃先9と目標施工地形CSとを平行にすることができる。したがって、施工時における油圧ショベル1の運転者の操作の負担が軽減されるとともに、運転者の習熟度に依存しない高品質な施工結果が得られる。
第2実施形態.
 第2実施形態について説明する。以下の説明において、上述の実施形態と同一又は同等の構成要素については同一の符号を付し、その説明を簡略又は省略する。
 図22及び図23は、本実施形態に係る作業機1の動作の一例を模式的に示す図である。図22及び図23は、チルト式のバケット8を有する作業機1を用いて傾斜した目標施工地形CSに基づいて施工が実施される例を示す。
 図22に示すように、バケット8の刃先9と目標施工地形CSとを平行にして刃先9と目標施工地形CSとを一致させた状態で、アーム7を移動しながら施工を実施したい場合がある。また、図23に示すように、バケット8の床面89と目標施工地形CSとを平行にして床面89と目標施工地形CSとを一致させた状態で、アーム7を移動しながら施工を実施したい場合がある。
 本実施形態においては、アーム7が作動する状態で、バケット8の刃先9及び床面89の少なくとも一方と目標施工地形CSとの平行が維持されるように、作業機制御部58が、チルトシリンダ14及びバケットシリンダ13の少なくとも一方を制御する例について説明する。
 図24は、本実施形態に係るバケット8の角度の調整方法の一例を示すフローチャートである。図25及び図26は、本実施形態に係るバケット8の角度の調整方法の一例を説明するための模式図である。図25は、バケット8の刃先9と目標施工地形CSとを平行にするときのバケット8の角度の調整方法の一例を模式的に示す。図26は、バケット8の床面89と目標施工地形CSとを平行にするときのバケット8の角度の調整方法の一例を模式的に示す。
 以下の説明では、バケット8の刃先9及び床面89を総称して適宜、バケット8の特定部位、と称する。
 規定点位置データ算出部53は、刃先9に規定されている規定点RPaの位置データ及び規定点RPbの位置データと、床面89に規定されている規定点RPcの位置データとを算出する(ステップSB10)。
 図25に示すように、規定点RPa及び規定点RPbは、刃先9におけるバケット8の幅方向両側の規定点である。規定点位置データ算出部53は、車体座標系における規定点RPaの位置データ及び規定点RPbの位置データを算出する。
 図26に示すように、規定点RPcは、平坦な床面89の一部の規定点である。バケット8の幅方向において、規定点RPaの座標と規定点RPcの座標とは等しい。本実施形態において、規定点RPaは、底板81の一端部に規定され、規定点RPcは、底板81の他端部に規定される。
 また、規定点位置データ算出部53は、規定点RPaの位置データ及び規定点RPbの位置データに基づいて、規定点RPaと規定点RPbとを結ぶ方向ベクトルVec_abを算出する。
 また、規定点位置データ算出部53は、規定点RPaの位置データ及び規定点RPcの位置データに基づいて、規定点RPaと規定点RPcとを結ぶ方向ベクトルVec_acを算出する。
 また、規定点位置データ算出部53は、チルト軸AX4の法線ベクトルVec_tiltを算出する。
 角度決定部57は、目標施工地形CSと平行にするバケット8の特定部位の目標法線ベクトルNrefを算出する(ステップSB20)。
 例えば、目標施工地形CSとバケット8の刃先9とを平行にする場合、図25に示すように、角度決定部57は、バケット8の刃先9の方向ベクトルVec_abと直交するバケット8の刃先9の目標法線ベクトルNrefを算出する。バケット8の刃先9の目標法線ベクトルNrefは、チルト動作平面TPにおいて、バケット8の刃先9の方向ベクトルVec_abと直交するように規定される。バケット8の刃先9の目標法線ベクトルNrefは、チルト軸AX4の法線ベクトルVec_tiltとも直交する。
 また、目標施工地形CSとバケット8の床面89とを平行にする場合、図26に示すように、角度決定部57は、バケット8の床面89の方向ベクトルVec_acと直交するバケット8の床面89の目標法線ベクトルNrefを算出する。床面89は実質的に平面である。したがって、バケット8の床面89の目標法線ベクトルNrefは一義的に定まる。
 方向ベクトルVec_abは、上述の(1)式で規定される。方向ベクトルVec_acは、以下の(3)式で規定される。
Figure JPOXMLDOC01-appb-M000003
 バケット8の刃先9の目標法線ベクトルNrefは、以下の(4)式で規定される。
Figure JPOXMLDOC01-appb-M000004
 バケット8の床面89の目標法線ベクトルNrefは、以下の(5)式で規定される。
Figure JPOXMLDOC01-appb-M000005
 目標施工地形生成部54は、目標施工地形CSの法線ベクトルNdを算出する(ステップSB30)。
 角度検出部57は、評価関数Qを算出する(ステップSB40)。
 評価関数Qは、目標法線ベクトルNrefと法線ベクトルNdとの平行誤差を示す評価関数Q1と、刃先9と目標施工地形CSとの距離Daを示す評価関数Q2との和である。すなわち、以下の(6)式、(7)式、及び(8)式が成立する。
Figure JPOXMLDOC01-appb-M000006
Figure JPOXMLDOC01-appb-M000007
Figure JPOXMLDOC01-appb-M000008
 (6)式において、目標法線ベクトルNrefと法線ベクトルNdとが平行となる条件は、互いに内積が1になることである。すなわち、以下の(9)式が成立することである。
Figure JPOXMLDOC01-appb-M000009
 なお、(8)式において、バケット8を目標施工地形CSに接触させる必要が無い場合には、Q=Q1でよい。
 角度検出部57は、(8)の評価関数Qが最小になるように、所定の数値演算法により演算処理を実施する。演算処理には、例えばニュートン法、パウエル法、及びシンプレックス法などが利用可能である。
 角度検出部57は、評価関数Qが最小になったか否かを判定する(ステップSB50)。すなわち、角度検出部57は、所定の数値演算法により演算処理を実施して、評価関数が実質的に零になったか否かを判定する。
 ステップSB50において、評価関数Qが最小である判定された場合(ステップSB50:Yes)、角度検出部57は、バケット8の特定部位と目標施工地形CSとを平行にするためのバケット8の特定部位のチルト角度δr及びバケット角度γrを算出する(ステップSB60)。すなわち、角度検出部57は、評価関数Qを最小にするチルト角度δr及びバケット角度γrを決定する。
 チルト角度δrは、目標施工地形CSとバケット8の特定部位とを平行にするための、チルト軸AX4を中心とするバケット8の特定部位の角度を示す。バケット角度γrは、バケット軸AX3を中心とするバケット8の特定部位の角度を示す。
 作業機制御部58は、角度決定部57で決定されたチルト角度δr及びバケット角度γrに基づいて、目標施工地形CSとバケット8の特定部位とが平行となるように、チルトシリンダ14及びバケットシリンダ13を制御する(ステップSB70)。
 ステップSB50において、評価関数Qが最小でないと判定された場合(ステップSB50:No)、角度検出部57は、チルト角度δr又はバケット角度γrを更新し(ステップSB80)、ステップSB40の処理に戻る。
その他の実施形態.
 なお、上述の実施形態において、評価関数Qについて、評価関数Q1及び評価関数Q2に重み付けしてもよい。
 なお、上述の実施形態においては、建設機械100が油圧ショベルであることとした。上述の実施形態で説明した構成要素は、油圧ショベルとは別の、作業機を有する建設機械に適用可能である。
 なお、上述の実施形態において、上部旋回体2は、油圧により旋回してもよいし、電動アクチュエータが発生する動力により旋回してもよい。また、作業機1は、油圧シリンダ10ではなく、電動アクチュエータが発生する動力により作動してもよい。
 1 作業機、2 上部旋回体、3 下部走行体、3C 履帯、4 運転室、5 機械室、6 ブーム、7 アーム、8 バケット、8B バケットピン、8T チルトピン、9 刃先、10 油圧シリンダ、10A キャップ側油室、10B ロッド側油室、11 ブームシリンダ、12 アームシリンダ、13 バケットシリンダ、14 チルトシリンダ、16 ブームストロークセンサ、17 アームストロークセンサ、18 バケットストロークセンサ、19 チルトストロークセンサ、20 位置演算装置、21 車体位置演算器、22 姿勢演算器、23 方位演算器、24 作業機角度演算装置、25 流量制御弁、30 操作装置、30F 操作ペダル、30L 左作業機操作レバー、30R 右作業機操作レバー、30T チルト操作レバー、31 メイン油圧ポンプ、32 パイロット圧ポンプ、33A,33B 油路、34A,34B 圧力センサ、35A,35B 油路、36A,36B シャトル弁、37A,37B 制御弁、38A,38B 油路、50 制御装置、51 車体位置データ取得部、52 作業機角度データ取得部、53 規定点位置データ算出部、54 目標施工地形生成部、55 チルトデータ算出部、56 チルト目標地形算出部、57 角度決定部、58 作業機制御部、59 目標速度決定部、60 記憶部、61 入出力部、70 目標施工データ生成装置、81 底板、82 背板、83 上板、84 側板、85 側板、86 開口部、87 ブラケット、88 ブラケット、89 床面、90 接続部材、91 プレート部材、92 ブラケット、93 ブラケット、94 第1リンク部材、94P 第1リンクピン、95 第2リンク部材、95P 第2リンクピン、96 バケットシリンダトップピン、97 ブラケット、100 油圧ショベル(建設機械)、200 制御システム、300 油圧システム、400 検出システム、AP 点、AX1 ブーム軸、AX2 アーム軸、AX3 バケット軸、AX4 チルト軸、CD 目標施工データ、CS 目標施工地形、Da 動作距離、L1 ブーム長さ、L2 アーム長さ、L3 バケット長さ、L4 チルト長さ、L5 バケット幅、LX ライン、LY ライン、RP 規定点、RX 旋回軸、ST チルト目標地形、TP チルト動作平面、α ブーム角度、β アーム角度、γ バケット角度、δ チルト角度、ε チルト軸角度、θ1 ロール角度、θ2 ピッチ角度、θ3 ヨー角度。

Claims (6)

  1.  アームと、バケット軸及び前記バケット軸と直交するチルト軸のそれぞれを中心に前記アームに対して回転可能なバケットとを含む作業機を備える建設機械の制御システムであって、
     掘削対象の目標形状を示す目標施工地形と前記バケットの特定部位とが平行となるように、前記チルト軸を中心とする前記バケットの前記特定部位の角度を示すチルト角度を決定する角度決定部と、
     前記角度決定部で決定された前記チルト角度に基づいて、前記チルト軸を中心に前記バケットを回転させるチルトシリンダを制御する作業機制御部と、
    を備える建設機械の制御システム。
  2.  前記角度決定部は、前記目標施工地形と前記バケットの前記特定部位とが平行となるように、前記バケット軸を中心とする前記バケットの前記特定部位の角度を示すバケット角度を決定し、
     前記作業機制御部は、前記角度決定部で決定された前記チルト角度及び前記バケット角度に基づいて、前記チルトシリンダ及び前記バケット軸を中心に前記バケットを回転させるバケットシリンダを制御する、
    請求項1に記載の建設機械の制御システム。
  3.  前記バケットは、刃先と、前記刃先と接続される平坦な床面とを含み、
     前記特定部位は、前記刃先及び前記床面を含む、
    請求項2に記載の建設機械の制御システム。
  4.  前記作業機制御部は、前記アームが作動する状態で、前記バケットの前記特定部位と前記目標施工地形との平行が維持されるように、前記チルトシリンダ及び前記バケットシリンダの少なくとも一方を制御する、
    請求項2又は請求項3に記載の建設機械の制御システム。
  5.  上部旋回体と、
     前記上部旋回体を支持する下部走行体と、
     前記アームと前記バケットとを含み、前記上部旋回体に支持される作業機と、
     請求項1から請求項4のいずれか一項に記載の建設機械の制御システムと、
    を備える建設機械。
  6.  アームと、バケット軸及び前記バケット軸と直交するチルト軸のそれぞれを中心に前記アームに対して回転可能なバケットとを含む作業機を備える建設機械の制御方法であって、
     掘削対象の目標形状を示す目標施工地形と前記バケットの特定部位とが平行となるように、前記チルト軸を中心とする前記バケットの前記特定部位の角度を示すチルト角度を決定することと、
     前記角度決定部で決定された前記チルト角度に基づいて、前記チルト軸を中心に前記バケットを回転させるチルトシリンダを制御することと、
    を含む建設機械の制御方法。
PCT/JP2017/027910 2016-08-12 2017-08-01 建設機械の制御システム、建設機械、及び建設機械の制御方法 WO2018030220A1 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
KR1020187033137A KR102165663B1 (ko) 2016-08-12 2017-08-01 건설 기계의 제어 시스템, 건설 기계, 및 건설 기계의 제어 방법
CN201780031792.0A CN109154150B (zh) 2016-08-12 2017-08-01 建筑机械的控制系统、建筑机械及建筑机械的控制方法
US16/301,503 US20190292747A1 (en) 2016-08-12 2017-08-01 Control system of construction machine, construction machine, and control method of construction machine
DE112017002603.2T DE112017002603T5 (de) 2016-08-12 2017-08-01 Steuerungssystem einer baumaschine, baumaschine und steuerverfahren einer baumaschine
JP2018532960A JP7129907B2 (ja) 2016-08-12 2017-08-01 建設機械の制御システム、建設機械、及び建設機械の制御方法

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2016158832 2016-08-12
JP2016-158832 2016-08-12

Publications (1)

Publication Number Publication Date
WO2018030220A1 true WO2018030220A1 (ja) 2018-02-15

Family

ID=61163409

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2017/027910 WO2018030220A1 (ja) 2016-08-12 2017-08-01 建設機械の制御システム、建設機械、及び建設機械の制御方法

Country Status (6)

Country Link
US (1) US20190292747A1 (ja)
JP (1) JP7129907B2 (ja)
KR (1) KR102165663B1 (ja)
CN (1) CN109154150B (ja)
DE (1) DE112017002603T5 (ja)
WO (1) WO2018030220A1 (ja)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020158235A1 (ja) * 2019-02-01 2020-08-06 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
WO2020158241A1 (ja) * 2019-02-01 2020-08-06 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
WO2020158234A1 (ja) * 2019-02-01 2020-08-06 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
WO2020158243A1 (ja) * 2019-02-01 2020-08-06 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7045926B2 (ja) * 2018-05-22 2022-04-01 株式会社小松製作所 油圧ショベル、およびシステム
JP7315333B2 (ja) * 2019-01-31 2023-07-26 株式会社小松製作所 建設機械の制御システム、及び建設機械の制御方法
CN110258713B (zh) * 2019-06-26 2021-05-14 广西柳工机械股份有限公司 装载机工作装置位置参数数据的获取方法
JP7396875B2 (ja) * 2019-11-27 2023-12-12 株式会社小松製作所 作業機械の制御システム、作業機械、および作業機械の制御方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002030690A (ja) * 2000-07-18 2002-01-31 Yanmar Diesel Engine Co Ltd アタッチメント水平機構付き掘削作業車
JP2003119818A (ja) * 2001-10-09 2003-04-23 Fukuzawa Corporation:Kk 掘削装置、この駆動方法、及び傾斜角計測装置
JP2014074319A (ja) * 2012-10-05 2014-04-24 Komatsu Ltd 掘削機械の表示システム、掘削機械及び掘削機械の表示用コンピュータプログラム

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1826448B (zh) * 2003-07-30 2010-04-28 株式会社小松制作所 作业机械
SE532563C2 (sv) * 2005-01-31 2010-02-23 Komatsu Mfg Co Ltd Arbetsmaskin där arbetsverktyget är bytbart mellan en skopa och en gaffel
US7810260B2 (en) * 2007-12-21 2010-10-12 Caterpillar Trimble Control Technologies Llc Control system for tool coupling
KR20120022233A (ko) * 2010-09-01 2012-03-12 현대중공업 주식회사 굴삭기 버켓 자동 조정방법
JP5555190B2 (ja) * 2011-02-22 2014-07-23 株式会社小松製作所 油圧ショベルの表示システム及びその制御方法
WO2012127913A1 (ja) * 2011-03-24 2012-09-27 株式会社小松製作所 掘削制御システムおよび建設機械
JP2015186179A (ja) 2014-03-26 2015-10-22 京セラ株式会社 電子機器
DE112014000080B4 (de) * 2014-05-30 2018-06-21 Komatsu Ltd. Arbeitsmaschinensteuersystem, Arbeitsmaschine,Baggersteuersystem und Arbeitsmaschinensteuerverfahren
CN105378186B (zh) 2014-06-02 2017-02-22 株式会社小松制作所 建筑机械的控制系统、建筑机械及建筑机械的控制方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002030690A (ja) * 2000-07-18 2002-01-31 Yanmar Diesel Engine Co Ltd アタッチメント水平機構付き掘削作業車
JP2003119818A (ja) * 2001-10-09 2003-04-23 Fukuzawa Corporation:Kk 掘削装置、この駆動方法、及び傾斜角計測装置
JP2014074319A (ja) * 2012-10-05 2014-04-24 Komatsu Ltd 掘削機械の表示システム、掘削機械及び掘削機械の表示用コンピュータプログラム

Cited By (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020158235A1 (ja) * 2019-02-01 2020-08-06 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
WO2020158241A1 (ja) * 2019-02-01 2020-08-06 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
WO2020158234A1 (ja) * 2019-02-01 2020-08-06 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
WO2020158243A1 (ja) * 2019-02-01 2020-08-06 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
JP2020125598A (ja) * 2019-02-01 2020-08-20 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
JP2020125594A (ja) * 2019-02-01 2020-08-20 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
JP2020125595A (ja) * 2019-02-01 2020-08-20 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
JP2020125599A (ja) * 2019-02-01 2020-08-20 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
CN113383130A (zh) * 2019-02-01 2021-09-10 株式会社小松制作所 工程机械的控制系统、工程机械及工程机械的控制方法
CN113383130B (zh) * 2019-02-01 2022-07-01 株式会社小松制作所 工程机械的控制系统、工程机械及工程机械的控制方法
JP7197392B2 (ja) 2019-02-01 2022-12-27 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
JP7283910B2 (ja) 2019-02-01 2023-05-30 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
JP7336853B2 (ja) 2019-02-01 2023-09-01 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
US12000108B2 (en) 2019-02-01 2024-06-04 Komatsu Ltd. Control system for construction machine, construction machine, and control method for construction machine
US12006662B2 (en) 2019-02-01 2024-06-11 Komatsu Ltd. Control system for construction machine, construction machine, and control method for construction machine
US12054920B2 (en) 2019-02-01 2024-08-06 Komatsu Ltd. Control system for construction machine, construction machine, and control method for construction machine

Also Published As

Publication number Publication date
KR102165663B1 (ko) 2020-10-14
KR20180135939A (ko) 2018-12-21
JPWO2018030220A1 (ja) 2019-06-06
JP7129907B2 (ja) 2022-09-02
CN109154150B (zh) 2021-09-28
CN109154150A (zh) 2019-01-04
DE112017002603T5 (de) 2019-04-25
US20190292747A1 (en) 2019-09-26

Similar Documents

Publication Publication Date Title
WO2018030220A1 (ja) 建設機械の制御システム、建設機械、及び建設機械の制御方法
JP6046320B1 (ja) 建設機械の制御システム、建設機械、及び建設機械の制御方法
JP6099834B1 (ja) 建設機械の制御システム、建設機械、及び建設機械の制御方法
JP6271771B2 (ja) 建設機械の制御装置及び建設機械の制御方法
JP6099835B1 (ja) 作業機械の制御システム、作業機械及び作業機械の制御方法
CN106460361B (zh) 作业机械的控制系统、作业机械以及作业机械的控制方法
JP6781067B2 (ja) 建設機械の制御システム、建設機械、及び建設機械の制御方法
JP6680849B2 (ja) 作業機械の制御システム、及び作業機械の制御方法
JP6781068B2 (ja) 作業機械の制御システム、作業機械及び作業機械の制御方法
WO2018123470A1 (ja) 建設機械の制御装置及び建設機械の制御方法

Legal Events

Date Code Title Description
WWE Wipo information: entry into national phase

Ref document number: 2018532960

Country of ref document: JP

ENP Entry into the national phase

Ref document number: 20187033137

Country of ref document: KR

Kind code of ref document: A

121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 17839293

Country of ref document: EP

Kind code of ref document: A1

122 Ep: pct application non-entry in european phase

Ref document number: 17839293

Country of ref document: EP

Kind code of ref document: A1