WO2023054615A1 - 作業機械を制御するためのシステム、方法およびプログラム - Google Patents
作業機械を制御するためのシステム、方法およびプログラム Download PDFInfo
- Publication number
- WO2023054615A1 WO2023054615A1 PCT/JP2022/036525 JP2022036525W WO2023054615A1 WO 2023054615 A1 WO2023054615 A1 WO 2023054615A1 JP 2022036525 W JP2022036525 W JP 2022036525W WO 2023054615 A1 WO2023054615 A1 WO 2023054615A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- bucket
- axis
- tilt
- work machine
- work implement
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 14
- 238000005259 measurement Methods 0.000 claims abstract description 24
- 239000011159 matrix material Substances 0.000 description 34
- 230000009466 transformation Effects 0.000 description 30
- 230000006870 function Effects 0.000 description 21
- 238000013461 design Methods 0.000 description 20
- 230000008569 process Effects 0.000 description 9
- 238000010586 diagram Methods 0.000 description 7
- 230000007246 mechanism Effects 0.000 description 7
- 238000009412 basement excavation Methods 0.000 description 5
- 239000002689 soil Substances 0.000 description 5
- 230000000694 effects Effects 0.000 description 4
- 238000010276 construction Methods 0.000 description 3
- 230000015654 memory Effects 0.000 description 3
- 230000001131 transforming effect Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 239000010720 hydraulic oil Substances 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- ATJFFYVFTNAWJD-UHFFFAOYSA-N Tin Chemical compound [Sn] ATJFFYVFTNAWJD-UHFFFAOYSA-N 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 230000001174 ascending effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 239000012530 fluid Substances 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 230000014759 maintenance of location Effects 0.000 description 1
- 238000012806 monitoring device Methods 0.000 description 1
- 239000003921 oil Substances 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000003825 pressing Methods 0.000 description 1
- 238000004549 pulsed laser deposition Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
Images
Classifications
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
- E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
- E02F3/436—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like for keeping the dipper in the horizontal position, e.g. self-levelling
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/3604—Devices to connect tools to arms, booms or the like
- E02F3/3677—Devices 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
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/3604—Devices to connect tools to arms, booms or the like
- E02F3/3677—Devices 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
- E02F3/3681—Rotators
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/40—Dippers; Buckets ; Grab devices, e.g. manufacturing processes for buckets, form, geometry or material of buckets
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
- E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
- E02F3/437—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like providing automatic sequences of movements, e.g. linear excavation, keeping dipper angle constant
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
- E02F9/264—Sensors and their calibration for indicating the position of the work tool
- E02F9/265—Sensors 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)
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2200/00—Type of vehicle
- B60Y2200/40—Special vehicles
- B60Y2200/41—Construction vehicles, e.g. graders, excavators
- B60Y2200/412—Excavators
Definitions
- the present disclosure relates to systems, methods and programs for controlling work machines.
- This application claims priority to Japanese Patent Application No. 2021-161174 filed in Japan on September 30, 2021, the contents of which are incorporated herein.
- Patent Document 1 discloses a control system for a construction machine (work machine) having a tiltable tilt bucket. As described above, there is known a working machine that is equipped with a plurality of rotating mechanisms capable of rotating around different axes and that can rotate a working implement such as a bucket as desired.
- a tilt rotator that supports an attachment of a work machine so that it can rotate around three mutually orthogonal axes. By attaching a tilt rotator to the work machine, the attachment can be oriented in any direction.
- a working machine such as a hydraulic excavator
- a hydraulic excavator when loading soil or the like onto the bed of a dump truck, there is a demand to avoid spilling the soil as much as possible in the process of moving the bucket onto the bed.
- a hydraulic excavator equipped with a plurality of rotating mechanisms as described above if an attempt is made to move the bucket in a state in which the width direction of the bucket (the direction along the cutting edge) is not horizontal, the bucket may be loaded. Soil tends to spill out during transport to the dump truck bed. Therefore, when moving the bucket, it is preferable to horizontally adjust the width direction of the bucket.
- An object of the present disclosure is to provide a work machine including a work implement supported by the work machine via a tiltrotator, without changing a first reference direction of the work implement (for example, an opening direction of a bucket), and a second reference direction. It is an object of the present invention to provide a system, method and program capable of simplifying an operation for aligning a direction (for example, the blade edge direction of a bucket) with a predetermined plane (for example, a vehicle body reference plane).
- a system includes a work machine operably supported by a vehicle body, a tilt rotator attached to the tip of the work machine, and a tilt rotator mounted on the work machine on different planes via the tilt rotator.
- a system for controlling a work machine comprising a work implement supported for rotation about three intersecting axes, the system comprising a processor.
- a processor obtains measurements from multiple sensors.
- a processor calculates a current attitude of the work implement based on the measurements.
- the processor determines the virtual axis of rotation based on the calculated current attitude of the work implement when a predetermined control start condition is satisfied.
- the processor generates a tiltrotator control signal for rotating the work implement about the virtual rotation axis by a predetermined amount from the current attitude to the target attitude.
- the processor outputs the generated control signal.
- the operation of aligning the second reference direction of the work implement with the predetermined plane without changing the first reference direction of the work implement. can be simplified.
- FIG. 1 is a schematic diagram showing the configuration of a working machine 100 according to a first embodiment
- FIG. 4 is a diagram showing the configuration of a tiltrotator 163 according to the first embodiment
- FIG. It is a figure showing a drive system of work machine 100 concerning a 1st embodiment
- 2 is a schematic block diagram showing the configuration of a control device 200 according to the first embodiment
- FIG. 4 is a flow chart showing an angle adjustment function in the first embodiment; It is a figure which shows the detail of the operating device in 1st Embodiment. It is a figure which shows the effect by the angle adjustment function in 1st Embodiment. It is a figure which shows the effect by the angle adjustment function in 1st Embodiment.
- FIG. 1 is a schematic diagram showing the configuration of a working machine 100 according to the first embodiment.
- a working machine 100 according to the first embodiment is, for example, a hydraulic excavator.
- the working machine 100 includes a traveling body 120 , a revolving body 140 , a working machine 160 , an operator's cab 180 and a control device 200 .
- the work machine 100 according to the first embodiment controls the cutting edge of the bucket 164 so as not to exceed the design surface.
- Traveling body 120 supports work machine 100 so that it can travel.
- the traveling body 120 is, for example, a pair of left and right endless tracks.
- the revolving body 140 is supported by the traveling body 120 so as to be able to revolve around the revolving center.
- Work implement 160 is operably supported by revolving body 140 .
- Work implement 160 is hydraulically driven.
- the working machine 160 includes a boom 161, an arm 162, a tiltrotator 163, and a bucket 164 as a working implement.
- a base end of the boom 161 is rotatably attached to the revolving body 140 .
- a proximal end of the arm 162 is rotatably attached to a distal end of the boom 161 .
- the tilt rotator 163 is rotatably attached to the tip of the arm 162 .
- Bucket 164 is attached to tiltrotator 163 .
- Bucket 164 is rotatably supported by tilt rotator 163 with respect to work implement 160 about three axes that intersect on different planes.
- a portion of the revolving body 140 to which the work implement 160 is attached is referred to as a front portion.
- the front portion is referred to as the rear portion
- the left portion is referred to as the left portion
- the right portion is referred to as the right portion.
- FIG. 2 is a diagram showing the configuration of the tiltrotator 163 according to the first embodiment.
- a tiltrotator 163 is attached to the tip of the arm 162 so as to support the bucket 164 .
- the tilt rotator 163 has a mounting portion 1631 , a tilt portion 1632 and a rotation portion 1633 .
- the attachment portion 1631 is attached to the tip of the arm 162 so as to be rotatable about an axis extending in the horizontal direction of the drawing.
- the tilt part 1632 is attached to the attachment part 1631 so as to be rotatable around an axis extending in the longitudinal direction of the drawing.
- the rotating portion 1633 is attached to the tilt portion 1632 so as to be rotatable around an axis extending vertically in the drawing.
- the rotation axes of the attachment portion 1631, the tilt portion 1632, and the rotation portion 1633 are orthogonal to each other.
- a base end portion of the bucket 164 is fixed to the rotating portion 1633 .
- the bucket 164 can rotate about three axes perpendicular to each other with respect to the arm 162 .
- the rotation axes of the mounting portion 1631, the tilt portion 1632, and the rotation portion 1633 include design errors and may not necessarily be orthogonal.
- the operator's cab 180 is provided in the front part of the revolving body 140 . Inside the operator's cab 180, an operation device 271 for an operator to operate the work machine 100 and a monitor device 272 as a man-machine interface of the control device 200 are provided.
- the operation device 271 controls the amount of operation of the travel motor 304, the amount of operation of the swing motor 305, the amount of operation of the boom cylinder 306, the amount of operation of the arm cylinder 307, the amount of operation of the bucket cylinder 308, the amount of operation of the tilt cylinder 309, and the input of the operation amount of rotary motor 310 .
- the monitor device 272 receives an input for setting and canceling the bucket attitude holding mode from the operator.
- the bucket attitude holding mode is a mode in which controller 200 automatically controls bucket cylinder 308, tilt cylinder 309, and rotary motor 310 to maintain the attitude of bucket 164 in the global coordinate system.
- the monitor device 272 is realized by a computer having a touch panel, for example.
- the control device 200 controls the traveling body 120, the revolving body 140, and the working machine 160 based on the operation of the operating device 271 by the operator.
- the control device 200 is provided inside the cab 180, for example.
- FIG. 3 is a diagram showing the drive system of the work machine 100 according to the first embodiment.
- Work machine 100 includes a plurality of actuators for driving work machine 100 .
- the work machine 100 includes an engine 301 , a hydraulic pump 302 , a control valve 303 , a pair of travel motors 304 , a swing motor 305 , a boom cylinder 306 , an arm cylinder 307 , a bucket cylinder 308 , a tilt cylinder 309 , a rotary motor 310 .
- the work machine 100 includes an engine 301 , a hydraulic pump 302 , a control valve 303 , a pair of travel motors 304 , a swing motor 305 , a boom cylinder 306 , an arm cylinder 307 , a bucket cylinder 308 , a tilt cylinder 309 , a rotary motor 310 .
- the engine 301 is a prime mover that drives the hydraulic pump 302 .
- Hydraulic pump 302 is driven by engine 301 and supplies working oil to travel motor 304 , swing motor 305 , boom cylinder 306 , arm cylinder 307 and bucket cylinder 308 via control valve 303 .
- Control valve 303 controls the flow rate of hydraulic oil supplied from hydraulic pump 302 to travel motor 304 , swing motor 305 , boom cylinder 306 , arm cylinder 307 and bucket cylinder 308 .
- Traveling motor 304 is driven by hydraulic fluid supplied from hydraulic pump 302 to drive traveling body 120 .
- the swing motor 305 is driven by hydraulic oil supplied from the hydraulic pump 302 to swing the swing body 140 with respect to the traveling body 120 .
- Boom cylinder 306 is a hydraulic cylinder for driving boom 161 .
- the base end of boom cylinder 306 is attached to rotating body 140 .
- a tip of the boom cylinder 306 is attached to the boom 161 .
- Arm cylinder 307 is a hydraulic cylinder for driving arm 162 .
- a base end of the arm cylinder 307 is attached to the boom 161 .
- a tip of the arm cylinder 307 is attached to the arm 162 .
- Bucket cylinder 308 is a hydraulic cylinder for driving tiltrotator 163 and bucket 164 .
- the proximal end of bucket cylinder 308 is attached to arm 162 .
- a tip of the bucket cylinder 308 is attached to the tiltrotator 163 via a link member.
- a tilt cylinder 309 is a hydraulic cylinder for driving the tilt section 1632 .
- a proximal end portion of the tilt cylinder 309 is attached to the attachment portion 1631 .
- the tip of the rod of the tilt cylinder 309 is attached to the tilt section 1632 .
- the rotary motor 310 is a hydraulic motor for driving the rotating portion 1633 .
- the bracket and stator of rotary motor 310 are fixed to tilt section 1632 .
- the rotary shaft and rotor of the rotary motor 310 are provided so as to extend vertically in the drawing and are fixed to the rotating portion 1633 .
- Work machine 100 includes a plurality of sensors for measuring the attitude, orientation, and position of work machine 100 .
- work machine 100 includes tilt measuring instrument 401 , position and heading measuring instrument 402 , boom angle sensor 403 , arm angle sensor 404 , bucket angle sensor 405 , tilt angle sensor 406 and rotation angle sensor 407 .
- the tilt measuring instrument 401 measures the attitude of the revolving body 140 .
- the tilt measuring device 401 measures the tilt (for example, roll angle, pitch angle and yaw angle) of the revolving superstructure 140 with respect to the horizontal plane.
- An example of the tilt measuring instrument 401 is an IMU (Inertial Measurement Unit).
- the tilt measuring device 401 measures the acceleration and angular velocity of the revolving structure 140, and calculates the tilt of the revolving structure 140 with respect to the horizontal plane based on the measurement results.
- the tilt measuring instrument 401 is installed, for example, below the driver's cab 180 .
- the inclination measuring device 401 outputs the posture data of the revolving structure 140 as measured values to the control device 200 .
- the position and orientation measuring device 402 measures the position of the representative point of the revolving superstructure 140 and the direction in which the revolving superstructure 140 faces by GNSS (Global Navigation Satellite System).
- the position and orientation measuring device 402 includes, for example, two GNSS antennas (not shown) attached to the revolving body 140, and measures an orientation orthogonal to a straight line connecting the positions of the two antennas as the orientation of the work machine 100.
- Position and orientation measuring device 402 outputs position data and orientation data of revolving structure 140 , which are measured values, to control device 200 .
- a boom angle sensor 403 measures the boom angle, which is the angle of the boom 161 with respect to the revolving body 140 .
- Boom angle sensor 403 may be an IMU attached to boom 161 .
- the boom angle sensor 403 measures the boom angle based on the tilt of the boom 161 with respect to the horizontal plane and the tilt of the revolving body measured by the tilt measuring device 401 .
- the measured value of the boom angle sensor 403 indicates zero, for example, when the direction of a straight line passing through the base end and the tip end of the boom 161 coincides with the longitudinal direction of the revolving structure 140 .
- the boom angle sensor 403 according to another embodiment may be a stroke sensor attached to the boom cylinder 306 .
- the boom angle sensor 403 may be a rotation sensor provided on a joint shaft that rotatably connects the revolving body 140 and the boom 161 .
- Boom angle sensor 403 outputs boom angle data, which is a measured value, to control device 200 .
- the arm angle sensor 404 measures the arm angle, which is the angle of the arm 162 with respect to the boom 161.
- Arm angle sensor 404 may be an IMU attached to arm 162 .
- the arm angle sensor 404 measures the arm angle based on the tilt of the arm 162 with respect to the horizontal plane and the boom angle measured by the boom angle sensor 403 .
- the measured value of the arm angle sensor 404 indicates zero when, for example, the direction of the straight line passing through the proximal end and the distal end of the arm 162 matches the direction of the straight line passing through the proximal end and the distal end of the boom 161 .
- the arm angle sensor 404 may calculate the angle by attaching a stroke sensor to the arm cylinder 307 .
- the arm angle sensor 404 may be a rotation sensor provided on a joint shaft that rotatably connects the boom 161 and the arm 162 .
- Arm angle sensor 404 outputs arm angle data, which is a measured value, to control device 200 .
- a bucket angle sensor 405 measures the bucket angle, which is the angle of the tiltrotator 163 with respect to the arm 162 .
- Bucket angle sensor 405 may be a stroke sensor provided on bucket cylinder 308 .
- the bucket angle sensor 405 measures the bucket angle based on the stroke amount of the bucket cylinder 308 .
- the measured value of the bucket angle sensor 405 indicates zero, for example, when the direction of the straight line passing through the proximal end and the cutting edge of the bucket 164 matches the direction of the straight line passing through the proximal end and the distal end of the arm 162 .
- the bucket angle sensor 405 may be a rotation sensor provided on a joint shaft that rotatably connects the arm 162 and the mounting portion 1631 of the tiltrotator 163 .
- Bucket angle sensor 405 may also be an IMU attached to bucket 164 .
- Bucket angle sensor 405 outputs bucket angle data, which is a measured value, to control device 200 .
- the tilt angle sensor 406 measures the tilt angle, which is the angle of the tilt portion 1632 with respect to the mounting portion 1631 of the tilt rotator 163 .
- the tilt angle sensor 406 may be a rotation sensor provided on a joint shaft that rotatably connects the attachment portion 1631 and the tilt portion 1632 .
- the measured value of the tilt angle sensor 406 indicates zero when, for example, the rotation axis of the arm 162 and the rotation axis of the rotating portion 1633 are orthogonal.
- the tilt angle sensor 406 may calculate the angle by attaching a stroke sensor to the tilt cylinder 309 .
- Tilt angle sensor 406 outputs tilt angle data, which is a measured value, to control device 200 .
- the rotation angle sensor 407 measures the rotation angle, which is the angle of the rotation portion 1633 with respect to the tilt portion 1632 of the tiltrotator 163 .
- the rotation angle sensor 407 may be a rotation sensor provided on the rotary motor 310 .
- the measured value of tilt angle sensor 406 indicates zero when, for example, the blade edge direction of bucket 164 and the plane of operation of work implement 160 are perpendicular to each other.
- Rotation angle sensor 407 outputs rotation angle data, which is a measured value, to control device 200 .
- FIG. 4 is a schematic block diagram showing the configuration of the control device 200 according to the first embodiment.
- the control device 200 is a computer that includes a processor 210 , main memory 230 , storage 250 and interface 270 .
- Control device 200 is an example of a control system.
- Control device 200 receives measurements from tilt measuring instrument 401 , position and heading measuring instrument 402 , boom angle sensor 403 , arm angle sensor 404 , bucket angle sensor 405 , tilt angle sensor 406 and rotation angle sensor 407 .
- the storage 250 is a non-temporary tangible storage medium. Examples of the storage 250 include magnetic disks, optical disks, magneto-optical disks, semiconductor memories, and the like.
- the storage 250 may be an internal medium directly connected to the bus of the control device 200, or an external medium connected to the control device 200 via the interface 270 or communication line.
- An operating device 271 and a monitor device 272 are connected to the processor 210 via an interface 270 .
- the storage 250 stores control programs for controlling the work machine 100.
- the control program may be for realizing part of the functions that the control device 200 is caused to exhibit.
- the control program may function in combination with another program already stored in the storage 250 or in combination with another program installed in another device.
- the control device 200 may include a custom LSI (Large Scale Integrated Circuit) such as a PLD (Programmable Logic Device) in addition to or instead of the above configuration.
- PLDs include PAL (Programmable Array Logic), GAL (Generic Array Logic), CPLD (Complex Programmable Logic Device), and FPGA (Field Programmable Gate Array). In this case, part or all of the functions implemented by the processor may be implemented by the integrated circuit.
- the storage 250 records geometry data representing the dimensions and center-of-gravity positions of the revolving structure 140 , the boom 161 , the arm 162 and the bucket 164 .
- Geometry data is data representing the position of an object in a predetermined coordinate system.
- the storage 250 also records design plane data, which is three-dimensional data representing the shape of the design plane of the construction site in the global coordinate system.
- the global coordinate system is a coordinate system composed of the Xg - axis extending in the latitude direction, the Yg - axis extending in the longitude direction, and the Zg - axis extending in the vertical direction.
- the design plane data is represented by TIN (Triangular Irregular Networks) data, for example.
- the processor 210 obtains an operation signal acquisition unit 211, an input unit 212, a display control unit 213, a measurement value acquisition unit 214, a position/orientation calculation unit 215, an intervention determination unit 216, a control signal output unit 218, A target attitude determination unit 219 and a rotation amount calculation unit 220 are provided.
- the operation signal acquisition unit 211 acquires an operation signal indicating the operation amount of each actuator from the operation device 271 .
- the input unit 212 receives operation inputs from the operator through the monitor device 272 .
- the display control unit 213 outputs screen data to be displayed on the monitor device 272 to the monitor device 272 .
- the measured value acquisition unit 214 acquires measured values from the tilt measuring device 401 , the position and heading measuring device 402 , the boom angle sensor 403 , the arm angle sensor 404 , the bucket angle sensor 405 , the tilt angle sensor 406 and the rotation angle sensor 407 .
- the position/orientation calculation unit 215 calculates the position of the work machine 100 in the global coordinate system and the vehicle body coordinate system based on the various measurement values acquired by the measurement value acquisition unit 214 and the geometry data recorded in the storage 250 . For example, the position/posture calculation unit 215 calculates the position of the cutting edge of the bucket 164 in the global coordinate system and the vehicle body coordinate system.
- the vehicle body coordinate system is an orthogonal coordinate system whose origin is a representative point of the revolving body 140 (for example, a point passing through the center of revolving). Calculations by the position/orientation calculation unit 215 will be described later.
- Intervention determination unit 216 determines whether to limit the speed of work implement 160 based on the positional relationship between the position of the cutting edge of bucket 164 calculated by position/orientation calculation unit 215 and the design surface indicated by the design surface data. .
- the restriction of the speed of work implement 160 by control device 200 is also referred to as intervention control.
- intervention determination unit 216 obtains the shortest distance between the design surface and bucket 164 , and determines that work implement 160 should be subjected to intervention control when the shortest distance is equal to or less than a predetermined distance.
- the intervention determination unit 216 rotates and translates the design surface data recorded in the storage 250 based on the measured values of the tilt measuring device 401 and the position/orientation measuring device 402, so that the data in the global coordinate system is Transform the position of the represented design plane into a position in the body coordinate system.
- the intervention determination unit 216 identifies the contour point of the bucket 164 that is closest to the design surface as the control point.
- the intervention determination unit 216 identifies a plane (polygon) located vertically below the control point in the design plane data.
- the intervention determination unit 216 calculates a first design line that is a line of intersection between a plane parallel to the X bk -Z bk plane of the bucket coordinate system passing through the control point and the identified plane.
- the intervention determination unit 216 determines whether or not the distance between the control point and the first design line is equal to or less than the intervention threshold.
- the control signal output unit 218 controls each actuator (the bucket cylinder 308, the tilt cylinder 309, and the rotary motor 310) according to the operation amount acquired by the operation signal acquisition unit 211 or the target value calculated by the rotation amount calculation unit 220.
- a signal is output to the control valve 303 .
- the position/orientation calculation unit 215 calculates the positions of the points of the outer shell based on the various measurement values acquired by the measurement value acquisition unit 214 and the geometry data recorded in the storage 250 .
- Storage 250 records geometry data representing the dimensions of revolving structure 140, boom 161, arm 162, tiltrotator 163 (mounting portion 1631, tilting portion 1632 and rotating portion 1633), and bucket 164.
- the geometry data of the revolving superstructure 140 indicates the center positions (x bm , y bm , z bm ) of the joint axes by which the revolving super structure 140 supports the boom 161 in the vehicle body coordinate system, which is the local coordinate system.
- the vehicle body coordinate system is a coordinate system composed of the X sb axis extending in the front-rear direction, the Y sb axis extending in the left-right direction, and the Z sb axis extending in the up-down direction with reference to the turning center of the turning body 140 .
- the vertical direction of the revolving body 140 does not necessarily match the vertical direction.
- the geometry data of the boom 161 indicates the joint axis positions (x am , y am , z am ) at which the boom 161 supports the arm 162 in the boom coordinate system, which is the local coordinate system.
- the boom coordinate system has an Xbm axis extending in the longitudinal direction, a Ybm axis extending in the direction in which the joint axis extends, and an Xbm axis and a Ybm axis, with reference to the central position of the joint axis connecting the revolving body 140 and the boom 161. is a coordinate system composed of the Zbm axis orthogonal to .
- the geometry data of the arm 162 indicates the positions (x t1 , y t1 , z t1 ) of the joint axes at which the arm 162 supports the mounting portion 1631 of the tiltrotator 163 in the arm coordinate system, which is the local coordinate system.
- the arm coordinate system is based on the center position of the joint axis connecting the boom 161 and the arm 162, the X am axis extending in the longitudinal direction, the Y am axis extending in the direction in which the joint axis extends, and the X am axis and the Yam axis. It is a coordinate system composed of orthogonal Z am axes.
- the geometry data of the mounting portion 1631 of the tiltrotator 163 is the position (x t2 , y t2 , z t2 ) of the joint axis by which the mounting portion 1631 supports the tilt portion 1632 in the first tilt-rotate coordinate system, which is the local coordinate system.
- the tilt of the joint axis ( ⁇ t ) is shown.
- the inclination ⁇ t of the joint axis is an angle related to the design error of the tiltrotator 163 and is obtained by calibration of the tiltrotator 163 or the like.
- the first tilt-rotate coordinate system is based on the central position of the joint axis connecting the arm 162 and the mounting portion 1631, the Yt1 axis extending in the direction in which the joint axis connecting the arm 162 and the mounting portion 1631 extends, and the mounting portion It is a coordinate system composed of the Zt1 axis extending in the direction in which the joint axis connecting 1631 and the tilt part 1632 extends, and the Xt1 axis perpendicular to the Yt1 axis and the Zt1 axis.
- the geometry data of the tilt portion 1632 of the tiltrotator 163 is the tip position (x t3 , y t3 , z t3 ) of the rotary shaft of the rotary motor 310 and the inclination ( ⁇ r ).
- the inclination ⁇ r of the rotation axis is an angle related to the design error of the tiltrotator 163 and is obtained by calibration of the tiltrotator 163 or the like.
- the second tilt-rotate coordinate system is based on the central position of the joint axis connecting the mounting portion 1631 and the tilting portion 1632, and the Xt2 axis extending in the direction in which the joint shaft connecting the mounting portion 1631 and the tilting portion 1632 extends.
- the geometry data of the rotating portion 1633 of the tiltrotator 163 indicates the center position (x t4 , y t4 , z t4 ) of the attachment surface of the bucket 164 in the third tilt-rotate coordinate system, which is the local coordinate system.
- the third tilt-rotate coordinate system is composed of the Z t3- axis extending in the direction in which the rotation axis of the rotary motor 310 extends, and the X t3- axis and the Yt3 - axis orthogonal to the rotation axis, with the center position of the mounting surface of the bucket 164 as a reference. It is a coordinate system that The bucket 164 is attached to the rotating portion 1633 so that the cutting edge is parallel to the Yt3 axis.
- the geometry data of bucket 164 indicates the locations (x bk , y bk , z bk ) of contour points of bucket 164 in the third tilt-rotate coordinate system.
- contour points include the ends and center of the cutting edge of the bucket 164 , the ends and center of the bottom of the bucket 164 , and the ends and center of the butt of the bucket 164 .
- the position/orientation calculation unit 215 converts the boom coordinate system to the vehicle body coordinate system using the following equation (1).
- the boom-body transformation matrix T bm sb is rotated about the Y bm axis by the boom angle ⁇ bm and translated by the deviation (x bm , y bm , z bm ) between the origin of the body coordinate system and the origin of the boom coordinate system. is a matrix that
- the position/orientation calculation unit 215 converts the arm coordinate system into the boom coordinate system using the following equation (2) based on the measurement value of the arm angle ⁇ am acquired by the measurement value acquisition unit 214 and the geometry data of the boom 161. Generate an arm-to-boom transformation matrix T am bm for The arm-boom transformation matrix T am bm is rotated about the Y am axis by the arm angle ⁇ am and translated by the deviation (x am , y am , z am ) between the origin of the boom coordinate system and the origin of the arm coordinate system.
- the position/orientation calculation unit 215 obtains the product of the boom-body transformation matrix T bm sb and the arm-boom transformation matrix T am bm to obtain an arm-body transformation matrix for transforming from the arm coordinate system to the vehicle body coordinate system. Generate T am sb .
- the position/orientation calculation unit 215 calculates arm coordinates from the first tilt-rotate coordinate system using the following equation (3). Generate a first tilt-to-arm transformation matrix T t1 am for transforming to the system.
- the first tilt-arm transformation matrix T t1 am is rotated by the bucket angle ⁇ bk about the Y t1 axis, and the deviation between the origin of the arm coordinate system and the origin of the first tilt-rotate coordinate system (x t1 , y t1 , z t1 ), and further tilts the joint axis of the tilt unit 1632 by the tilt ⁇ t .
- the position/orientation calculation unit 215 obtains the product of the arm-body transformation matrix T am sb and the first tilt-arm transformation matrix T t1 am to obtain a value for transforming from the first tilt-rotate coordinate system to the vehicle body coordinate system. Generate a first tilt-to-body transformation matrix T t1 sb .
- the position/orientation calculation unit 215 calculates the first tilt-rotate coordinate system from the first tilt-rotate coordinate system using the following equation (4).
- a second tilt-first tilt transformation matrix T t2 t1 for transformation to the two-tilt-rotate coordinate system is generated.
- the second tilt-first tilt transformation matrix T t2 t1 is rotated by the tilt angle ⁇ t around the X t2 axis, and the deviation between the origin of the first tilt rotated coordinate system and the origin of the second tilt rotated coordinate system (x t2 , y t2 , z t2 ) and further tilted by the tilt ⁇ r of the rotation axis of the rotating unit 1633 . Further, the position/orientation calculation unit 215 obtains the product of the first tilt-to-vehicle transformation matrix T t1 sb and the second tilt-to-first tilt transformation matrix T t2 t1 , thereby shifting from the second tilt-rotate coordinate system to the vehicle body coordinate system. Generate a second tilt-to-body transformation matrix T t2 sb for transformation.
- the position/orientation calculation unit 215 calculates the second tilt-rotate coordinate system from the second tilt-rotate coordinate system using the following equation (5).
- a third tilt-second tilt transformation matrix T t3 t2 for transformation to the three-tilt-rotate coordinate system is generated.
- the third tilt-second tilt transformation matrix T t3 t2 is rotated by the rotation angle ⁇ r about the Z t3 axis, and the deviation (x t3 , y t3 , z t3 ).
- the position/orientation calculation unit 215 obtains the product of the second tilt-to-vehicle transformation matrix T t2 sb and the third tilt-to-second tilt transformation matrix T t3 t2 , thereby shifting from the third tilt-rotate coordinate system to the vehicle body coordinate system. Generate a third tilt-to-body transformation matrix T t3 sb for transformation.
- the position/orientation calculation unit 215 calculates the center position (x t4 , y t4 , z t4 ) of the mounting surface of the bucket 164 and the positions (x bk , y bk , z bk ) and the third tilt-to-body transformation matrix T bk sb , the positions of contour points of the bucket 164 in the body coordinate system can be determined.
- the angle of the cutting edge of bucket 164 with respect to the ground plane of work machine 100 that is, the angle formed by the X sb -Y sb plane of the vehicle body coordinate system and the Y t3 axis of the third tilt-rotate coordinate system is the boom angle ⁇ bm , the arm It is determined by the angle ⁇ am , bucket angle ⁇ bk , tilt angle ⁇ t and rotate angle ⁇ r . Therefore, as shown in FIG. 1 , the position/orientation calculation unit 215 identifies a bucket coordinate system whose starting point is the base end of the bucket 164 , that is, the central position of the mounting surface of the bucket 164 on the tiltrotator 163 .
- the bucket coordinate system includes an X bk axis that extends in the direction in which the blade edge of bucket 164 faces, a Y bk axis that is orthogonal to the X bk axis and extends along the blade edge of bucket 164, and a Z bk axis that is orthogonal to the X bk axis and the Y bk axis.
- It is a Cartesian coordinate system composed of axes.
- the Xbk axis is also referred to as the bucket tilt axis
- the Ybk axis as the bucket pitch axis
- the Zbk axis as the bucket rotation axis.
- the bucket tilt axis X bk , the bucket pitch axis Y bk and the bucket rotation axis Z bk are virtual axes and are different from the joint axes of the tiltrotator 163 . Note that when the tilt of the rotating shaft of the rotary motor 310 is zero, the bucket coordinate system and the third tilt-rotate coordinate system match.
- the position/orientation calculation unit 215 calculates a bucket-third tilt conversion matrix T bk t3 for converting from the third tilt-rotate coordinate system to the bucket coordinate system using the following equation (6). Generate.
- the bucket-third tilt transformation matrix T bk t3 is a matrix that rotates about the Y t3 axis by the inclination ⁇ r of the rotation axis.
- angle adjustment refers to rotating the bucket 164 around the bucket tilt axis ( Xbk axis) to align the blade edge direction (bucket pitch axis ( Ybk axis)) of the bucket 164 with respect to the vehicle body reference plane. It means the operation to make it a predetermined angle.
- the vehicle body reference plane is an X sb axis-Y sb axis plane (see FIG. 1) in the vehicle body coordinate system.
- the predetermined angle is an angle at which the cutting edge and the vehicle body reference plane are parallel.
- the cutting edge can be made parallel to the vehicle body reference plane without changing the opening direction (bucket tilt axis direction) of the bucket 164 .
- the predetermined angle is not limited to the angle at which the cutting edge and the vehicle body reference plane are parallel, and may be an angle arbitrarily determined by the operator.
- the operation signal acquisition unit 211 acquires an operation signal for a dedicated operation reception unit (hereinafter also referred to as an angle adjustment operation reception unit) for using the angle adjustment function in the operation device 271. do.
- a dedicated operation reception unit hereinafter also referred to as an angle adjustment operation reception unit
- the target attitude determination unit 219 determines a target attitude, which is an attitude obtained by rotating the bucket 164 about the virtual rotation axis from the current attitude by a predetermined amount.
- a virtual rotation axis is a virtual rotation axis that faces the opening direction of the bucket 164 .
- the bucket tilt axis ( Xbk axis, see FIG. 1) in the bucket coordinate system described above is determined as the virtual rotation axis.
- the target posture is a posture in which a reference axis perpendicular to the virtual axis of rotation forms a predetermined angle with respect to a predetermined plane.
- the reference axis is an axis extending along the cutting edge of the bucket 164, and in this embodiment, it is the bucket pitch axis ( Ybk axis, see FIG. 1) in the bucket coordinate system described above.
- the predetermined plane is a vehicle body reference plane.
- the rotation amount calculator 220 calculates the amount of rotation required for each of the plurality of rotating mechanisms to match the current attitude of the bucket 164 with the target attitude.
- the plural rotating mechanisms in this embodiment are the bucket cylinder 308 , the tilt cylinder 309 and the rotary motor 310 .
- the bucket cylinder 308 rotates the bucket 164 about the Yt1 axis.
- the tilt cylinder 309 rotates the bucket 164 around the Xt2 axis.
- the rotary motor 310 rotates the bucket 164 around the Zt3 axis.
- FIG. 5 is a flow chart showing the angle matching function in the first embodiment.
- control device 200 When an operator of work machine 100 starts operating work machine 100, control device 200 performs the following control at predetermined control intervals (for example, 1000 milliseconds).
- the measured value acquiring unit 214 acquires the measured values of the tilt measuring device 401, the position and heading measuring device 402, the boom angle sensor 403, the arm angle sensor 404, the bucket angle sensor 405, the tilt angle sensor 406, and the rotation angle sensor 407. (Step S101).
- the position/posture calculation unit 215 calculates the posture of the bucket in the vehicle body coordinate system based on the measurement values acquired in step S101 (step S102).
- the posture of the bucket in the vehicle body coordinate system is represented by a posture matrix R cur that indicates the direction of each axis (X bk , Y bk , Z bk ) of the bucket coordinate system in the vehicle body coordinate system. All translation components of the attitude matrix R cur representing the attitude of the bucket 164 are set to zero.
- the operation signal acquisition unit 211 acquires an operation signal from the angle adjustment operation reception unit by the operator (step S103).
- the operating device 271 comprises, for example, two levers 2710, 2711 as shown in FIG.
- the operator tilts the two levers 2710 and 2711 in the front-rear direction and the left-right direction to operate the revolving body 140 and adjust the boom angle ⁇ as in a normal work machine.
- bm , arm angle ⁇ am and bucket angle ⁇ bk can be manipulated independently.
- the operator operates the operation reception units (buttons, slide switches, dials, proportional roller switches) provided on the upper surfaces of the levers 2710 and 2711 to change the tilt angle ⁇ t through the tilt rotator 163. and the rotation angle ⁇ r can be individually controlled.
- the operating device 271 has an angle adjustment operation receiving portion 2710b on the lever 2710.
- the angle adjustment operation reception unit 2710b is, for example, a press-type mechanical switch. By pressing the switch, the operator can execute angle adjustment control at a desired timing.
- the processor acquires the signal from the angle adjustment operation reception unit 2710b, it determines that the predetermined control start condition is satisfied, and proceeds to the process of step S104.
- the target posture determination unit 219 determines the bucket tilt axis X bk as the virtual rotation axis, and specifies the target value ⁇ bk_t_tgt of the angular velocity around the bucket tilt axis X bk (step S104).
- the target value ⁇ bk_t_tgt may be a preset fixed value. It should be noted that specifying the target value ⁇ bk_t_tgt of the angular velocity about the bucket tilt axis Xbk is synonymous with determining the target attitude of the bucket 164 that should be after the elapse of the unit time from the current time.
- the rotation amount calculation unit 220 calculates the rotation amount of each of the plurality of rotating mechanisms required to match the current attitude of the bucket 164 with the target attitude.
- a target value is calculated (step S105). Specifically, the rotation amount calculation unit 220 substitutes the angular velocity target value ⁇ bk_t_tgt into the following equation (7) to obtain a rotation matrix R bk_t bk representing rotation about the bucket tilt axis X bk in the bucket coordinate system. create.
- the rotation amount calculation unit 220 calculates the target attitude R tgt of the bucket 164 after a unit time by multiplying the matrix R cur representing the current attitude of the bucket 164 by the rotation matrix R bk_p bk of Equation (7). . Based on the current attitude R cur of the bucket 164 and the target attitude R tgt of the bucket 164 after the unit time, the rotation amount calculation unit 220 calculates the bucket angle using the following equations (8), (9), and (10). Target values ( ⁇ bk_tgt , ⁇ t_tgt , ⁇ r_tgt ) of ⁇ bk , tilt angle ⁇ t , and rotation angle ⁇ r are obtained.
- the target angular velocity ( ⁇ bk_t_tgt ) about one virtual rotation axis (bucket tilt axis) is converted to the target angular velocity ( ⁇ bk_tgt , ⁇ t_tgt , ⁇ r_tgt ).
- control signal output unit 218 outputs each actuator ( bucket cylinder 308 , tilt A control signal for the cylinder 309 and the rotary motor 310) is generated, and a control signal for each actuator is output to the control valve 303 (step S106).
- the attitude of the bucket 164 actually changes when the control signal output unit 218 outputs control signals for the respective actuators to the control valve 303 .
- the target attitude determination unit 219 acquires the changed current attitude R cur and determines whether or not the bucket pitch axis is parallel to the vehicle body reference plane (step S107). If the bucket pitch axis (Y bk axis) is not parallel to the vehicle body reference plane (step S107; NO), the process returns to step S104 , and the angular velocity target value ( ⁇ bk_t_tgt ). As a result, the process of step S105 by the rotation amount calculation unit 220 and the process of step S106 by the control signal output unit 218 are executed again.
- step S107 when the bucket pitch axis ( Ybk axis) becomes parallel to the vehicle body reference plane (step S107; YES), the target attitude determination unit 219, the rotation amount calculation unit 220, and the control signal output unit 218 terminate the processing. . This completes the automatic angle adjustment control by the control device 200 .
- FIG. 7 and 8 show working machine 100 viewed from the same angle.
- excavation is performed in a state in which the blade edge direction of the bucket 164 (bucket pitch axis (Y bk axis)) is inclined with respect to the vehicle body reference plane (X sb -Y sb plane). It shows the state immediately after The operator of work machine 100 loads the dump truck from this state.
- the operator operates boom 161 and arm 162 to lift bucket 164 upward in order to load the scooped soil onto the dump truck.
- the operator presses down the operation receiving portion 2710b (see FIG. 6) while operating the boom 161 and the arm 162 via the levers 2710 and 2711.
- FIG. 6 the bucket 164 automatically rotates about the bucket tilt axis ( Xbk axis), and the bucket pitch axis ( Ybk axis) is controlled to be parallel to the vehicle body reference plane.
- FIG. 8 shows the state immediately after the automatic angle adjustment control is completed.
- the blade edge direction of the bucket 164 (bucket pitch axis ( Ybk axis)) is parallel to the vehicle body reference plane.
- the opening direction of the bucket 164 (bucket tilt axis ( Xbk axis)) has not changed. Therefore, when the bucket 164 is returned to the excavation surface again after the earth is discharged to the dump truck, the state in which the opening surface is aligned with the excavation surface is maintained.
- the work machine 100 including the work machine 160 in which the plurality of rotating mechanisms (the bucket cylinder 308, the tilt cylinder 309, and the rotary motor 310) and the bucket 164 are connected , the operation for making the direction of the cutting edge of the bucket 164 parallel to the vehicle body reference plane can be simplified.
- the condition for starting control of the angle adjustment function was the operator's operation (button depression).
- the control device 200 according to the modified example of the first embodiment may have the following functions.
- the target attitude determination unit 219 starts the process of determining the target attitude when the bucket 164 is separated from the ground by a predetermined distance as a control start condition for the angle adjustment function.
- the function of the intervention determination unit 216 described above can be used to determine whether the bucket 164 has left the ground by a predetermined distance. That is, the target attitude determination unit 219 constantly obtains the shortest distance between the position of the cutting edge of the bucket 164 and the design surface via the intervention determination unit 216 . Then, the target attitude determination unit 219 satisfies a predetermined control start condition when the shortest distance calculated momentarily becomes equal to or greater than a predetermined determination threshold value while the scooped bucket 164 is ascending. Then, the process of step S104 is started.
- control device 200 may be configured by a single computer, or the configuration of the control device 200 may be divided into a plurality of computers, and the plurality of computers may cooperate with each other. may function as the control device 200. At this time, some of the computers constituting control device 200 may be mounted inside the work machine, and other computers may be provided outside the work machine.
- the operation device 271 and the monitor device 272 are provided remotely from the work machine 100, and the configuration other than the measurement value acquisition unit 214 and the control signal output unit 218 of the control device 200 is provided in a remote server. may be
- the work machine 100 according to the above-described embodiment is a hydraulic excavator, it is not limited to this.
- the work machine 100 according to another embodiment may be a work machine fixed on the ground and not self-propelled.
- the working machine 100 according to another embodiment may be a working machine that does not have a revolving body.
- Work machine 100 includes bucket 164 as an attachment for work machine 160, but is not limited to this.
- work machine 100 may include a breaker, a fork, a grapple, etc. as attachments.
- the control device 200 has the X bk axis extending in the direction in which the blade edge of the attachment faces, the Y bk axis extending in the direction along the blade edge, and the Z bk axis orthogonal to the X bk axis and the Y bk axis.
- the tilt rotator 163 is controlled by a local coordinate system consisting of .
- the axes of the tiltrotator 163 do not have to be orthogonal as long as they intersect on different planes.
- the axis AX1 related to the joint shaft connecting the arm 162 and the mounting portion 1631 the axis AX2 related to the joint shaft connecting the mounting portion 1631 and the tilt portion 1632, and the rotation axis AX3 of the rotary motor 310.
- a plane parallel to the axes AX1 and AX2 a plane parallel to the axes AX2 and AX3, and a plane parallel to the axes AX3 and AX1 are:
- Each may be different.
- control device 200 may not have a design setting function.
- control device 200 can automatically control the tiltrotator 163 by performing bucket attitude retention control. For example, the operator can carry out simple leveling work without setting a design surface.
- the operation of aligning the second reference direction of the work implement with the predetermined plane without changing the first reference direction of the work implement. can be simplified.
- Control device 210 ... processor 211 ... operation signal acquisition section 212 ... input section 213 ... display control section 214 ... measurement value acquisition section 215 ... position and orientation calculation section 216 ... intervention determination section 218 ... control signal output section 219 ... target orientation determination section 220 ...
- Rotation angle sensor 230 Main memory 250 Storage 270 Interface 271 Operating device 272 Monitoring device 301
- Control valve 304 Traveling motor 305 Swing motor 306
- Boom cylinder 307 Arm cylinder 308 Bucket Cylinder 309... Tilt cylinder 310...
- Rotary motor 401 Inclination measuring instrument 402... Position and heading measuring instrument 403...
- Boom angle sensor 404 Arm angle sensor 405... Bucket angle sensor 406... Tilt angle sensor 407... Rotation angle sensor
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)
- Shovels (AREA)
Abstract
Description
本願は、2021年9月30日に日本に出願された特願2021-161174号について優先権を主張し、その内容をここに援用する。
《作業機械の構成》
以下、図面を参照しながら実施形態について詳しく説明する。
図1は、第1の実施形態に係る作業機械100の構成を示す概略図である。第1の実施形態に係る作業機械100は、例えば油圧ショベルである。作業機械100は、走行体120、旋回体140、作業機160、運転室180、制御装置200を備える。第1の実施形態に係る作業機械100は、バケット164の刃先が設計面を越えないように制御する。
旋回体140は、走行体120に旋回中心回りに旋回可能に支持される。
作業機160は、旋回体140に動作可能に支持される。作業機160は、油圧により駆動する。作業機160は、ブーム161、アーム162、チルトローテータ163、および作業器具であるバケット164を備える。ブーム161の基端部は、旋回体140に回動可能に取り付けられる。アーム162の基端部は、ブーム161の先端部に回動可能に取り付けられる。チルトローテータ163は、アーム162の先端部に回動可能に取り付けられる。バケット164は、チルトローテータ163に取り付けられる。バケット164は、チルトローテータ163を介して作業機160に対して互いに異なる平面で交差する3つの軸回りに回転可能に支持される。ここで、旋回体140のうち作業機160が取り付けられる部分を前部という。また、旋回体140について、前部を基準に、反対側の部分を後部、左側の部分を左部、右側の部分を右部という。
図3は、第1の実施形態に係る作業機械100の駆動系を示す図である。
作業機械100は、作業機械100を駆動するための複数のアクチュエータを備える。具体的には、作業機械100は、エンジン301、油圧ポンプ302、コントロールバルブ303、一対の走行モータ304、旋回モータ305、ブームシリンダ306、アームシリンダ307、バケットシリンダ308、チルトシリンダ309、回転モータ310を備える。
油圧ポンプ302は、エンジン301により駆動され、コントロールバルブ303を介して走行モータ304、旋回モータ305、ブームシリンダ306、アームシリンダ307およびバケットシリンダ308に作動油を供給する。
コントロールバルブ303は、油圧ポンプ302から走行モータ304、旋回モータ305、ブームシリンダ306、アームシリンダ307およびバケットシリンダ308へ供給される作動油の流量を制御する。
走行モータ304は、油圧ポンプ302から供給される作動油によって駆動され、走行体120を駆動する。
旋回モータ305は、油圧ポンプ302から供給される作動油によって駆動され、走行体120に対して旋回体140を旋回させる。
アームシリンダ307は、アーム162を駆動するための油圧シリンダである。アームシリンダ307の基端部は、ブーム161に取り付けられる。アームシリンダ307の先端部は、アーム162に取り付けられる。
バケットシリンダ308は、チルトローテータ163およびバケット164を駆動するための油圧シリンダである。バケットシリンダ308の基端部は、アーム162に取り付けられる。バケットシリンダ308の先端部は、リンク部材を介してチルトローテータ163に取り付けられる。
回転モータ310は、回転部1633を駆動するための油圧モータである。回転モータ310のブラケットおよび固定子は、チルト部1632に固定される。回転モータ310の回転軸および回転子は、図示上下方向に伸びるように設けられ、回転部1633に固定される。
作業機械100は、作業機械100の姿勢、方位および位置を計測するための複数のセンサを備える。具体的には、作業機械100は、傾斜計測器401、位置方位計測器402、ブーム角センサ403、アーム角センサ404、バケット角センサ405、チルト角センサ406、回転角センサ407を備える。
図4は、第1の実施形態に係る制御装置200の構成を示す概略ブロック図である。
制御装置200は、プロセッサ210、メインメモリ230、ストレージ250、インタフェース270を備えるコンピュータである。制御装置200は、制御システムの一例である。制御装置200は、傾斜計測器401、位置方位計測器402、ブーム角センサ403、アーム角センサ404、バケット角センサ405、チルト角センサ406および回転角センサ407から計測値を受信する。
プロセッサ210は、制御プログラムを実行することで、操作信号取得部211、入力部212、表示制御部213、計測値取得部214、位置姿勢算出部215、介入判定部216、制御信号出力部218、目標姿勢決定部219および回転量算出部220を備える。
入力部212は、モニタ装置272からオペレータによる操作入力を受け付ける。
表示制御部213は、モニタ装置272に表示させる画面データをモニタ装置272へ出力する。
計測値取得部214は、傾斜計測器401、位置方位計測器402、ブーム角センサ403、アーム角センサ404、バケット角センサ405、チルト角センサ406および回転角センサ407から計測値を取得する。
ここで、位置姿勢算出部215による作業機械100の外殻の点の位置の算出方法を説明する。位置姿勢算出部215は、計測値取得部214が取得した各種計測値とストレージ250に記録されたジオメトリデータとに基づいて外殻の点の位置を算出する。ストレージ250には、旋回体140、ブーム161、アーム162、チルトローテータ163(取付部1631、チルト部1632および回転部1633)およびバケット164の寸法を表すジオメトリデータが記録される。
以下、図面を参照しながら、本実施形態に係る角度合わせ機能について詳しく説明する。ここで、「角度合わせ」とは、バケットチルト軸(Xbk軸)回りにバケット164を回動させて、当該バケット164の刃先方向(バケットピッチ軸(Ybk軸))を車体基準面に対して所定の角度にする操作を意味する。車体基準面とは、車体座標系におけるXsb軸-Ysb軸平面(図1参照)である。本実施形態において、所定の角度とは、刃先と車体基準面とが平行となる角度である。この操作により、バケット164の開口方向(バケットチルト軸方向)を変化させることなく刃先を車体基準面と平行にすることができる。なお、所定の角度は、刃先と車体基準面とが平行となる角度に限らず、オペレータによって任意に決められた角度であってもよい。
具体的には、回転量算出部220は、下記式(7)に角速度の目標値θbk_t_tgtを代入することで、バケット座標系におけるバケットチルト軸Xbk回りの回転を表す回転行列Rbk_t bkを作成する。
バケットピッチ軸(Ybk軸)が車体基準面と平行になっていない場合(ステップS107;NO)、ステップS104に戻り、再度、バケットチルト軸(Xbk軸)回りの角速度の目標値(θbk_t_tgt)を特定する。これにより、回転量算出部220によるステップS105の処理、および、制御信号出力部218によるステップS106の処理が再度実行される。
一方、バケットピッチ軸(Ybk軸)が車体基準面と平行になった場合(ステップS107;YES)、目標姿勢決定部219、回転量算出部220および制御信号出力部218は、処理を終了する。これにより、制御装置200による自動の角度合わせ制御が完了する。
次に、図7、図8を参照しながら、角度合わせ機能の作用効果について説明する。
図7、図8は、作業機械100を同じ角度から見た様子を示している。
ここで、図7は、バケット164の刃先方向(バケットピッチ軸(Ybk軸))が車体基準面(Xsb-Ysb平面)に対して傾斜している状態で掘削(すくい込み)を行った直後の状態を示している。作業機械100のオペレータは、この状態からダンプトラックへの積み込みを行う。
上述した第1の実施形態では、オペレータが操作受付部2710bを押下することで、所望のタイミングで角度合わせ制御を開始することができるものとして説明した。つまり、第1の実施形態では、角度合わせ機能の制御開始条件が、オペレータによる操作(ボタンの押下)であった。しかし、他の実施形態においてはこの態様に限定されない。例えば、第1の実施形態の変形例に係る制御装置200は、以下のような機能を有していてもよい。
以上、図面を参照して一実施形態について詳しく説明してきたが、具体的な構成は上述のものに限られることはなく、様々な設計変更等をすることが可能である。すなわち、他の実施形態においては、上述の処理の順序が適宜変更されてもよい。また、一部の処理が並列に実行されてもよい。
上述した実施形態に係る制御装置200は、単独のコンピュータによって構成されるものであってもよいし、制御装置200の構成を複数のコンピュータに分けて配置し、複数のコンピュータが互いに協働することで制御装置200として機能するものであってもよい。このとき、制御装置200を構成する一部のコンピュータが作業機械の内部に搭載され、他のコンピュータが作業機械の外部に設けられてもよい。例えば、他の実施形態においては操作装置271およびモニタ装置272が作業機械100から遠隔に設けられ、制御装置200のうち計測値取得部214および制御信号出力部218以外の構成が遠隔のサーバに設けられてもよい。
Claims (8)
- 車体に動作可能に支持された作業機と、前記作業機の先端に取り付けられたチルトローテータと、前記チルトローテータを介して前記作業機に対して互いに異なる平面で交差する3つの軸回りに回転可能に支持された作業器具とを備える作業機械を制御するためのシステムであって、
プロセッサを備え、
前記プロセッサは、
複数のセンサから計測値を取得し、
前記計測値に基づいて、前記作業器具の現在の姿勢を算出し、
所定の制御開始条件を満たした場合に、算出した前記作業器具の前記現在の姿勢に基づいて、仮想回転軸を決定し、
前記作業器具を、前記現在の姿勢から目標姿勢となるように前記仮想回転軸回りに所定量だけ回転させるための前記チルトローテータの制御信号を生成し、
生成した前記制御信号を出力する、
システム。 - 前記作業器具は刃先を有し、
前記仮想回転軸は、前記作業器具の前記刃先が向く方向に伸びる軸である、
請求項1に記載のシステム。 - 前記プロセッサは、
前記仮想回転軸に直交し、かつ、前記作業器具の刃先に沿って伸びる基準軸を決定し、
前記基準軸と車体基準面とが平行となる姿勢を前記目標姿勢とする、
請求項2に記載のシステム。 - 前記プロセッサは、
オペレータによる所定の操作信号を取得し、
前記制御開始条件として、前記所定の操作信号を受け付けた場合に、前記作業器具の前記現在の姿勢が前記目標姿勢となるように前記仮想回転軸回りに所定量だけ回転させるための前記チルトローテータの制御信号を生成する、
請求項1から請求項3のいずれか一項に記載のシステム。 - 前記プロセッサは、前記制御開始条件として、前記作業器具が地面から所定の距離だけ離れた場合に、前記目標姿勢を決定する、
請求項1または請求項4のいずれか一項に記載のシステム。 - 前記仮想回転軸は、前記チルトローテータの関節軸とは異なる、
請求項1から請求項5のいずれか一項に記載のシステム。 - 車体に動作可能に支持された作業機と、前記作業機の先端に取り付けられたチルトローテータと、前記チルトローテータを介して前記作業機に対して互いに異なる平面で交差する3つの軸回りに回転可能に支持された作業器具とを備える作業機械を制御するための方法であって、
複数のセンサから計測値を取得するステップと、
前記計測値に基づいて、前記作業器具の現在の姿勢を算出するステップと、
所定の制御開始条件を満たした場合に、算出した前記作業器具の前記現在の姿勢に基づいて、仮想回転軸を決定するステップと、
前記作業器具を、前記現在の姿勢から目標姿勢となるように前記仮想回転軸回りに所定量だけ回転させるための前記チルトローテータの制御信号を生成するステップと、
生成した前記制御信号を出力するステップと、
を備える方法。 - 車体に動作可能に支持された作業機と、前記作業機の先端に取り付けられたチルトローテータと、前記チルトローテータを介して前記作業機に対して互いに異なる平面で交差する3つの軸回りに回転可能に支持された作業器具とを備える作業機械の制御システムのコンピュータに、
複数のセンサから計測値を取得するステップと、
前記計測値に基づいて、前記作業器具の現在の姿勢を算出するステップと、
所定の制御開始条件を満たした場合に、算出した前記作業器具の前記現在の姿勢に基づいて、仮想回転軸を決定するステップと、
前記作業器具を、前記現在の姿勢から目標姿勢となるように前記仮想回転軸回りに所定量だけ回転させるための前記チルトローテータの制御信号を生成するステップと、
生成した前記制御信号を出力するステップと、
を実行させるプログラム。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202280056295.7A CN117836487A (zh) | 2021-09-30 | 2022-09-29 | 用于控制作业机械的系统、方法以及程序 |
DE112022003054.2T DE112022003054T5 (de) | 2021-09-30 | 2022-09-29 | System, Verfahren und Programm zur Steuerung einer Arbeitsmaschine |
KR1020247004822A KR20240029558A (ko) | 2021-09-30 | 2022-09-29 | 작업 기계를 제어하기 위한 시스템, 방법 및 프로그램 |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021-161174 | 2021-09-30 | ||
JP2021161174A JP2023050846A (ja) | 2021-09-30 | 2021-09-30 | 作業機械を制御するためのシステム、方法およびプログラム |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2023054615A1 true WO2023054615A1 (ja) | 2023-04-06 |
Family
ID=85782946
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2022/036525 WO2023054615A1 (ja) | 2021-09-30 | 2022-09-29 | 作業機械を制御するためのシステム、方法およびプログラム |
Country Status (5)
Country | Link |
---|---|
JP (1) | JP2023050846A (ja) |
KR (1) | KR20240029558A (ja) |
CN (1) | CN117836487A (ja) |
DE (1) | DE112022003054T5 (ja) |
WO (1) | WO2023054615A1 (ja) |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2020122380A (ja) * | 2019-01-31 | 2020-08-13 | 株式会社小松製作所 | 建設機械の制御システム、及び建設機械の制御方法 |
JP2020125598A (ja) * | 2019-02-01 | 2020-08-20 | 株式会社小松製作所 | 建設機械の制御システム、建設機械、及び建設機械の制御方法 |
JP2020125599A (ja) * | 2019-02-01 | 2020-08-20 | 株式会社小松製作所 | 建設機械の制御システム、建設機械、及び建設機械の制御方法 |
-
2021
- 2021-09-30 JP JP2021161174A patent/JP2023050846A/ja active Pending
-
2022
- 2022-09-29 WO PCT/JP2022/036525 patent/WO2023054615A1/ja active Application Filing
- 2022-09-29 DE DE112022003054.2T patent/DE112022003054T5/de active Pending
- 2022-09-29 CN CN202280056295.7A patent/CN117836487A/zh active Pending
- 2022-09-29 KR KR1020247004822A patent/KR20240029558A/ko unknown
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2020122380A (ja) * | 2019-01-31 | 2020-08-13 | 株式会社小松製作所 | 建設機械の制御システム、及び建設機械の制御方法 |
JP2020125598A (ja) * | 2019-02-01 | 2020-08-20 | 株式会社小松製作所 | 建設機械の制御システム、建設機械、及び建設機械の制御方法 |
JP2020125599A (ja) * | 2019-02-01 | 2020-08-20 | 株式会社小松製作所 | 建設機械の制御システム、建設機械、及び建設機械の制御方法 |
Also Published As
Publication number | Publication date |
---|---|
JP2023050846A (ja) | 2023-04-11 |
DE112022003054T5 (de) | 2024-05-08 |
KR20240029558A (ko) | 2024-03-05 |
CN117836487A (zh) | 2024-04-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR101759409B1 (ko) | 작업차량 및 작업차량의 제어 방법 | |
JP7197392B2 (ja) | 建設機械の制御システム、建設機械、及び建設機械の制御方法 | |
US20220403617A1 (en) | Work machine control system, work machine, and work machine control method | |
JP2020117982A (ja) | 作業機械 | |
KR102479701B1 (ko) | 작업 기계 | |
JP7283910B2 (ja) | 建設機械の制御システム、建設機械、及び建設機械の制御方法 | |
JP7336853B2 (ja) | 建設機械の制御システム、建設機械、及び建設機械の制御方法 | |
WO2023054615A1 (ja) | 作業機械を制御するためのシステム、方法およびプログラム | |
WO2023054623A1 (ja) | 作業機械を制御するためのシステム、方法およびプログラム | |
WO2023054603A1 (ja) | 作業機械を制御するためのシステムおよび方法 | |
WO2023054608A1 (ja) | 作業機械を制御するためのシステムおよび方法 | |
WO2023054610A1 (ja) | 作業機械を制御するためのシステムおよび方法 | |
WO2023032949A1 (ja) | 制御システム、制御方法および制御プログラム | |
WO2023032970A1 (ja) | 制御システム、制御方法および制御プログラム | |
JP7396875B2 (ja) | 作業機械の制御システム、作業機械、および作業機械の制御方法 | |
JP2022026596A (ja) | 作業機械および施工支援システム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 22876478 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 20247004822 Country of ref document: KR Kind code of ref document: A |
|
WWE | Wipo information: entry into national phase |
Ref document number: 1020247004822 Country of ref document: KR |
|
WWE | Wipo information: entry into national phase |
Ref document number: 112022003054 Country of ref document: DE |
|
WWE | Wipo information: entry into national phase |
Ref document number: 202280056295.7 Country of ref document: CN |