WO2015167022A1 - 作業機械の制御システム及び作業機械 - Google Patents
作業機械の制御システム及び作業機械 Download PDFInfo
- Publication number
- WO2015167022A1 WO2015167022A1 PCT/JP2015/065637 JP2015065637W WO2015167022A1 WO 2015167022 A1 WO2015167022 A1 WO 2015167022A1 JP 2015065637 W JP2015065637 W JP 2015065637W WO 2015167022 A1 WO2015167022 A1 WO 2015167022A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- work machine
- mode
- position information
- detection device
- positioning
- Prior art date
Links
Images
Classifications
-
- 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/267—Diagnosing or detecting failure of vehicles
-
- 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/08—Superstructures; Supports for superstructures
- E02F9/10—Supports for movable superstructures mounted on travelling or walking gears or on other superstructures
- E02F9/12—Slewing or traversing gears
- E02F9/121—Turntables, i.e. structure rotatable about 360°
- E02F9/123—Drives or control devices specially adapted therefor
-
- 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/2025—Particular purposes of control systems not otherwise provided for
-
- 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
- E02F9/2278—Hydraulic circuits
- E02F9/2292—Systems with two or more pumps
-
- 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
- E02F9/2278—Hydraulic circuits
- E02F9/2296—Systems with a variable displacement pump
-
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/14—Receivers specially adapted for specific applications
Definitions
- the present invention relates to a work machine control system and a work machine used in a work machine provided with a work machine.
- Patent Document 1 describes a technique for accurately measuring the position of a monitor point even when the measurement accuracy of the three-dimensional position of the work machine changes.
- information on the position of the work machine detected by the machine may be used to display a work guidance screen on a display device installed in the cab of the work machine. Some control the operation of the work machine. Construction by such a work machine is called information construction, but it is preferable that the work machine has a function of backing up the positioning when the position of itself cannot be determined for some reason, and the function of backing up the positioning. If there is, information-oriented construction can be continued accurately.
- Patent Document 1 corrects the position calculation of the monitor point based on the yaw angle measured by the yaw angle measurement means when the measurement accuracy by the three-dimensional position measurement means decreases.
- a correct yaw angle value cannot be obtained due to malfunction or communication failure of the yaw angle measurement means, or if the work machine runs, even if correction is performed based on the measurement value of the yaw angle measurement means, the calculation is performed.
- the position obtained by correcting the result may be different from the actual position.
- the position where the calculation result is corrected differs from the actual position, if the operation of the work machine is controlled based on the corrected position, the work machine may not be accurately controlled.
- Patent Document 1 uses the origin of the coordinate system of the hydraulic excavator as the intersection of the turning center and the turning base frame. Furthermore, in the technique described in Patent Document 1, when the GPS is not normal, the accuracy of both GPS antennas fluctuates with respect to changes in at least one of the roll angle and the pitch angle. 1 has neither description nor suggestion. For this reason, in the technique described in Patent Document 1, when the GPS is not normal, the work implement may not be accurately controlled.
- the present invention relates to a work machine that performs informationized construction based on the result of positioning the position of the work machine, accurately and continuously controlling the work machine when the informationized construction is being performed, and a work guidance screen It is an object of the present invention to provide a work machine control system and a work machine that can realize at least one of displaying appropriate information on the work machine.
- the present invention is a system for controlling a work machine having a work implement having a work tool and a traveling device, the position detection device detecting the position of the work machine, and detecting operation information indicating the operation of the work machine.
- a work machine control system comprising: an information generation unit; and a target value generation unit for determining a position of the work implement based on the position information obtained from the position information generation unit.
- the position information generation unit is configured to perform the third mode. It is preferable to operate with.
- the work machine is provided with a turning body to which the work machine is attached and which is attached to the traveling device and mounted on the traveling device to turn, and the specific point has an abnormal positioning by the position detecting device.
- the position information generation unit further detects the position during operation in the second mode, and is an intersection of a rotation center axis of the revolving structure and a surface corresponding to a surface on which the traveling device contacts the ground. It is preferable to operate in the first mode when positioning by the apparatus is normal, and in the third mode on condition that the work machine travels while operating in the second mode.
- the position information generation unit may be replaced with the third mode on condition that there is an abnormality related to at least one of a device that detects the operation of the work machine and a device that obtains the position of the work machine. It is preferable to operate.
- the present invention relates to a system for controlling a working machine having a traveling device, a working machine having a working tool, and a revolving body mounted on the traveling device and swivel mounted on the traveling device.
- a position detection device that detects the position of the work machine
- a state detection device that detects the operation of the work machine, detects operation information indicating the detected operation, and information on the position detected by the position detection device.
- Both the first mode to be output as position information related to the position, the specific point serving as a reference of the work machine before the positioning by the position detection device becomes abnormal, and the operation information detected by the state detection device Operating in any one of a second mode for outputting the position information obtained using the position information as the position information and a third mode for not outputting the position information,
- the positioning by the position detection device becomes normal during the operation in the mode 2
- the first mode is used, and the work machine is in a non-static state during the operation in the second mode.
- a position information generation unit that operates in the third mode, and a target value generation unit that obtains the position of the work implement based on the position information obtained from the position information generation unit. is there.
- the position information generation unit When the positioning by the position detection device is normal during the turning of the revolving structure and during the operation in the second mode, the position information generation unit at least until the revolving of the revolving structure is completed. It is preferable to continue the operation in the mode.
- the position information generation unit has an abnormality related to at least one of a device for detecting the operation of the work machine and a device for determining the position of the work machine during operation in the second mode instead of the condition.
- a condition it is preferable to operate in the third mode.
- the position information generation unit operates in the third mode on condition that the time in which the operation has been performed in the second mode exceeds a threshold value instead of the condition.
- the position information generation unit does not output the position of the work machine on condition that the turning body turns more than a specific angle in the same direction during operation in the second mode instead of the condition. Is preferred.
- the present invention relates to a system for controlling a working machine having a traveling device, a working machine having a working tool, and a revolving body mounted on the traveling device and swivel mounted on the traveling device.
- a position detection device that detects the position of the work machine
- a state detection device that detects the operation of the work machine, detects operation information indicating the detected operation, and information on the position detected by the position detection device.
- the position information obtained by using both the specific point that is an intersection with the surface corresponding to the surface to be grounded and the operation information detected by the state detection device is output as the position information.
- Position information that operates by selecting one of the second mode and the third mode that does not output the position information by using the state of positioning by the position detection device and the state of the work machine A work machine control system comprising: a generation unit; and a target value generation unit that obtains a position of the work implement based on the position information obtained from the position information generation unit.
- the position information generation unit operates in the first mode when the work machine is in a stationary state and the positioning by the position detection device is normal, obtains the specific point, and the work machine is non-static. It is preferable to operate in the second mode using the specific point when a fixed state or positioning by the position detection device becomes abnormal.
- the position information generation unit is in a state where the operating device for operating the revolving body is ON, or the operating device for operating the traveling device is ON, or the speed at which the revolving body rotates is greater than or equal to a threshold value. Is determined to be in the non-static state, the operating device for operating the revolving structure is OFF, the operating device for operating the traveling device is OFF, and the turning When the state in which the speed at which the body turns is less than the threshold value continues for the second time, it is preferable to determine that the body is in the static state.
- the present invention is a work machine including the above-described work machine control system.
- the present invention relates to a work machine that performs informationized construction based on the result of positioning the position of the work machine, accurately and continuously controlling the work machine when the informationized construction is being performed, and a work guidance screen It is possible to provide a work machine control system and a work machine that can realize at least one of displaying appropriate information on the work machine.
- FIG. 1 is a perspective view of a work machine according to an embodiment.
- FIG. 2 is a block diagram showing the configuration of the hydraulic excavator control system and the hydraulic system.
- FIG. 3 is a side view of the excavator.
- FIG. 4 is a rear view of the excavator.
- FIG. 5 is a control block diagram of the control system according to the embodiment.
- FIG. 6 is a plan view showing the posture of the excavator.
- FIG. 7 is a plan view showing the posture of the excavator.
- FIG. 8 is a flowchart illustrating an example of processing in which the control system according to the embodiment generates position information.
- FIG. 9 is a diagram illustrating transition of modes in which the sensor controller operates.
- FIG. 10 is a diagram for explaining a condition for transition to the third mode.
- FIG. 11 is a diagram for explaining a condition for transition to the third mode.
- FIG. 12 is a timing chart of processing executed by the sensor controller when the upper-
- FIG. 1 is a perspective view of a work machine according to an embodiment.
- FIG. 2 is a block diagram illustrating configurations of the control system 200 and the hydraulic system 300 of the excavator 100.
- a hydraulic excavator 100 as a work machine has a vehicle main body 1 and a work implement 2 as main bodies.
- the vehicle main body 1 includes an upper swing body 3 that is a swing body and a traveling device 5 that is a traveling body.
- the upper swing body 3 accommodates devices such as an engine and a hydraulic pump, which are power generation devices, in the engine room 3EG.
- the excavator 100 uses an internal combustion engine such as a diesel engine as an engine that is a power generation device, but the power generation device is not limited to the internal combustion engine.
- the power generation device of the hydraulic excavator 100 may be, for example, a so-called hybrid device in which an internal combustion engine, a generator motor, and a power storage device are combined. Further, the power generation device of the hydraulic excavator 100 may not be an internal combustion engine, and may be a device that combines a power storage device and a generator motor.
- the upper swing body 3 has a cab 4.
- the cab 4 is installed on the other end side of the upper swing body 3. That is, the cab 4 is installed on the side opposite to the side where the machine room 3EG is disposed.
- a display unit 29 and an operation device 25 shown in FIG. 2 are arranged in the cab 4, a display unit 29 and an operation device 25 shown in FIG. 2 are arranged.
- a handrail 9 is attached above the upper swing body 3.
- the upper swing body 3 is mounted on the traveling device 5.
- the traveling device 5 has crawler belts 5a and 5b.
- the traveling device 5 is driven by one or both of hydraulic motors 5c provided on the left and right.
- the crawler belts 5a and 5b of the traveling device 5 rotate, the excavator 100 is caused to travel.
- the work machine 2 is attached to the side of the cab 4 of the upper swing body 3.
- the hydraulic excavator 100 may include a tire instead of the crawler belts 5a and 5b, and a traveling device that can travel by transmitting the driving force of the engine to the tire via the transmission.
- An example of the hydraulic excavator 100 having such a configuration is a wheel-type hydraulic excavator.
- the upper revolving unit 3 is on the front side where the working machine 2 and the operator cab 4 are arranged, and is on the side where the machine room 3EG is arranged.
- the front-rear direction of the upper swing body 3 is the x direction.
- the left side toward the front is the left of the upper swing body 3, and the right side toward the front is the right of the upper swing body 3.
- the left-right direction of the upper swing body 3 is also referred to as the width direction or the y direction.
- the excavator 100 or the vehicle body 1 has the traveling device 5 side on the lower side with respect to the upper swing body 3 and the upper swing body 3 side on the basis of the traveling device 5.
- the vertical direction of the upper swing body 3 is the z direction.
- the work machine 2 includes a boom 6, an arm 7, a bucket 8 as a work tool, a boom cylinder 10, an arm cylinder 11, and a bucket cylinder 12.
- a base end portion of the boom 6 is rotatably attached to a front portion of the vehicle main body 1 via a boom pin 13.
- a base end portion of the arm 7 is rotatably attached to a tip end portion of the boom 6 via an arm pin 14.
- a bucket 8 is attached to the tip of the arm 7 via a bucket pin 15.
- the bucket 8 rotates around the bucket pin 15.
- the bucket 8 has a plurality of blades 8 ⁇ / b> B attached to the side opposite to the bucket pin 15.
- the blade tip 8T is the tip of the blade 8B.
- the bucket 8 may not have a plurality of blades 8B. That is, it may be a bucket that does not have the blade 8B as shown in FIG. 1 and whose blade edge is formed in a straight shape by a steel plate.
- the work machine 2 may include, for example, a tilt bucket having a single blade.
- a tilt bucket is provided with a bucket tilt cylinder, and even if the excavator 100 is on an inclined ground by tilting the bucket to the left and right, the slope and the flat ground can be formed into a free shape or leveled. It is a bucket that can also be rolled by a bottom plate.
- the working machine 2 may include, as a work tool, a rock drilling attachment provided with a slope bucket or a chip for rock drilling instead of the bucket 8.
- the pressure of the hydraulic oil is appropriately referred to as hydraulic pressure.
- the boom cylinder 10 drives the boom 6 to move up and down.
- the arm cylinder 11 drives the arm 7 to rotate around the arm pin 14.
- the bucket cylinder 12 drives the bucket 8 to rotate around the bucket pin 15.
- the direction control valve 64 controls the flow rate of the hydraulic oil supplied from the hydraulic pumps 36 and 37 to the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12, and the like, and switches the direction in which the hydraulic oil flows.
- the direction control valve 64 is a working direction control valve for driving the hydraulic motor 5c and a swing motor 38 for swinging the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12, and the upper swing body 3.
- the work machine controller 26 shown in FIG. 2 controls the control valve 27 shown in FIG. 2, the pilot pressure of the hydraulic oil supplied from the operating device 25 to the direction control valve 64 is controlled.
- the flow rate of the hydraulic oil supplied from the direction control valve 64 to the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12 or the turning motor 38 is controlled.
- the work machine controller 26 can control the operations of the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12, and the upper swing body 3.
- the antennas 21 and 22 are attached to the upper part of the upper swing body 3.
- the antennas 21 and 22 are used to detect the current position of the excavator 100.
- the antennas 21 and 22 are electrically connected to the global coordinate calculation device 23 shown in FIG.
- the global coordinate calculation device 23 is a position detection device that detects the position of the excavator 100.
- the global coordinate calculation device 23 detects the current position of the excavator 100 using RTK-GNSS (Real Time Kinematic-Global Navigation Satellite Systems, GNSS is a global navigation satellite system).
- RTK-GNSS Real Time Kinematic-Global Navigation Satellite Systems
- GNSS is a global navigation satellite system
- the antennas 21 and 22 are appropriately referred to as GNSS antennas 21 and 22, respectively.
- a signal corresponding to the GNSS radio wave received by the GNSS antennas 21 and 22 is input to the global coordinate calculation device 23.
- the global coordinate calculation device 23 obtains the installation positions of the GNSS antennas 21 and 22 in the global
- the GNSS antennas 21 and 22 are preferably installed on the upper swing body 3 at both end positions separated from each other in the left-right direction of the excavator 100, that is, in the width direction.
- the GNSS antennas 21 and 22 are attached to the handrails 9 attached to both sides in the width direction of the upper swing body 3.
- the position at which the GNSS antennas 21 and 22 are attached to the upper swing body 3 is not limited to the handrail 9, but the GNSS antennas 21 and 22 should be installed as far as possible from the excavator 100. This is preferable because the detection accuracy of the current position is improved.
- the GNSS antennas 21 and 22 are preferably installed at positions that do not hinder the visual field of the operator as much as possible. Therefore, for example, the GNSS antennas 21 and 22 may be disposed on a counterweight disposed behind the machine room 3EG.
- the hydraulic system 300 of the excavator 100 includes an engine 35 and hydraulic pumps 36 and 37.
- the hydraulic pumps 36 and 37 are driven by the engine 35 and discharge hydraulic oil.
- the hydraulic oil discharged from the hydraulic pumps 36 and 37 is supplied to the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12.
- the excavator 100 includes a turning motor 38.
- the turning motor 38 is a hydraulic motor, and is driven by hydraulic oil discharged from the hydraulic pumps 36 and 37.
- the turning motor 38 turns the upper turning body 3.
- two hydraulic pumps 36 and 37 are shown, but one hydraulic pump may be used.
- the turning motor 38 is not limited to a hydraulic motor, and may be an electric motor.
- a control system 200 that is a control system for a work machine includes a global coordinate calculation device 23, an IMU (Inertial Measurement Unit) 24 that is a state detection device that detects angular velocity and acceleration, an operation device 25, and a work machine.
- a work machine controller 26 as a control unit, a sensor controller 39 as a position information generation unit, a display controller 28 as a target value generation unit, and a display unit 29 are included.
- the operating device 25 is a device for operating at least one of the work machine 2, the upper swing body 3, and the traveling device 5 shown in FIG. The operating device 25 receives an operation by an operator to drive the work machine 2 and the like, and outputs a pilot hydraulic pressure corresponding to the operation amount.
- the operating device 25 has a left operating lever 25L installed on the left side of the operator and a right operating lever 25R arranged on the right side of the operator.
- the front-rear and left-right operations correspond to the biaxial operations.
- the operation in the front-rear direction of the right operation lever 25R corresponds to the operation of the boom 6.
- the left / right operation of the right operation lever 25R corresponds to the operation of the bucket 8.
- An operation in the front-rear direction of the left operation lever 25L corresponds to an operation of the arm 7.
- the left / right operation of the left operation lever 25L corresponds to the turning of the upper swing body 3.
- the operating device 25 uses a pilot hydraulic system.
- the operating device 25 is supplied from the hydraulic pump 36 with hydraulic oil whose pressure is reduced to a predetermined pilot pressure by a pressure reducing valve (not shown) based on a boom operation, a bucket operation, an arm operation, a turning operation, and a traveling operation.
- the pilot hydraulic pressure can be supplied to the pilot oil passage 450 according to the operation in the front-rear direction of the right operation lever 25R, and the operation of the boom 6 by the operator is accepted.
- a valve device included in the right operation lever 25R is opened according to the operation amount of the right operation lever 25R, and hydraulic oil is supplied to the pilot oil passage 450.
- the pressure sensor 66 detects the pressure of the hydraulic oil in the pilot oil passage 450 at that time as the pilot pressure.
- the pressure sensor 66 transmits the detected pilot pressure to the work machine controller 26 as a boom operation signal MB.
- the pilot oil passage 450 between the operating device 25 and the boom cylinder 10 is provided with a pressure sensor 68, a control valve (hereinafter referred to as an intervention valve as appropriate) 27C, and a shuttle valve 51.
- the pilot hydraulic pressure can be supplied to the pilot oil passage 450 in accordance with the left / right operation of the right operation lever 25R, and the operation of the bucket 8 by the operator is accepted.
- the valve device included in the right operation lever 25R is opened according to the operation amount of the right operation lever 25R, and hydraulic oil is supplied to the pilot oil passage 450.
- the pressure sensor 66 detects the pressure of the hydraulic oil in the pilot oil passage 450 at that time as the pilot pressure.
- the pressure sensor 66 transmits the detected pilot pressure to the work machine controller 26 as a bucket operation signal MT.
- the pilot hydraulic pressure can be supplied to the pilot oil passage 450 according to the operation in the front-rear direction of the left operation lever 25L, and the operation of the arm 7 by the operator is accepted.
- the valve device included in the left operation lever 25L is opened according to the operation amount of the left operation lever 25L, and hydraulic oil is supplied to the pilot oil passage 450.
- the pressure sensor 66 detects the pressure of the hydraulic oil in the pilot oil passage 450 at that time as the pilot pressure.
- the pressure sensor 66 transmits the detected pilot pressure to the work machine controller 26 as an arm operation signal MA.
- the pilot hydraulic pressure can be supplied to the pilot oil passage 450 according to the left / right operation of the left operation lever 25L, and the turning operation of the upper swing body 3 by the operator is accepted.
- the valve device included in the left operation lever 25L is opened according to the operation amount of the left operation lever 25L, and hydraulic oil is supplied to the pilot oil passage 450.
- the pressure sensor 66 detects the pressure of the hydraulic oil in the pilot oil passage 450 at that time as the pilot pressure.
- the pressure sensor 66 transmits the detected pilot pressure to the work machine controller 26 as a turning operation signal MR.
- the operation device 25 supplies the directional control valve 64 with pilot hydraulic pressure having a magnitude corresponding to the operation amount of the right operation lever 25R.
- the operating device 25 supplies the control valve 27 with pilot hydraulic pressure having a magnitude corresponding to the operating amount of the left operating lever 25L. The spool of the direction control valve 64 is moved by this pilot hydraulic pressure.
- the pilot oil passage 450 is provided with a control valve 27.
- the operation amount of the right operation lever 25R and the left operation lever 25L is detected by a pressure sensor 66 installed in the pilot oil passage 450.
- the pilot hydraulic pressure detected by the pressure sensor 66 is input to the work machine controller 26.
- the work machine controller 26 opens and closes the pilot oil passage 450 by outputting a control signal N of the pilot oil passage 450 to the control valve 27 according to the input pilot oil pressure.
- the operating device 25 has travel levers 25FL and 25FR.
- the reduced hydraulic oil is supplied from the hydraulic pump 36 to the direction control valve 64, and the direction control is performed based on the pressure of the hydraulic oil in the pilot oil passage 450.
- the spool of valve 64 is driven. Then, hydraulic oil is supplied from the hydraulic pumps 36 and 37 to the hydraulic motors 5c and 5c provided in the traveling device 5 of the excavator 100, and the traveling becomes possible.
- the pressure of the hydraulic oil in the pilot oil passage 450 that is, the pilot pressure is detected by the pressure sensor 27PC.
- the operator of the hydraulic excavator 100 When the operator of the hydraulic excavator 100 operates the traveling device 5, the operator operates the traveling levers 25FL and 25FR. The amount of operation of the travel levers 25FL and 25FR by the operator is detected by the pressure sensor 27PC and output to the work machine controller 26 as an operation signal MD.
- the operation amounts of the left operation lever 25L and the right operation lever 25R are detected by, for example, a potentiometer and a Hall IC, and the work machine controller 26 controls the direction control valve 64 and the control valve 27 based on these detection values.
- the work machine 2 may be controlled.
- the left operation lever 25L and the right operation lever 25R may be of an electric system.
- the control system 200 includes a first stroke sensor 16, a second stroke sensor 17, and a third stroke sensor 18.
- the first stroke sensor 16 is provided in the boom cylinder 10
- the second stroke sensor 17 is provided in the arm cylinder 11
- the third stroke sensor 18 is provided in the bucket cylinder 12.
- the first stroke sensor 16 detects the amount of displacement corresponding to the extension of the boom cylinder 10 and outputs it to the sensor controller 39.
- the second stroke sensor 17 detects the amount of displacement corresponding to the extension of the arm cylinder 11 and outputs it to the sensor controller 39.
- the third stroke sensor 18 detects the amount of displacement corresponding to the extension of the bucket cylinder 12 and outputs it to the sensor controller 39.
- the work machine controller 26 includes a processing unit 26P which is a processor such as a CPU (Central Processing Unit) and a storage unit 26M which is a storage device such as a RAM (Random Access Memory) and a ROM (Read Only Memory).
- the work machine controller 26 controls the control valve 27 and the intervention valve 27C based on the detected value of the pressure sensor 66 shown in FIG.
- the direction control valve 64 is disposed between hydraulic actuators such as the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12, and the turning motor 38, and the hydraulic pumps 36 and 37.
- the direction control valve 64 controls the flow rate of hydraulic oil supplied from the hydraulic pumps 36 and 37 to the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12 and the swing motor 38.
- the GNSS antenna 21 receives reference position data P1 indicating its own position from a positioning satellite.
- the GNSS antenna 22 receives reference position data P2 indicating its own position from a positioning satellite.
- the GNSS antennas 21 and 22 receive the reference position data P1 and P2 at a predetermined cycle.
- the reference position data P1 and P2 are information on the position where the GNSS antenna is installed.
- a signal corresponding to the GNSS radio wave received by the GNSS antennas 21 and 22 is input to the global coordinate calculation device 23.
- the GNSS antennas 21 and 22 output the global position calculation device 23.
- the global coordinate calculation device 23 acquires two reference position data P1 and P2 (a plurality of reference position data) expressed in the global coordinate system.
- the global coordinate calculation device 23 generates revolving body arrangement data indicating the arrangement of the upper revolving body 3 based on the two reference position data P1 and P2.
- the swing body arrangement data includes at least one reference position data P of the two reference position data P1 and P2, and swing body orientation data Q generated based on the two reference position data P1 and P2. included.
- These two GNSS antennas 21 and 22 may constitute a GPS compass to obtain the revolving body orientation data Q.
- the reference position data of both the GNSS antennas 21 and 22 may not be output, and the azimuth angle may be calculated from the relative positions of the two GNSS antennas, and the azimuth angle may be used as the turning body azimuth data Q.
- the turning body azimuth data Q is an angle formed by the azimuth determined from the reference position data P acquired by the GNSS antennas 21 and 22 with respect to a reference azimuth (for example, north) of global coordinates, that is, an azimuth angle. .
- the azimuth angle is also the yaw angle of the excavator 100.
- the turning body orientation data Q indicates the direction in which the upper turning body 3, that is, the work implement 2 is facing.
- the global coordinate calculation device 23 includes a processing unit that is a processor such as a CPU and a storage unit that is a storage device such as a RAM and a ROM.
- the global coordinate calculation device 23 acquires two reference position data P1 and P2 from the GNSS antennas 21 and 22 at a predetermined cycle.
- the global coordinate calculation device 23 obtains the azimuth angle of the excavator 100 as the swing body orientation data Q, more specifically, the azimuth angle of the upper swing body 3 from the acquired two reference position data P1 and P2.
- the revolving body arrangement data that is, the reference position data P and the revolving body orientation data Q are updated and output to the sensor controller 39.
- the display controller 28 includes a processing unit 28P which is a processor such as a CPU, and a storage unit 28M which is a storage device such as a RAM (Random Access Memory) and a ROM.
- the display controller 28 displays, for example, an image such as a guidance screen to be described later on the display unit 29, and also uses the position information IPL of the excavator 100 obtained from the sensor controller 39, so that the three-dimensional position of the cutting edge 8T of the bucket 8 Bucket blade edge position data S indicating the blade edge position is generated.
- the display unit 29 is, for example, a liquid crystal display device or the like, but is not limited to this. As the display unit 29, for example, a touch panel in which an input unit and a display unit are integrated can be used.
- a switch 29 ⁇ / b> S is installed adjacent to the display unit 29.
- the switch 29S is an input device for executing excavation control to be described later or stopping the excavation control being executed.
- the switch 29S may be incorporated in the input unit of the touch panel.
- the display controller 28 can display the image of the target construction surface to be excavated by the work implement 2 and the image of the bucket 8 generated using the bucket blade tip position data S on the display unit 29 as a guidance screen.
- the display controller 28 allows the operator of the hydraulic excavator 100 to recognize the positional relationship between the target construction surface and the bucket 8 through the guidance screen, and can reduce the burden on the operator when performing the information construction.
- the IMU 24 is a state detection device that detects operation information MI indicating the operation of the excavator 100.
- the operation of the excavator 100 includes at least one of the operation of the upper swing body 3 and the operation of the traveling device 5.
- the operation information MI may include information indicating the attitude of the excavator 100. Examples of the information indicating the attitude of the excavator 100 include the roll angle, pitch angle, and azimuth angle of the excavator 100.
- the IMU 24 detects the angular velocity and acceleration of the excavator 100.
- the hydraulic excavator 100 generates various accelerations such as acceleration generated during running, angular acceleration generated during turning, and gravitational acceleration.
- the IMU 24 detects acceleration including at least gravitational acceleration, The detected acceleration is output without distinguishing the type of acceleration.
- the gravitational acceleration is an acceleration corresponding to a drag force against the gravity. In the local coordinate system (x, y, z) shown in FIG.
- the IMU 24 has accelerations in the x-axis direction, y-axis direction, and z-axis direction, and angular velocities (rotational angular velocities) around the x-axis, y-axis, and z-axis. And detect. These are the operation information MI.
- the local coordinate system is a three-dimensional coordinate system indicated by (x, y, z) with the excavator 100 as a reference.
- the motion information MI detected by the IMU 24 includes a rotational angular velocity at which the upper swing body 3 turns around the z axis that is the rotation center axis of the upper swing body 3, that is, a swing angular velocity ⁇ .
- the turning angular velocity ⁇ may be obtained by differentiating the turning angle of the upper turning body 3 acquired from information indicating the positions of the GNSS antennas 21 and 22 with respect to time.
- the turning angle can be obtained by integrating the turning angular velocity ⁇ with time.
- the IMU 24 is attached to the upper swing body 3.
- the IMU 24 is preferably provided, for example, on the turning center axis of the upper turning body 3 of the excavator 100, but the IMU 24 may be installed at the lower part of the cab 4. Good.
- the sensor controller 39 includes a processing unit 39P that is a processor such as a CPU (Central Processing Unit) and a storage unit 39M that is a storage device such as a RAM (Random Access Memory) and a ROM (Read Only Memory).
- the sensor controller 39 includes a detection value of the global coordinate arithmetic unit 23, a detection value of the IMU 24, a detection value of the pressure sensors 27PC, 66 and 68, a detection value of the first stroke sensor 16, a detection value of the second stroke sensor 17, The detection value of the 3-stroke sensor 18 is input.
- the sensor controller 39 obtains position information IPL related to the position of the excavator 100 from the detection value of the global coordinate arithmetic unit 23 and the detection value of the IMU 24 and outputs it to the display controller 28 and the work machine controller 26.
- FIG. 3 is a side view of the excavator 100.
- FIG. 4 is a rear view of the excavator 100.
- the inclination angle ⁇ 4 with respect to the left-right direction of the vehicle body 1, that is, the width direction is the roll angle of the excavator 100
- the inclination angle ⁇ 5 with respect to the front-rear direction of the vehicle body 1 is the pitch angle of the excavator 100.
- the angle of the body 3 is the azimuth angle of the excavator 100.
- the roll angle was detected by integrating the angular velocity around the x axis detected by the IMU 24 with time
- the pitch angle was integrated with the angular velocity around the y axis detected by the IMU 24, and the azimuth was detected by the IMU 24.
- the angular velocity around the z axis is the turning angular velocity ⁇ of the excavator 100. That is, the azimuth angle of the excavator 100, more specifically, the upper swing body 3 is obtained by integrating the swing angular velocity ⁇ with time.
- the IMU 24 updates the acceleration and angular velocity of the excavator 100 at a predetermined cycle.
- the update cycle of the IMU 24 is preferably shorter than the update cycle in the global coordinate calculation device 23.
- the acceleration and angular velocity detected by the IMU 24 are output to the sensor controller 39 or the work machine controller 26 as motion information MI.
- the sensor controller 39 performs processing such as filtering and integration on the operation information MI acquired from the IMU 24 to obtain the tilt angle ⁇ 4 that is the roll angle, the tilt angle ⁇ 5 that is the pitch angle, and the azimuth angle.
- the sensor controller 39 outputs the obtained tilt angle ⁇ 4, tilt angle ⁇ 5, and azimuth to the display controller 28 as position information IPL related to the position of the excavator 100.
- the display controller 28 acquires the reference position data P and the turning direction data Q from the global coordinate calculation device 23.
- the turning azimuth data Q is information indicating the azimuth of the excavator 100, and in the embodiment, is information indicating the azimuth of the upper swing body 3.
- the turning direction data Q is the azimuth angle of the upper turning body 3.
- the display controller 28 generates bucket blade edge position data S as work implement position data.
- the bucket blade edge position data S may be generated by the sensor controller 39 or the work machine controller 26.
- the target construction information T is stored in the storage unit 28M (target construction information storage unit 28C) of the display controller 28.
- the target construction information T is information that becomes a finish target after excavation of the excavation target of the work machine 2 included in the excavator 100, and includes information on a target construction surface obtained from design data.
- the target excavation landform data U is one or a plurality of inflection points before and after the excavation target position when the intersection of the perpendicular line passing through the current cutting edge position of the cutting edge 8T and the target construction surface in the local coordinate system is the excavation target position. Information indicating the position of the line and angle information of the lines before and after the position.
- the sensor controller 39 calculates the tilt angle ⁇ 1 (see FIG. 3) of the boom 6 with respect to the direction (z-axis direction) orthogonal to the horizontal plane in the local coordinate system from the boom cylinder length detected by the first stroke sensor 16.
- the sensor controller 39 calculates the inclination angle ⁇ 2 (see FIG. 3) of the arm 7 with respect to the boom 6 from the arm cylinder length detected by the second stroke sensor 17.
- the sensor controller 39 calculates the inclination angle ⁇ 3 of the bucket 8 with respect to the arm 7 from the bucket cylinder length detected by the third stroke sensor 18.
- the sensor controller 39 outputs the calculated inclination angles ⁇ 1, ⁇ 2, and ⁇ 3 to the work machine controller 26. Further, the IMU 24 outputs the turning angular velocity ⁇ to the work machine controller 26.
- the work machine controller 26 acquires the turning angular velocity ⁇ of the upper swing body 3 when the upper swing body 3 rotates about the z axis shown in FIG.
- the work machine controller 26 acquires the boom operation signal MB, the bucket operation signal MT, the arm operation signal MA, and the turning operation signal MR from the pressure sensor 66.
- the work machine controller 26 acquires the tilt angle ⁇ 1 of the boom 6, the tilt angle ⁇ 2 of the arm 7, and the tilt angle ⁇ 3 of the bucket 8 from the sensor controller 39.
- the work machine controller 26 acquires the target excavation landform data U from the display controller 28.
- the work machine controller 26 calculates the position of the blade edge 8T of the bucket 8 (hereinafter, referred to as the blade edge position as appropriate) from the angles ( ⁇ 1, ⁇ 2, ⁇ 3) of the work machine 2 acquired from the sensor controller 39.
- the storage unit 26M of the work machine controller 26 stores data of the work machine 2 (hereinafter, referred to as work machine data as appropriate).
- the work machine data includes design dimensions such as the length L1 of the boom 6, the length L2 of the arm 7, and the length L3 of the bucket 8. As shown in FIG. 3, the length L ⁇ b> 1 of the boom 6 corresponds to the length from the boom pin 13 to the arm pin 14.
- the length L2 of the arm 7 corresponds to the length from the arm pin 14 to the bucket pin 15.
- the length L3 of the bucket 8 corresponds to the length from the bucket pin 15 to the cutting edge 8T of the bucket 8.
- the blade tip 8T is the tip of the blade 8B shown in FIG.
- the work implement data includes information on the position up to the boom pin 13 with respect to the origin position PL in the local coordinate system.
- the work machine controller 26 can obtain the edge position with respect to the origin position PL using the lengths L1, L2, L3, the inclination angles ⁇ 1, ⁇ 2, ⁇ 3, and the origin position PL.
- the work machine controller 26 uses the boom operation signal MB, the bucket operation signal MT, and the arm operation signal MA input from the operation device 25 as the target excavation so that the cutting edge 8T of the bucket 8 moves along the target excavation landform data U. Adjustment is made based on the distance between the terrain data U and the cutting edge 8T of the bucket 8 and the speed of the cutting edge 8T of the bucket 8.
- the work machine controller 26 generates a control signal N for controlling the work machine 2 so that the cutting edge 8T of the bucket 8 moves along the target excavation landform data U, and outputs the control signal N to the control valve 27 shown in FIG. To do.
- the speed at which the work machine 2 approaches the target excavation landform data U is limited according to the distance to the target excavation landform data U.
- the global coordinate calculation device 23 detects the reference position data P1 and P2 of the GNSS antennas 21 and 22 in the global coordinate system.
- the global coordinate system is a three-dimensional coordinate system indicated by (X, Y, Z) based on, for example, a reference position PG of the reference pile 60 that is a reference installed in the work area GA of the excavator 100. As shown in FIG. 3, the reference position PG is located at the tip 60T of the reference pile 60 installed in the work area GA, for example.
- the global coordinate system is, for example, a coordinate system in GNSS.
- the display controller 28 shown in FIG. 2 calculates the position of the local coordinate system in the global coordinate system based on the detection result by the global coordinate calculation device 23.
- the origin position PL of the local coordinate system is an intersection of the z axis that is the rotation center axis of the revolving structure and a surface that corresponds to the surface that the traveling device 5 contacts with the ground.
- the coordinates of the origin position PL are (0, 0, 0) in the local coordinate system.
- the surface to which the traveling device 5 contacts is the surface GD of the work area GA with which the crawler belts 5a and 5b are in contact.
- the surface corresponding to the surface on which the traveling device 5 contacts the ground may be the surface GD of the work area GA, or the plane CP defined by the portion where the crawler belts 5a and 5b contact the ground.
- the plane CP defined by the portion where the crawler belts 5a and 5b are grounded is uniquely determined from the design dimensions of the excavator 100 in the local coordinate system (x, y, z).
- the origin position PL is not limited to the intersection of the z axis and the plane CP. In the embodiment, the position of a pseudo-fixed point described later may or may not coincide with the origin position PL.
- the origin position PL in the local coordinate system may be another place. For example, the center point of the length of the boom pin 13 in the axial direction may be set as the origin position PL.
- the origin position PL may be located on the z axis and on a swing circle for the upper swing body 3 to swing.
- the work machine controller 26 obtains the cutting edge position with respect to the origin position PL, that is, the cutting edge position in the local coordinate system. If the coordinates of the origin position PL in the global coordinate system can be obtained, the work machine controller 26 in the local coordinate system can be obtained.
- the coordinates of the cutting edge position can be converted into the coordinates of the cutting edge position in the global coordinate system.
- the work machine controller 26 performs control so that the speed in the direction in which the work machine 2 approaches the object to be excavated is equal to or less than the speed limit in order to prevent the bucket 8 from eroding the target excavation landform.
- This control is appropriately referred to as excavation control.
- the work implement 2 approaches the excavation target while calculating the relative position between the work implement 2 and the excavation target based on the target excavation landform data U and the bucket edge position data S acquired from the display controller 28. This is the control to make the speed in the direction below the speed limit.
- the excavation target can be constructed in the target shape (the shape indicated by the target construction information T).
- FIG. 5 is a control block diagram of the control system 200 according to the embodiment.
- 6 and 7 are plan views showing the posture of the excavator 100.
- the work machine controller 26, the display controller 28, and the sensor controller 39 of the control system 200 can exchange information with each other via a signal line. Further, the sensor controller 39 can acquire information from the global coordinate calculation device 23 via a signal line.
- the signal line for transmitting information in the control system 200 is exemplified by an in-vehicle signal line such as CAN (Controller Area Network).
- the work system controller 26 and the display controller 28 are separate devices in the control system 200, but both may be realized by one device.
- the display controller 28 has a cutting edge position calculation unit 28A, a target excavation landform data generation unit 28B, and a target construction information storage unit 28C.
- the cutting edge position calculation unit 28A and the target excavation landform data generation unit 28B are realized by the processing unit 28P executing the computer program stored in the storage unit 28M.
- the target construction information storage unit 28C is realized by a part of the storage area of the storage unit 28M.
- the cutting edge position calculation unit 28A based on the position information IPL acquired from the sensor controller 39, turns center position data XR indicating the position of the turning center of the excavator 100 that passes through the z axis that is the turning center axis of the upper swing body 3. Is generated.
- the position information IPL acquired by the blade edge position calculation unit 28A from the sensor controller 39 is reference position data P1c and P2c based on the reference position data P1 and P2, and the azimuth angle ⁇ d.
- the cutting edge position calculation unit 28A is based on the turning center position data XR, the inclination angles ⁇ 1, ⁇ 2, and ⁇ 3 of the work implement 2, the length L1 of the boom 6, the length L2 of the arm 7, and the length L3 of the bucket 8.
- bucket cutting edge position data S indicating the current position of the cutting edge 8T of the bucket 8 is generated and output to the target excavation landform data generation unit 28B.
- the bucket blade edge position data S is information indicating the position of the work machine 2.
- the position of the work machine 2 is not limited to the blade edge position, that is, the three-dimensional position of the blade edge 8T of the bucket 8, and may be a position of a specific part of the work machine 2.
- the position of the work machine 2 may be the position of the bottom of the bucket 8, the position of the bottom part of the slope bucket, or the position of the part to which the attachment of the work machine 2 is attached. It may be.
- the target excavation landform data generation unit 28B acquires the target construction information T stored in the target construction information storage unit 28C and the bucket blade tip position data S from the blade tip position calculation unit 28A.
- the target excavation landform data generation unit 28B sets, as the excavation target position, the intersection of the perpendicular line passing through the cutting edge position of the cutting edge 8T at the current time and the target construction surface in the local coordinate system.
- the target excavation landform data generation unit 28 ⁇ / b> B generates the target excavation landform data U based on the target construction information T and the bucket edge position data S and outputs the target excavation landform data U to the work machine controller 26.
- the processing unit 39P of the sensor controller 39 includes an attitude angle calculation unit 39A and a position information calculation unit 39B.
- the posture angle calculation unit 39A and the position information calculation unit 39B are realized by the processing unit 39P executing the computer program stored in the storage unit 39M.
- accelerations a (ax, ay, az) and angular velocities ⁇ ( ⁇ x, ⁇ y, ⁇ z) that are detection values of the IMU 24, that is, motion information MI, and detection values of the global coordinate calculation unit 23 are stored.
- Revolving body azimuth data Q (azimuth angle ⁇ da) is input.
- the detected values of the pressure sensors 66 and 27PC are input to the attitude angle calculation unit 39A and the position information calculation unit 39B of the processing unit 39P.
- the global coordinate calculation device 23 generates error information Err when the global coordinate calculation device 23 becomes unable to receive radio waves or when communication with the sensor controller 39 fails, and the processing unit 39P and display of the sensor controller 39 are displayed.
- the data is output to the processing unit 28P of the controller 28.
- the global coordinate calculation device 23 is a positioning state determination device that determines whether or not a failure has occurred in positioning by RTK-GNSS.
- the sensor controller 39 acquires the error information Err
- the sensor controller 39 executes processing for backing up positioning by RTK-GNSS. This process will be described later.
- the display controller 28 acquires the error information Err, the display controller 28 displays on the display unit 29 shown in FIG. 2 that an abnormality has occurred in positioning by RTK-GNSS.
- the attitude angle calculation unit 39A obtains the tilt angle ⁇ 4 that is the roll angle of the excavator 100 and the tilt angle ⁇ 5 that is the pitch angle of the excavator 100 from the detection value of the IMU 24, and the position information calculation unit 39B and the display controller. It outputs to 28 cutting edge position calculation part 28A.
- the attitude angle calculation unit 39A integrates the turning angular velocity ⁇ around the z axis detected by the IMU 24 to obtain the azimuth angle ⁇ di.
- the attitude angle calculation unit 39A switches between the azimuth angle ⁇ di obtained by itself or the azimuth angle ⁇ da acquired from the global coordinate calculation apparatus 23 according to the state of the global coordinate calculation apparatus 23 that is a position detection device.
- the azimuth angle ⁇ dc is output to the blade edge position calculation unit 28A or the position information calculation unit 39B. That is, when the positioning by RTK-GNSS is normal, the bucket blade edge data S is obtained using the azimuth angle ⁇ da acquired from the global coordinate arithmetic unit 23, and when the positioning by RTK-GNSS is abnormal, Bucket edge data S is obtained using the azimuth angle ⁇ di obtained by integrating the turning angular velocity ⁇ around the z-axis detected by the IMU 24. Further, the inclination angle ⁇ 4, the inclination angle ⁇ 5, and the azimuth angle ⁇ dc sent from the attitude angle calculation unit 39A to the display controller 28 are position information IPL related to the position of the excavator 100.
- the inclination angle ⁇ 4 is appropriately referred to as a roll angle ⁇ 4
- the inclination angle ⁇ 5 is appropriately referred to as a pitch angle ⁇ 5.
- the position information IPL is information related to the position of the excavator 100, which is a work machine, as described above.
- the position information IPL includes information necessary for obtaining the position of the excavator 100 in addition to information on the position of the excavator 100 itself.
- Information on the position of the excavator 100 itself is exemplified by reference position data P1, P2 and bucket blade edge position data S.
- Information necessary for obtaining the position of the excavator 100 includes an inclination angle ⁇ 4, an inclination angle ⁇ 5, and an azimuth angle.
- ⁇ d ( ⁇ di, ⁇ da, or ⁇ dc) is exemplified.
- the position information calculation unit 39B switches the reference position data P1 and P2 acquired from the global coordinate calculation device 23 and the reference position data P1i and P2i obtained by the position information calculation unit 39B, and the cutting edge position calculation unit of the display controller 28.
- the reference position data P1c and P2c are output to 28A.
- the reference position data P1i and P2i are position information obtained by the position information calculation unit 39B using both the origin position PL and the motion information MI detected by the IMU 24 before the state of the global coordinate calculation device 23 becomes abnormal. is there.
- the reference position data P1i and P2i are obtained as follows.
- the reference position data P1i and P2i are the roll angle ⁇ 4 and the pitch angle ⁇ 5 obtained by the attitude angle calculation unit 39A from the acceleration a (ax, ay, az) and the angular velocity ⁇ ( ⁇ x, ⁇ y, ⁇ z) that are detection values of the IMU 24.
- the azimuth angle ⁇ dc output from the attitude angle calculation unit 39A.
- This azimuth angle ⁇ dc is obtained by integrating the turning angular velocity ⁇ into the azimuth angle ⁇ da or the azimuth angle ⁇ da acquired from the global coordinate calculation device 23 by the attitude angle calculation unit 39A before the state of the global coordinate calculation device 23 becomes abnormal. It is an azimuth obtained by adding the azimuth.
- the sensor controller 39 operates in any one of the three modes of the first mode, the second mode, and the third mode when outputting the position information IPL of the excavator 100 to the display controller 28.
- the first mode is a mode in which the sensor controller 39 outputs position information detected by the global coordinate calculation device 23 as position information IPL of the excavator 100.
- the second mode the position information obtained by the sensor controller 39 using both the origin position PL of the excavator 100 and the operation information MI detected by the IMU 24 before the positioning by the global coordinate arithmetic unit 23 becomes abnormal. Is output as position information IPL.
- the third mode is a mode in which the sensor controller 39 does not output the position information IPL.
- the attitude angle calculation unit 39A and the position information calculation unit 39B that is, the processing unit 39P determine the stationary state of the excavator 100 based on the detection values from the pressure sensors 66 and 27PC, and the first mode based on the determination result. Any one of the second mode and the third mode is executed.
- the sensor controller 39 operates in the first mode when the positioning by the global coordinate calculation device 23 is normal, and when the positioning by the global coordinate calculation device 23 is abnormal and the excavator 100 stops without traveling. Operates in the second mode, and operates in the third mode when the positioning by the global coordinate calculation device 23 is abnormal and the excavator 100 is traveling.
- the case where the excavator 100 is stopped without traveling includes both the state where the upper swing body 3 is turned and stopped and the state where the upper swing body 3 is stopped without turning.
- the stationary state is a state in which the excavator 100 does not travel and the upper swing body 3 is swung and stopped, or is not swung.
- the non-static state is a state where the excavator 100 is traveling.
- the positioning by the global coordinate calculation device 23 becomes abnormal when the coordinate values of the reference position data P1 and P2 output from the global coordinate calculation device 23 indicate an abnormal value, between the global coordinate calculation device 23 and the sensor controller 39.
- a case where a communication error occurs between the two and a case where a fault occurs in positioning by RTK-GNSS is included.
- the GNSS antennas 21 and 22 cannot receive radio waves from positioning satellites or receive radio waves, it becomes difficult to perform positioning by RTK-GNSS.
- the control system 200 of the excavator 100 measures the absolute position by RTK-GNSS, in the embodiment, the position in global coordinates. For this reason, if a problem occurs in the positioning by RTK-GNSS for some reason, that is, if the positioning by the global coordinate arithmetic unit 23 becomes abnormal, the positioning accuracy of the absolute position decreases. If the positioning failure by RTK-GNSS is short, positioning by RTK-GNSS can be backed up by a method other than positioning by RTK-GNSS. The control system 200 backs up the positioning by RTK-GNSS using a pseudo fixed point described later. By executing positioning backup, the control system 200 can continue excavation control and display of a guidance screen even when a positioning failure due to RTK-GNSS occurs, and can accurately continue information construction.
- the control system 200 maintains the absolute position of the fixed point, and the relative position from the fixed point to an arbitrary point on the vehicle body 1.
- the absolute position of an arbitrary point of hydraulic excavator 100 can be calculated.
- vibration is generated by the operation of the work implement 2 and the like, so there is no fixed point, so an approximate position that can be regarded as a fixed point is selected as a pseudo fixed point.
- the control system 200 can back up positioning by RTK-GNSS using the pseudo fixed point by handling the selected pseudo fixed point in the same manner as the above-described fixed point.
- the pseudo fixed point can be regarded as a fixed point when the excavator 100 is not moving, that is, when the crawler belts 5a and 5b shown in FIG. 1 are not moving.
- the pseudo fixed point is the origin position PL of the excavator 100 shown in FIGS. 3 and 4.
- the origin position PL is determined as the origin of the local coordinate system as described above, the origin of the local coordinate system may be determined at another position. Therefore, the pseudo fixed point may be referred to as a specific point in the following description.
- the hydraulic excavator 100 in operation has a movement that causes rotation, the fulcrum of the rotation does not move.
- the pseudo fixed point is at the fulcrum, the position determined by the control system 200, for example, the work machine 2
- the error of the position of the work implement 2 including the position of the specific part of the bucket or the position of the 8 cutting edges 8T of the bucket is the smallest.
- the pseudo fixed point cannot be used as a fulcrum for rotation, if the pseudo fixed point is set as close to the fulcrum as possible, the error of the position (position of the work implement 2) obtained by the control system 200 can be reduced. Since the fulcrum when the upper turning body 3 turns is the turning center axis, that is, the axis z, the pseudo fixed point is set on the axis z.
- the fulcrum of rotation in the direction of the roll angle ⁇ 4 and the direction of the pitch angle ⁇ 5 is not a fixed point, but it is considered that it is always on the surface on which the excavator 100 contacts the ground.
- the origin position PL is the intersection of the z axis that is the rotation center axis of the revolving structure and the surface that corresponds to the surface that the traveling device 5 contacts with the ground.
- the origin position PL which is a pseudo-fixed point, is set on the surface on which the excavator 100 comes into contact with the ground, so that the position required by the control system 200 when the positioning failure due to RTK-GNSS occurs, more specifically, Specifically, the error of the absolute position of the GNSS antennas 21 and 22 can be reduced.
- the excavator 100 can perform various operations. In the case of slope construction, excavation and leveling can be performed only by operating the work machine 2 or the upper swing body 3 while the traveling device 5 is stopped. There is. When performing such sloped construction using the hydraulic excavator 100 that enables computerized construction, the positioning of RTK-GNSS is backed up using pseudo fixed points, and the excavation control and guidance screens are displayed. The display can be continued and the computerized construction can be continued accurately.
- the control system 200 of the excavator 100 measures the absolute position of the GNSS antennas 21 and 22. For this reason, the control system 200 backs up the RTK-GNSS positioning by calculating the absolute position of the GNSS antennas 21 and 22 as described below when a fault in positioning by the RTK-GNSS occurs. it can.
- Equation (1) is obtained by calculating the difference between the position vector of the origin position PL in the local coordinate system and the position vector of the GNSS antennas 21 and 22 and the position vector of the origin position PL and the position vectors of the GNSS antennas 21 and 22 in the global coordinate system. This is a formula for converting to From equation (1), equation (2) is obtained. Equation (3) is calculated by replacing the measured value Ral of the position vector of the GNSS antennas 21 and 22 in the global coordinate system of the equation (1) with the calculated value Ralc of the position vector of the GNSS antennas 21 and 22 in the global coordinate system. This is an expression for obtaining the value Ralc.
- Rfl-Ral Clb (Rfb-Rab) (1)
- Rfl Clb (Rfb ⁇ Rab) + Ral (2)
- Ralc Clb (Rab ⁇ Rfb) + Rfl (3) here
- Rfb Calibration value of the position vector of the origin position PL in the local coordinate system
- Rab Calibration value of the position vector of the GNSS antennas 21 and 22 in the local coordinate system
- Rfl Calculated value of the position vector of the origin position PL in the global coordinate system
- Ral Global Measured value
- Ralc of the position vector of the GNSS antennas 21 and 22 in the coordinate system Calculated value of the position vector of the GNSS antennas 21 and 22 in the global coordinate system
- Clb Coordinate rotation matrix from the local coordinate system to the global coordinate system
- the calibration value is a value of the origin position PL and the position of the GNSS antennas 21 and 22 obtained by measuring each position and size of the excavator 100, and the storage unit 26M and the sensor controller 39 of the work machine controller 26. Is stored in the storage unit 39M.
- the calibration value may be based on the design size of the hydraulic excavator 100, but since variations occur in each hydraulic excavator 100, it is preferable to obtain a calibration value based on measurement (calibration) as described above.
- the coordinate rotation matrix Clb is expressed as Equation (4) using the roll angle ⁇ 4, the pitch angle ⁇ 5, and the yaw angle, that is, the azimuth angle ⁇ di.
- the roll angle ⁇ 4, the pitch angle ⁇ 5, and the azimuth angle ⁇ di are obtained by integrating the angular velocity ⁇ x around the x axis, the angular velocity ⁇ y around the y axis, and the angular velocity ⁇ z around the z axis detected by the IMU 24 by the posture angle calculation unit 39A. Is required.
- sx is sin ⁇ 4, sy is sin ⁇ 5, sz is sin ⁇ di, cx is cos ⁇ 4, cy is cos ⁇ 5, and cz is cos ⁇ di.
- the control system 200 can obtain a specific point (the origin position PL in the embodiment) that is a pseudo-fixed point by using the equation (2). Moreover, the control system 200 can obtain
- the attitude angle calculation unit 39A included in the sensor controller 39 of the control system 200 obtains the roll angle ⁇ 4, the pitch angle ⁇ 5, and the azimuth angle ⁇ di, and the display controller 28 It outputs to the blade edge
- the attitude angle calculation unit 39A acquires the azimuth angle ⁇ dc (here, the azimuth angle ⁇ da) in the global coordinate system using the reference position data P1 and P2 acquired from the global coordinate calculation device 23. Since the turning body orientation data Q is obtained from the reference position data P1 and P2, the position of the work machine 2 obtained with respect to the local coordinate system can be obtained as the position of the work machine 2 in the global coordinate system.
- the attitude angle calculation unit 39A stores the acquired azimuth angle ⁇ da in the storage unit 39M as a normal azimuth angle, that is, the azimuth angle ⁇ dib before occurrence of a failure in positioning by RTK-GNSS.
- the azimuth angle ⁇ di represents the inclination of the x axis, which is the longitudinal axis of the upper swing body 3 with respect to the Y axis of the global coordinate system (X, Y, Z).
- the azimuth D1 of the excavator 100 is determined by the azimuth angle ⁇ di.
- the position information calculation unit 39B calculates a coordinate rotation matrix Clb from the roll angle ⁇ 4, the pitch angle ⁇ 5, and the azimuth angle ⁇ di determined by the posture angle calculation unit 39A. Further, the position information calculation unit 39B measures the position vector measurement values of the GNSS antennas 21 and 22 in the global coordinate system from the reference position data P1 and P2 acquired from the global coordinate calculation device 23 in a state where the positioning by RTK-GNSS is normal. Find Ral. Then, the position information calculation unit 39B gives the calculated coordinate rotation matrix Clb and the measured value Ral of the position vector to Expression (2) to obtain the calculated value Rfl of the position vector of the origin position PL in the global coordinate system.
- the calculated value Rfl is appropriately referred to as a normal origin position Rfl.
- the position information calculation unit 39B stores the obtained normal origin position Rfl in the storage unit 39M. Then, the position information calculation unit 39B outputs the reference position data P1 and P2 acquired from the global coordinate calculation device 23 to the blade edge position calculation unit 28A of the display controller 28 as the reference position data P1c and P2c.
- attitude angle calculation unit 39A detects the detected value of IMU 24. Are used to determine the roll angle ⁇ 4, the pitch angle ⁇ 5, and the azimuth angle ⁇ di.
- the attitude angle calculation unit 39A calculates the azimuth angle ⁇ div stored in the storage unit 39M and the angular velocity ⁇ z around the z axis after the occurrence of the positioning failure before the RTK-GNSS positioning failure occurs. Is obtained as an azimuth angle ⁇ di.
- the posture angle calculation unit 39A outputs the calculated roll angle ⁇ 4, pitch angle ⁇ 5, and further the azimuth angle ⁇ di to the cutting edge position calculation unit 28A of the display controller 28 as the azimuth angle ⁇ dc.
- the position information calculation unit 39B generates a coordinate rotation matrix Clb using the roll angle ⁇ 4, the pitch angle ⁇ 5, and the azimuth angle ⁇ di obtained from the attitude angle calculation unit 39A after the occurrence of a positioning failure or the like.
- the position information calculation unit 39B reads the normal origin position Rfl before the occurrence of a positioning failure or the like stored in the storage unit 39M. Then, the position information calculation unit 39B gives the read out normal origin position Rfl and the generated coordinate rotation matrix Clb to Expression (3), and obtains the calculated value Ralc of the position vectors of the GNSS antennas 21 and 22 in the global coordinate system.
- the position information calculation unit 39B obtains the reference position data P1i and P2i of the GNSS antennas 21 and 22 from the calculated value Ralc of the position vector, and outputs the reference position data P1c and P2c to the cutting edge position calculation unit 28A of the display controller 28. Since the turning body orientation data Q is obtained from the reference position data P1c and P2c, the position of the work machine 2 obtained with respect to the local coordinate system can be obtained as the position of the work machine 2 in the global coordinate system.
- the operation of the sensor controller 39 of the control system 200 when a positioning failure or the like occurs corresponds to the second mode described above.
- the position information calculation unit 39B obtains the azimuth angle ⁇ di during turning as follows.
- the azimuth angle at the start of turning is ⁇ dib and is stored in the storage unit 39M of the sensor controller 39.
- the attitude angle calculation unit 39A integrates the turning angular velocity ⁇ of the upper swing body 3 that has started turning from the direction D1 over time to obtain the azimuth angle ⁇ dia (azimuth angle change amount) from the direction D1, and the position information calculation unit Output to 39B.
- the position information calculation unit 39B adds the azimuth angle ⁇ dia from the azimuth D1 and the azimuth angle ⁇ dib at the start of turning read from the storage unit 39M, and sets the obtained value as the azimuth angle ⁇ di during turning.
- the azimuth D2 of the excavator 100 during turning is determined by the azimuth angle ⁇ di.
- the control system 200 uses the reference position data P1i, the reference position data P1i, using the reference position data P1 and P2 that are normally measured before the positioning failure occurs. Find P2i. By doing in this way, the control system 200 can obtain
- FIG. 8 is a flowchart illustrating an example of a process in which the control system 200 according to the embodiment generates the position information IPL.
- the processing unit 39P of the sensor controller 39 determines whether or not the positioning by the global coordinate calculation device 23 is normal and the excavator 100 is in a static state. Whether or not the positioning by the global coordinate calculation device 23 is normal is determined as follows. (1) If any error relating to positioning of the global coordinate calculation device 23 has occurred or if the value of coordinate data in the Z direction of the GNSS antennas 21 and 22 exceeds the threshold value, the global coordinate calculation device 23 The positioning by is abnormal.
- the positioning by the global coordinate calculation device 23 may be abnormal.
- the positioning by the global coordinate calculation device 23 may be normal.
- Whether the excavator 100 is in a static state is determined as follows. In the following description, when the operating lever of the operating device 25 is ON, it indicates that the operating lever is operated and is not in a neutral state, and when the operating lever of the operating device 25 is OFF, the operating lever is not operated and is in a neutral state. Show.
- the excavator 100 When the left operating lever 25L is operated to either the left or right and the left operating lever 25L is ON, or when at least one of the traveling lever 25FL and the traveling lever 25FR is ON, or the turning angular velocity ⁇ When the state where the absolute value is equal to or greater than the turning angular velocity threshold value ⁇ c continues for the first time ta, the excavator 100 is in a non-static state, that is, a dynamic state.
- the turning angular velocity threshold value ⁇ c is not limited, but is 1 degree / second in the embodiment.
- the first time ta is not limited, but is 0.03 seconds, for example.
- the reason why the state in which the absolute value of the turning angular velocity ⁇ is equal to or greater than the turning angular velocity threshold value ⁇ c is the non-static state when the state continues for the first time ta is as follows. It is assumed that the operator releases his / her hand from the left operation lever 25L in order to stop the turn from the state where the left operation lever 25L is operated to turn the upper swing body 3. At this time, the left operation lever 25L is in the neutral position, and the left operation lever 25L is OFF. However, at this time, it is assumed that the upper swing body 3 is rotating for a certain period of time due to inertial force. That is, this state can be said that the excavator 100 is a dynamic state.
- one of the judgment conditions is that not only the ON / OFF of each operation lever but also the case where the absolute value of the turning angular acceleration ⁇ is not less than a predetermined threshold value continues for a predetermined time. I put it.
- the left operating lever 25L is not operated to the left or right, the left operating lever 25L is OFF, both the traveling lever 25FL and the traveling lever 25FR are OFF, and the absolute value of the turning angular velocity ⁇ Is lower than the turning angular velocity threshold value ⁇ c, the hydraulic excavator 100 is in a static state, that is, a static state.
- the second time tb is not limited, but is larger than the first time ta, for example, 4 seconds.
- whether or not it is in a static state is determined by the detection values STr of the pressure sensor 66 for detecting the pilot pressures of the left operating lever 25L and the right operating lever 25R shown in FIG. 2, the travel lever 25FL, and the travel lever 25FR.
- the determination is made based on the detection value STd of the pressure sensor 27PC that detects the pilot pressure.
- the processing unit 39P of the sensor controller 39 determines that it is in a non-static state.
- the processing unit 39P of the sensor controller 39 determines that the state is a static state.
- the processing unit 39P of the sensor controller 39 uses the detection values STr and STd of the pressure sensors 66 and 27PC to determine whether the excavator 100 is in a static state or a non-static state. This determination is not limited to the method using the detection values of the pressure sensors 66 and 27PC.
- the processing unit 39P of the sensor controller 39 May determine whether the excavator 100 is in a static state or a non-static state using the output value of the potentiometer or Hall IC.
- the processing unit 39P of the sensor controller 39 may determine whether the excavator 100 is in a static state or a non-static state using the detection value of the IMU 24. For example, when the IMU 24 detects the turning angular velocity ⁇ , or detects acceleration in at least one direction of the x-axis direction, the y-axis direction, and the z-axis direction, the processing unit 39P of the sensor controller 39 causes the hydraulic excavator 100 to It can be determined that the state is non-static.
- the attitude angle calculation unit 39A of the sensor controller 39 acquires the operation information MI from the IMU 24 in step S102. .
- the posture angle calculation unit 39A obtains the roll angle ⁇ 4, the pitch angle ⁇ 5, and the azimuth angle ⁇ di, which are the position information IPL, from the acquired motion information MI, and the position information calculation unit 39B as the roll angle ⁇ 4, the pitch angle ⁇ 5, and the azimuth angle ⁇ dc. Output to.
- step S103 the position information calculation unit 39B obtains a coordinate rotation matrix Clb from the acquired roll angle ⁇ 4, pitch angle ⁇ 5, and azimuth angle ⁇ di ( ⁇ dc).
- step S104 the position information calculation unit 39B calculates the coordinate rotation matrix Clb and the measured values Ral of the position vectors of the GNSS antennas 21 and 22 based on the reference position data P1 and P2 acquired from the global coordinate calculation device 23 using the equation (2). ) To obtain the position of the specific point (in the embodiment, the origin position PL).
- step S105 the position information calculation unit 39B stores the obtained origin position PL in the storage unit 39M.
- step S106 the position information calculation unit 39B obtains reference position data P1c and P2c in the global coordinate system, and outputs the position information IPL to the blade position calculation unit 28A of the display controller 28 in step S107.
- the reference position data P1c and P2c output to the blade edge position calculation unit 28A are the reference position data P1 and P2 acquired from the global coordinate calculation device 23.
- Step S107 corresponds to the first mode.
- the processing unit 39P of the sensor controller 39 returns to step S101 and executes the subsequent processing.
- step S101 when positioning by the global coordinate calculation device 23 is abnormal and the excavator 100 is in a non-static state (step S101, No), the position information calculation unit 39B is acquired from the attitude angle calculation unit 39A in step S108.
- a coordinate rotation matrix Clb is obtained from the azimuth angle ⁇ dia obtained by integrating the roll angle ⁇ 4, pitch angle ⁇ 5 and turning angular velocity ⁇ , and the azimuth angle ⁇ div stored in the storage unit 39M.
- the azimuth angle ⁇ di used when the position information calculation unit 39B obtains the coordinate rotation matrix Clb the azimuth angle ⁇ dib stored in the storage unit 39M is read a predetermined time before the time point determined as No in step S101, As described above, the sum of the azimuth angle ⁇ dib and the azimuth angle ⁇ dia is obtained as the azimuth angle ⁇ di. Further, the coordinate rotation matrix Clb is obtained using the obtained azimuth angle ⁇ di and the equation (4).
- the predetermined time here is not limited to a specific value because it is determined by the communication time between the global coordinate calculation device 23 and the sensor controller 39 and the calculation time of the sensor controller 39, but is 0.3 seconds, for example.
- step S109 the position information calculation unit 39B reads the position of the specific point (the origin position PL in the embodiment) stored in the storage unit 39M of the sensor controller 39.
- the sensor controller 39 stores the origin position PL before the time point determined as No in step S101 in the storage unit 39M.
- step S109 the position information calculation unit 39B reads the origin position PL stored in the storage unit 39M a predetermined time before the time point determined as No in step S101.
- the predetermined time in step S109 is the same as the predetermined time in step S108.
- step S108 and step S109 the azimuth angle ⁇ di and the origin position PL stored in the storage unit 39M before the time point determined as No in step S101 are used. For this reason, the position information calculation unit 39B can use the azimuth angle ⁇ di and the origin position PL when the positioning by the global coordinate calculation device 23 is surely normal.
- step S110 the position information calculation unit 39B gives the coordinate rotation matrix Clb obtained in step S108 and the origin position PL read in step S109 to Expression (3), and uses the reference position data P1i and P2i in the global coordinate system.
- step S111 the processing unit 39P of the sensor controller 39 determines whether or not the positioning by the global coordinate calculation device 23 is abnormal. This determination is as described above.
- step S112 the processing unit 39P of the sensor controller 39 determines whether or not the excavator 100 is traveling.
- the processing unit 39P determines that the excavator 100 is traveling, and both the travel lever 25FL and the travel lever 25FR are OFF. In this case, it is determined that the excavator 100 is not traveling, that is, stopped.
- step S112 When the excavator 100 is traveling (step S112, Yes), the process proceeds to step S113, where the position information calculation unit 39B and the posture angle calculation unit 39A of the sensor controller 39 obtain the position information IPL of the blade edge position calculation unit of the display controller 28. Does not output to 28A.
- the position of the specific point (the origin position PL in the embodiment) also moves together with the excavator 100. Therefore, the origin position PL after the movement is greater than the time point when it is determined No in step S101. This is different from the origin position PL stored in the storage unit 39M before a predetermined time.
- the reference position data P1i and P2i in the global coordinate system obtained using the origin position PL before the time point determined as No in step S101 is traveling. This is different from the actual reference position data P1 and P2 of the excavator 100.
- the position information calculation unit 39B and the posture angle calculation unit 39A do not output the position information IPL to the blade position calculation unit 28A of the display controller 28 when the excavator 100 is traveling.
- the cutting edge position calculation unit 28A of the display controller 28 does not generate the bucket cutting edge position data S, so the target excavation landform data generation unit 28B also does not generate the target excavation landform data U.
- the work machine controller 26 and the display controller 28 do not execute processing using the target excavation landform data U, for example, excavation control or display of the excavation assistance guidance screen on the display unit 29. .
- the control system 200 does not display the excavation control or the excavation assistance guidance screen based on a position different from the actual position.
- Step S113 corresponds to the third mode.
- the processing unit 39P of the sensor controller 39 returns to step S101 and executes the subsequent processing.
- step S111 when the positioning by the global coordinate arithmetic unit 23 is not abnormal, that is, normal (step S111, No), the processing unit 39P of the sensor controller 39 in step S114, the azimuth angle ⁇ di obtained in step S108.
- the reference position data P1i and P2i obtained in step S110 are stored in the storage unit 39M of the sensor controller 39.
- step S114 ends, the processing unit 39P of the sensor controller 39 returns to step S101 and executes the subsequent processing.
- step S114 the processing unit 39P of the sensor controller 39 uses the origin position PL before the time point determined as No in step S101. Only the reference position data P1i and P2i in the system are obtained.
- step S114 the processing unit 39P outputs the reference position data P1 and P2 acquired from the global coordinate calculation device 23 as the reference position data P1c and P2c to the cutting edge position calculation unit 28A of the display controller 28.
- step S115 the position information calculation unit 39B and the posture angle calculation unit 39A of the sensor controller 39 are obtained in step S108.
- the roll angle ⁇ 4, pitch angle ⁇ 5, azimuth angle ⁇ di ( ⁇ dc) and the reference position data P1i and P2i obtained in step S110 are output as position information IPL to the cutting edge position calculation unit 28A of the display controller 28.
- Step S115 corresponds to the second mode.
- step S116 the processing unit 39P of the sensor controller 39 determines whether or not to transit to the third mode.
- step S116 Yes
- step S113 the position information calculation unit 39B and the posture angle calculation unit 39A of the sensor controller 39 display the position information IPL. Is not output to the blade edge position calculation unit 28A.
- the processing unit 39P of the sensor controller 39 returns to Step S101 and executes the subsequent processing.
- FIG. 9 is a diagram illustrating transition of modes in which the sensor controller 39 operates.
- the sensor controller 39 operates in the first mode A.
- the sensor controller 39 starts from the operation in the first mode A to the third mode C. Transition to operation in (II).
- the sensor controller 39 transitions (III) from the operation in the first mode A to the operation in the second mode B. .
- the sensor controller 39 transitions from the operation in the second mode B to the operation in the first mode A (IV). .
- the sensor controller 39 shifts to the operation in the third mode C when the condition for shifting to the third mode is satisfied during the operation in the second mode B (V).
- the sensor controller 39 transitions to the operation in the first mode A when the positioning by the global coordinate calculation device 23 becomes normal (I).
- the conditions for transition to the third mode will be described in detail.
- the threshold value is not limited, but is 60 seconds, for example.
- the threshold value may be arbitrarily changed by an input device (not shown) of the display unit 29. The reason why the time tc2 operated in the second mode B exceeds the threshold in the condition for transition from the second mode B to the third mode C will be described later.
- the abnormality of the sensor of the excavator 100 is an abnormality related to at least one of a device that detects the operation of the excavator 100 and a device that determines the position of the excavator 100.
- the device that detects the operation of the excavator 100 include the IMU 24, pressure sensors 66, 27PC, 68, the first stroke sensor 16, the second stroke sensor 17, the third stroke sensor 18, and the sensor controller 39. It is not limited.
- Examples of devices for obtaining the position of the hydraulic excavator 100 include the GNSS antennas 21 and 22, the global coordinate calculation device 23, the sensor controller 39, the first stroke sensor 16, the second stroke sensor 17, and the third stroke sensor 18. It is not limited to.
- the device that detects the operation of the hydraulic excavator 100 and the device that determines the position of the hydraulic excavator 100 may realize both functions.
- a turning angle threshold for example, a specific angle of 250 degrees
- the second mode The condition for transition (V) from B to the third mode C is established.
- the specific angle corresponds to a turning angle threshold.
- the threshold value may be arbitrarily changed by an input device (not shown) of the display unit 29. The reason why the turn from the second mode B to the third mode C is made greater than the turn angle threshold in the same direction will be described later.
- the first condition to the fourth condition which are the conditions for transition (V) from the second mode B to the third mode C, have been described, but any one of the first condition to the fourth condition is satisfied.
- the second mode B transitions to the third mode C (V).
- FIG. 10 and FIG. 11 are diagrams for explaining conditions for transition to the third mode.
- the origin positions PLa (Xa, Ya, Za) and PLb (Xb, Yb, Zb) shown in FIG. 10 are all expressed in the global coordinate system.
- the origin position PLa in FIG. 10 is a position when the excavator 100 is stationary.
- the origin position PLa is stored in the storage unit 39M of the sensor controller 39, and the sensor controller 39 generates the position information IPL using the origin position PLa when the positioning by the global coordinate arithmetic unit 23 is abnormal. To do. Assume that the excavator 100 moves from the origin position PLa to the origin position PLb in this state.
- the actual origin position PL of the hydraulic excavator 100 is the origin position PLb, but when the positioning by the global coordinate calculation device 23 is abnormal, the sensor controller 39 uses the origin position PLa different from the actual origin position PLb.
- the position information IPL is generated. Therefore, when the excavator 100 travels while operating in the second mode, the sensor controller 39 shifts to the third mode, thereby using the origin position PLa different from the actual position information IPL. Avoid generating.
- An orientation DS in FIG. 11 indicates an orientation when the sensor controller 39 starts the operation in the second mode, and an orientation DE indicates that the upper swing body 3 is 180 in the same direction after the operation is started in the second mode.
- the direction when turning more than degrees is shown.
- the arrow RTa indicates the turning direction when the upper turning body 3 turns more than 180 degrees in the same direction.
- An arrow RTb indicates a turning direction when the upper turning body 3 turns in the direction opposite to the arrow RTa and becomes the direction DE.
- the attitude angle calculation unit 39A of the sensor controller 39 obtains the azimuth angle ⁇ di by integrating the turning angular velocity ⁇ with time. For this reason, if the amount by which the upper-part turning body 3 turns in the same direction increases, errors due to the characteristics of the IMU 24, that is, errors due to the integration of the turning angular velocity ⁇ , may accumulate, and the accuracy of the azimuth angle ⁇ di may decrease. There is.
- the upper swing body 3 is changed from the direction DS to the bearing DE, the upper swing body 3 has two turning directions.
- the operator of the excavator 100 normally employs a turning direction in which the amount of turning of the upper swing body 3 is less than 180 degrees. That is, in the example shown in FIG.
- the sensor controller 39 transitions to the third mode C. By such processing, the sensor controller 39 can reduce the error of the azimuth angle ⁇ di.
- the sensor controller 39 makes a transition to the third mode when the time tc2 in which the operation has been performed in the second mode B exceeds the threshold value. By such processing, the sensor controller 39 can reduce the error of the azimuth angle ⁇ di.
- the abnormality of the sensor for transitioning to the third mode is a communication abnormality between the IMU 24 and the sensor controller 39, and communication between the sensor controller 39 and other controllers (display controller 28, work machine controller 26, pump controller, etc.). Examples include abnormalities, abnormalities in the IMU 24, and abnormalities in the pressure sensors 66 and 27PC.
- FIG. 12 is a timing chart of processing executed by the sensor controller 39 when the upper swing body 3 is turned.
- a transition from the first mode A to the second mode B when the upper swing body 3 starts turning will be described.
- the sensor controller 39 uses reference position data in the global coordinate system using the origin position PL and the azimuth angle ⁇ div before the excavator 100 enters a non-static state. P1i and P2i are obtained.
- the sensor controller 39 does not transition to the second mode B but operates in the first mode A.
- the time from t1 to t0 corresponds to the predetermined time described above, and is, for example, 0.3 seconds. That is, the sensor controller 39 stores the reference position data P1i and P2i in the storage unit 39M at the time t0.
- the sensor controller 39 uses the reference position data P1 and P2 acquired from the global coordinate calculation device 23 and the turning angular velocity ⁇ detected by the IMU 24.
- the obtained azimuth angle ⁇ di is output. That is, the sensor controller 39 operates in the first mode A, and the second mode B is OFF.
- the sensor controller 39 makes a transition from the operation in the first mode A to the operation in the second mode B (the second mode B is ON).
- the operation of the sensor controller 39 is determined by the positioning state by the global coordinate calculation device 23 and the state of the hydraulic excavator 100.
- the mode shifts to the second mode B, and then the upper swing body 3 turns while operating in the second mode B.
- a case will be described in which the positioning becomes normal while the upper swing body 3 is turning without ending.
- the global coordinate calculation device 23 and the sensor controller 39 take time to process information. For this reason, the sensor controller 39 displays the position information IPL based on the detection value of the global coordinate arithmetic unit 23 even if the positioning becomes normal during the turning of the upper swing body 3 and at the same time the transition to the first mode A is performed. Cannot be sent immediately.
- the sensor controller 39 at least of the upper swing body 3 is used.
- the operation in the second mode B is continued until the turn is completed.
- the determination condition is whether the upper-part turning body 3 is in a turning state or in a turning end state (non-turning state). This determination is made as follows. When the left operating lever 25L is ON or the state where the absolute value of the turning angular velocity ⁇ is equal to or larger than the turning angular velocity threshold ⁇ d continues for the third time tc3, the upper turning body 3 is in the turning state.
- the turning angular velocity threshold value ⁇ d is not limited, in the embodiment, it is 3 degrees / second.
- the third time tc is not limited, but is 0.03 seconds, for example.
- the fourth time td is not limited, but is, for example, 1.5 seconds.
- the control system 200 uses the first mode for obtaining the position information IPL using the result of positioning by RTK-GNSS, and the position information IPL using the origin position PL and the azimuth angle ⁇ d when the positioning by RTK-GNSS is normal. In the second mode in which the position information IPL is not output. The control system 200 can implement backup in the second mode when an abnormality occurs in positioning by RTK-GNSS. Further, the position determined by the control system 200 and the hydraulic excavator 100 depending on the state where there is an abnormality in at least one of the device that detects the operation of the hydraulic excavator 100 and the device that determines the position of the hydraulic excavator 100 or the state in which the hydraulic excavator 100 travels.
- the control system 200 does not output the position information IPL in the third mode. For this reason, the work machine controller 26 does not execute excavation control using the target excavation landform data U, and the display controller 28 does not display the guidance screen for excavation assistance. As a result, the control system 200 accurately and continuously controls the work implement 2 when the information construction is being performed when performing the information construction based on the result of positioning the position of the excavator 100. At least one of displaying appropriate information on the work guidance screen can be realized.
- the control system 200 When the positioning by RTK-GNSS is normal, the control system 200 does not store the yaw angle output by the IMU 24, but from the measured values by the two GNSS antennas 21 and 22, the azimuth angle in the global coordinate system ( (Absolute azimuth) ⁇ d is obtained and stored. Since the upper turning body 3 has a high turning angular velocity ⁇ , the azimuth angle ⁇ di output from the IMU 24 includes an error. Therefore, the azimuth angle ⁇ d is obtained from the reference position data P1 and P2 obtained by the global coordinate calculation device 23 when the positioning by RTK-GNSS is normal. By such processing, the control system 200 can suppress a decrease in accuracy of the reference position data P1i and P2i obtained in the second mode when the upper swing body 3 is turning.
- the control system 200 can obtain the global coordinates obtained by the device. Using the azimuth angle ⁇ d in the system, the reference position data P1i and P2i after the positioning by RTK-GNSS becomes abnormal may be obtained.
- a geomagnetic sensor is exemplified as an apparatus for obtaining the azimuth angle ⁇ d in the global coordinate system. In this way, the sensor controller 39 does not need to store the azimuth angle ⁇ div obtained using the reference position data P1 and P2 obtained when the positioning by RTK-GNSS is normal in the storage unit 39M. Therefore, the processing load can be suppressed, and the storage capacity for storing the azimuth angle ⁇ div by the storage unit 39M can be reduced.
- the display controller 28 of the control system 200 may display the operation state of the sensor controller 39 on the display unit 29 shown in FIG.
- the display controller 28 causes the display unit 29 to display whether the operation of the sensor controller 39 is the first mode, the second mode, or the third mode.
- the operator of the excavator 100 can grasp what mode it is currently in.
- the positioning by the RTK-GNSS is normal for the sensor controller 39 of the control system 200.
- the origin position PL and the azimuth angle ⁇ da before that are set.
- Only the position information IPL is calculated by using the reference position data P1 and P2 measured by the RTK-GNSS and output to the display controller 28 as the position information IPL.
- This operation of the sensor controller 39 is referred to as a fourth mode.
- the display controller 28 may display on the display unit 29 that the operation of the sensor controller 39 is the fourth mode. Good. By such processing, the operator of the excavator 100 can grasp in more detail which mode is currently in effect.
- the control system 200 may include a communication device that communicates with a server of a management device provided outside the excavator 100, and may exchange information with the management device server.
- Information exchanged between the control system 200 and the server of the management apparatus includes information regarding the state of the excavator 100 and various commands transmitted from the server of the management apparatus to the control system 200 to operate the control system 200.
- the control system 200 includes a communication device that communicates with the management device server, information such as the positioning state by RTK-GNSS, the number of times the first mode to the fourth mode are executed, the execution time, and the execution time May be sent to the server of the management device.
- each process executed by the sensor controller 39 may be executed by the work machine controller 26, the display controller 28, the pump controller, or other controllers.
- the work machine is not limited to the hydraulic excavator 100, and may be another work machine such as a wheel loader or a bulldozer.
- the attitude angle calculation unit 39A and the position information calculation unit 39B shown in FIG. 5 are provided in the sensor controller 39, but either one or both may be provided in the display controller 28, or a controller other than the display controller 28. May be provided.
Landscapes
- Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Operation Control Of Excavators (AREA)
- Component Parts Of Construction Machinery (AREA)
- Fluid Mechanics (AREA)
Abstract
Description
図1は、実施形態に係る作業機械の斜視図である。図2は、油圧ショベル100の制御システム200及び油圧システム300の構成を示すブロック図である。作業機械としての油圧ショベル100は、本体部としての車両本体1と作業機2とを有する。車両本体1は、旋回体である上部旋回体3と走行体としての走行装置5とを有する。上部旋回体3は、機関室3EGの内部に、動力発生装置であるエンジン及び油圧ポンプ等の装置を収容している。
図5は、実施形態に係る制御システム200の制御ブロック図である。図6及び図7は、油圧ショベル100の姿勢を示す平面図である。実施形態において、制御システム200の作業機コントローラ26と、表示コントローラ28と、センサコントローラ39とは、信号線を介して互いに情報をやり取りすることができる。また、センサコントローラ39は、グローバル座標演算装置23から信号線を介して情報を取得することができる。制御システム200内で情報を伝達する信号線は、CAN(Controller Area Network)のような車内信号線が例示される。実施形態において、制御システム200は、作業機コントローラ26と、表示コントローラ28とが別個の装置であるが、両者は1つの装置で実現されてもよい。
Rfl=Clb(Rfb-Rab)+Ral・・・(2)
Ralc=Clb(Rab-Rfb)+Rfl・・・(3)
ここで、
Rfb:ローカル座標系における原点位置PLの位置ベクトルの校正値
Rab:ローカル座標系におけるGNSSアンテナ21、22の位置ベクトルの校正値
Rfl:グローバル座標系における原点位置PLの位置ベクトルの計算値
Ral:グローバル座標系におけるGNSSアンテナ21、22の位置ベクトルの測定値
Ralc:グローバル座標系におけるGNSSアンテナ21、22の位置ベクトルの計算値
Clb:ローカル座標系からグローバル座標系への座標回転行列
図8は、実施形態に係る制御システム200が位置情報IPLを生成する処理の一例を示すフローチャートである。ステップS101において、センサコントローラ39の処理部39Pは、グローバル座標演算装置23による測位が正常かつ油圧ショベル100が静定状態であるか否かを判定する。グローバル座標演算装置23による測位が正常であるか否かは、次のように判定される。
(1)グローバル座標演算装置23の測位に関するいずれかのエラーが発生している場合又はGNSSアンテナ21、22のZ方向における座標データの値が閾値を超えている場合には、グローバル座標演算装置23による測位が異常である。GNSSアンテナ21、22のZ方向における座標データの値が閾値以下である場合には、グローバル座標演算装置23による測位が異常であるとしてもよい。
(2)グローバル座標演算装置23の測位に関するエラーが発生していない場合かつGNSSアンテナ21、22のZ方向における座標データの値が閾値を下回っている場合には、グローバル座標演算装置23による測位が正常である。GNSSアンテナ21、22のZ方向における座標データの値が閾値を超えている場合には、グローバル座標演算装置23による測位が正常であるとしてもよい。
(1)左操作レバー25Lが左右のいずれかに操作されて左操作レバー25LがONである場合、又は走行用レバー25FL及び走行用レバー25FRの少なくとも一方がONである場合、又は旋回角速度ωの絶対値が旋回角速度閾値ωc以上となる状態が第1時間ta継続した場合には、油圧ショベル100が非静定状態、すなわち動的状態である。旋回角速度閾値ωcは限定されるものではないが、実施形態では1度/秒である。第1時間taは限定されるものではないが、例えば0.03秒である。旋回角速度ωの絶対値が旋回角速度閾値ωc以上となる状態が第1時間ta継続した場合を非静定状態であることを判断条件の一つに入れた理由は、次の事由による。オペレータが、上部旋回体3を旋回させるために左操作レバー25Lを操作している状態から旋回を止めるために左操作レバー25Lから手を放したとする。このとき、左操作レバー25Lは中立位置になり、左操作レバー25LはOFFとなる。しかし、この時点では、上部旋回体3が、慣性力により、ある程度の時間、旋回している状態が想定される。つまり、この状態は、油圧ショベル100は動的状態と言える。したがって、各操作レバーのON/OFFだけでなく、旋回角加速度ωの絶対値が、所定の閾値以上となる状態が所定の時間継続した場合を非静定であることを判断条件の一つに入れている。
(2)左操作レバー25Lが左右のいずれにも操作されず左操作レバー25LがOFFであって、かつ走行用レバー25FL及び走行用レバー25FRの両方がOFFであり、さらに旋回角速度ωの絶対値が旋回角速度閾値ωc未満となる状態が第2時間tb継続した場合には、油圧ショベル100が静定状態、すなわち静的状態である。第2時間tbは限定されるものではないが、第1時間taよりも大きく、例えば4秒である。
図9は、センサコントローラ39が動作するモードの遷移を示す図である。グローバル座標演算装置23による測位が正常かつ油圧ショベル100が静定状態である場合に、センサコントローラ39は第1のモードAで動作する。グローバル座標演算装置23による測位が異常かつ油圧ショベル100が非静定状態、より具体的には走行状態であるときに、センサコントローラ39は、第1のモードAでの動作から第3のモードCでの動作に遷移(II)する。グローバル座標演算装置23による測位が異常かつ油圧ショベル100が非走行状態であるときに、センサコントローラ39は、第1のモードAでの動作から第2のモードBでの動作に遷移(III)する。グローバル座標演算装置23による測位が正常かつ油圧ショベル100が非旋回状態であるときに、センサコントローラ39は、第2のモードBでの動作から第1のモードAでの動作に遷移する(IV)。センサコントローラ39は、第2のモードBでの動作中、第3のモードに遷移する条件が成立したら、第3のモードCでの動作に遷移する(V)。センサコントローラ39は、第3のモードCでの動作中、グローバル座標演算装置23による測位が正常になると、第1のモードAでの動作に遷移する(I)。
(1)第2のモードBで動作した時間tc2が閾値を超えた場合(第1条件)又は油圧ショベル100が走行した場合(第2条件)又は油圧ショベル100のセンサに異常があった場合(第3条件)に、第2のモードBから第3のモードCに遷移(V)する条件が成立する。閾値は限定されるものではないが、例えば、60秒である。例えば、表示部29の図示しない入力装置によって、この閾値の大きさを任意に変更できるようにしてもよい。このように第2のモードBから第3のモードCに遷移する条件に、第2のモードBで動作した時間tc2が閾値を超えたかどうかを入れている理由については後述する。実施形態において、油圧ショベル100のセンサの異常とは、油圧ショベル100の動作を検出する機器及び油圧ショベル100の位置を求める機器の少なくとも一方に関する異常である。油圧ショベル100の動作を検出する機器は、IMU24、圧力センサ66、27PC、68、第1ストロークセンサ16、第2ストロークセンサ17、第3ストロークセンサ18及びセンサコントローラ39が例示されるが、これらに限定されるものではない。油圧ショベル100の位置を求める機器は、GNSSアンテナ21、22、グローバル座標演算装置23、センサコントローラ39、第1ストロークセンサ16、第2ストロークセンサ17、第3ストロークセンサ18が例示されるが、これらに限定されるものではない。油圧ショベル100の動作を検出する機器と油圧ショベル100の位置を求める機器とは、共通する機器が両方の機能を実現してもよい。
(2)第2のモードBで動作中、上部旋回体3が同一方向に旋回角度の閾値(例えば、特定角度として250度)よりも大きく旋回した場合(第4条件)に、第2のモードBから第3のモードCに遷移(V)する条件が成立する。特定角度は、旋回角度の閾値に対応する。例えば、表示部29の図示しない入力装置によって、この閾値の大きさを任意に変更できるようにしてもよい。このように第2のモードBから第3のモードCに遷移する条件に、同一方向に旋回角度の閾値よりも大きく旋回したかどうかを入れている理由については後述する。以上のように、第2のモードBから第3のモードCに遷移(V)する条件である、第1条件から第4条件について説明したが、第1条件から第4条件のいずれかが成立した場合に、第2のモードBから第3のモードCに遷移(V)する。
2 作業機
3 上部旋回体
5 走行装置
5a、5b 履帯
5c 油圧モータ
6 ブーム
7 アーム
8 バケット
8B 刃
8T 刃先
21、22 アンテナ(GNSSアンテナ)
23 グローバル座標演算装置
25 操作装置
25R 右操作レバー
25L 左操作レバー
25FL、25FR 走行用レバー
26 作業機コントローラ
27PC、66、68 圧力センサ
28 表示コントローラ
28A 刃先位置算出部
28B 目標掘削地形データ生成部
28C 目標施工情報格納部
29 表示部
39 センサコントローラ
39A 姿勢角演算部
39B 位置情報演算部
100 油圧ショベル
200 制御システム
Clb 座標回転行列
IPL 位置情報
MI 動作情報
P、P1、P1c、P1i、P2、P2c、P2i 基準位置データ
PL、PLb 原点位置
θ4 ロール角
θ5 ピッチ角
θd、θda、θdc、θdi、θdia、θdib 方位角
ω 旋回角速度
Claims (13)
- 作業具を有する作業機及び走行装置を備える作業機械を制御するシステムであって、
前記作業機械の位置を検出する位置検出装置と、
前記作業機械の動作を示す動作情報を検出する状態検出装置と、
前記位置検出装置によって検出された位置の情報を前記作業機械の位置に関連する位置情報として出力する第1のモードと、前記位置検出装置による測位が異常となる前における前記作業機械の基準となる特定点及び前記状態検出装置によって検出された前記動作情報の両方を用いて求めた位置の情報を前記位置情報として出力する第2のモードと、前記位置情報を出力しない第3のモードと、のいずれか1つで動作し、
前記位置検出装置による測位が正常である場合は前記第1のモードで、前記位置検出装置による測位が異常かつ前記作業機械が静定状態である場合には前記第2のモードで、前記位置検出装置による測位が異常かつ前記作業機械が非静定状態である場合には前記第3のモードで動作する位置情報生成部と、
前記位置情報生成部から得られる前記位置情報に基づき前記作業機の位置を求める目標値生成部と、
を含む、作業機械の制御システム。 - 前記位置情報生成部は、
前記第2のモードで動作中に、前記作業機械の動作を検出する機器及び前記作業機械の位置を求める機器の少なくとも一方に関する異常があった場合、前記第3のモードで動作する、
請求項1に記載の作業機械の制御システム。 - 前記作業機械は、前記作業機が取り付けられ、かつ前記走行装置に取り付けられて、前記走行装置の上に搭載されて旋回する旋回体を備え、
前記特定点は、前記位置検出装置による測位が異常となる前における、前記旋回体の回転中心軸と前記走行装置が接地する面に対応する面との交点であり、
位置情報生成部は、さらに、前記第2のモードで動作中に前記位置検出装置による測位が正常になった場合は前記第1のモードで、前記第2のモードで動作中に前記作業機械が走行した場合を条件として前記第3のモードで動作する、
請求項1に記載の作業機械の制御システム。 - 前記位置情報生成部は、
前記条件に代えて、前記作業機械の動作を検出する機器及び前記作業機械の位置を求める機器の少なくとも一方に関する異常があった場合を条件として、前記第3のモードで動作する、
請求項3に記載の作業機械の制御システム。 - 走行装置、作業具を有する作業機、前記作業機が取り付けられ、かつ前記走行装置の上に搭載されて旋回する旋回体を備える作業機械を制御するシステムであって、
前記作業機械の位置を検出する位置検出装置と、
前記作業機械の動作を検出し、検出した動作を示す動作情報を検出する状態検出装置と、
前記位置検出装置によって検出された位置の情報を前記作業機械の位置に関連する位置情報として出力する第1のモードと、前記位置検出装置による測位が異常となる前における前記作業機械の基準となる特定点及び前記状態検出装置によって検出された前記動作情報の両方を用いて求めた位置の情報を前記位置情報として出力する第2のモードと、前記位置情報を出力しない第3のモードと、のいずれか1つで動作し、
前記第2のモードで動作中に前記位置検出装置による測位が正常になった場合は前記第1のモードで、前記第2のモードで動作中に前記作業機械が非静定状態となった場合を条件として前記第3のモードで動作する位置情報生成部と、
前記位置情報生成部から得られる前記位置情報に基づき前記作業機の位置を求める目標値生成部と、
を含む、作業機械の制御システム。 - 前記位置情報生成部は、
前記旋回体の旋回中、前記第2のモードで動作中に前記位置検出装置による測位が正常になった場合は、少なくとも前記旋回体の旋回が終了するまで前記第2のモードでの動作を継続する、請求項5に記載の作業機械の制御システム。 - 前記位置情報生成部は、
前記条件に代えて、前記第2のモードで動作中、前記作業機械の動作を検出する機器及び前記作業機械の位置を求める機器の少なくとも一方に関する異常があった場合を条件として、前記第3のモードで動作する、
請求項5に記載の作業機械の制御システム。 - 前記位置情報生成部は、
前記条件に代えて、前記第2のモードで動作した時間が閾値を超えた場合を条件として、前記第3のモードで動作する、
請求項5に記載の作業機械の制御システム。 - 前記位置情報生成部は、
前記条件に代えて、前記第2のモードで動作中、前記旋回体が同一方向に特定角度よりも大きく旋回した場合を条件として、前記作業機械の位置を出力しない、
請求項5に記載の作業機械の制御システム。 - 走行装置、作業具を有する作業機、前記作業機が取り付けられ、かつ前記走行装置の上に搭載されて旋回する旋回体を備える作業機械を制御するシステムであって、
前記作業機械の位置を検出する位置検出装置と、
前記作業機械の動作を検出し、検出した動作を示す動作情報を検出する状態検出装置と、
前記位置検出装置によって検出された位置の情報を前記作業機械の位置に関連する位置情報として出力する第1のモードと、前記位置検出装置による測位が異常となる前における前記作業機械の基準となる位置であって、前記旋回体の回転中心軸と前記走行装置が接地する面に相当する面との交点である特定点及び前記状態検出装置によって検出された前記動作情報の両方を用いて求めた位置の情報を前記位置情報として出力する第2のモードと、前記位置情報を出力しない第3のモードと、のいずれか1つを、前記位置検出装置による測位の状態及び前記作業機械の状態を用いて選択して動作する位置情報生成部と、
前記位置情報生成部から得られる前記位置情報に基づき前記作業機の位置を求める目標値生成部と、
を含む、作業機械の制御システム。 - 前記位置情報生成部は、
前記作業機械が静定状態かつ前記位置検出装置による測位が正常である場合には前記第1のモードで動作し、かつ前記特定点を求め、
前記作業機械が非静定状態又は前記位置検出装置による測位が異常になった場合に、前記特定点を用いて前記第2のモードで動作する、
請求項10に記載の作業機械の制御システム。 - 前記位置情報生成部は、
前記旋回体を操作する操作装置がONである場合、又は前記走行装置を操作する操作装置がONである場合、又は前記旋回体が旋回する速度が閾値以上である状態が第1時間継続した場合、前記非静定状態であると判定し、
前記旋回体を操作する操作装置がOFFであって、かつ前記走行装置を操作する操作装置がOFFであり、さらに前記旋回体が旋回する速度が閾値未満である状態が第2時間継続した場合、前記静定状態であると判定する、
請求項11に記載の作業機械の制御システム。 - 請求項1から請求項12のいずれか1項に記載の作業機械の制御システムを備える、作業機械。
Priority Applications (6)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020157024051A KR101833603B1 (ko) | 2015-05-29 | 2015-05-29 | 작업 기계의 제어 시스템 및 작업 기계 |
DE112015000055.0T DE112015000055B4 (de) | 2015-05-29 | 2015-05-29 | Steuersystem einer Arbeitsmaschine und Arbeitsmaschine |
JP2015528784A JP6162807B2 (ja) | 2015-05-29 | 2015-05-29 | 作業機械の制御システム及び作業機械 |
PCT/JP2015/065637 WO2015167022A1 (ja) | 2015-05-29 | 2015-05-29 | 作業機械の制御システム及び作業機械 |
US14/778,724 US10145088B2 (en) | 2015-05-29 | 2015-05-29 | Control system of work machine and work machine |
CN201580000306.XA CN105518226B (zh) | 2015-05-29 | 2015-05-29 | 作业机械的控制系统和作业机械 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2015/065637 WO2015167022A1 (ja) | 2015-05-29 | 2015-05-29 | 作業機械の制御システム及び作業機械 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2015167022A1 true WO2015167022A1 (ja) | 2015-11-05 |
Family
ID=54358742
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2015/065637 WO2015167022A1 (ja) | 2015-05-29 | 2015-05-29 | 作業機械の制御システム及び作業機械 |
Country Status (6)
Country | Link |
---|---|
US (1) | US10145088B2 (ja) |
JP (1) | JP6162807B2 (ja) |
KR (1) | KR101833603B1 (ja) |
CN (1) | CN105518226B (ja) |
DE (1) | DE112015000055B4 (ja) |
WO (1) | WO2015167022A1 (ja) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI579670B (zh) * | 2015-11-10 | 2017-04-21 | 遠東科技大學 | 監控機台異常狀態方法及其系統 |
WO2019044316A1 (ja) * | 2017-09-01 | 2019-03-07 | 株式会社小松製作所 | 作業機械の計測システム、作業機械、及び作業機械の計測方法 |
WO2021192831A1 (ja) * | 2020-03-27 | 2021-09-30 | 日立建機株式会社 | 作業機械 |
WO2022085688A1 (ja) | 2020-10-20 | 2022-04-28 | 日立建機株式会社 | 建設機械 |
KR20230171035A (ko) | 2021-07-08 | 2023-12-19 | 가부시키가이샤 고마쓰 세이사쿠쇼 | 작업 기계의 제어 시스템, 작업 기계, 및 작업 기계의 제어 방법 |
KR20240009502A (ko) | 2021-07-08 | 2024-01-22 | 가부시키가이샤 고마쓰 세이사쿠쇼 | 작업 기계의 제어 시스템, 작업 기계, 및 작업 기계의 제어 방법 |
JP7419119B2 (ja) | 2020-03-16 | 2024-01-22 | 日立建機株式会社 | 作業機械 |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9206587B2 (en) * | 2012-03-16 | 2015-12-08 | Harnischfeger Technologies, Inc. | Automated control of dipper swing for a shovel |
US11441294B2 (en) * | 2016-10-31 | 2022-09-13 | Komatsu Ltd. | Measurement system, work machine, and measurement method |
US10619330B2 (en) * | 2016-11-08 | 2020-04-14 | Guangxi Liugong Machinery Co., Ltd. | Multiple level work hydraulics anti-stall |
JP6714534B2 (ja) * | 2017-03-29 | 2020-06-24 | 日立建機株式会社 | 建設機械 |
WO2019012651A1 (ja) * | 2017-07-13 | 2019-01-17 | 株式会社小松製作所 | 油圧ショベルおよび油圧ショベルの較正方法 |
US9943022B1 (en) * | 2017-08-02 | 2018-04-17 | Caterpillar Trimble Control Technologies Llc | Determining yaw and center-of-rotation of a rotating platform using a single position sensor |
JP6807290B2 (ja) * | 2017-09-14 | 2021-01-06 | 日立建機株式会社 | 作業機械 |
EP3760567A4 (en) * | 2018-02-28 | 2021-11-17 | Tadano Ltd. | CRANE |
JP6961636B2 (ja) * | 2019-03-01 | 2021-11-05 | 日立建機株式会社 | 作業機械 |
JP7229109B2 (ja) * | 2019-06-19 | 2023-02-27 | 株式会社小松製作所 | 作業機械および作業機械の制御方法 |
CN113454298B (zh) * | 2019-09-26 | 2022-09-27 | 日立建机株式会社 | 作业机械 |
US20220333338A1 (en) * | 2020-03-24 | 2022-10-20 | Hitachi Construction Machinery Co., Ltd. | Work machine |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004125580A (ja) * | 2002-10-02 | 2004-04-22 | Hitachi Constr Mach Co Ltd | 作業機械の位置計測システム |
JP2004212294A (ja) * | 2003-01-07 | 2004-07-29 | Hitachi Constr Mach Co Ltd | 走行式建設機械の位置計測システム |
JP2005267568A (ja) * | 2004-03-22 | 2005-09-29 | Kobelco Contstruction Machinery Ltd | 移動式作業機械の盗難防止装置及び同装置を備えた移動式作業機械 |
JP2007147588A (ja) * | 2005-11-01 | 2007-06-14 | Hitachi Constr Mach Co Ltd | 作業機械の位置計測システム |
Family Cites Families (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4920655A (en) * | 1984-07-30 | 1990-05-01 | Applied Technologies Associates | High speed well surveying and land navigation |
US5742915A (en) * | 1995-12-13 | 1998-04-21 | Caterpillar Inc. | Position referenced data for monitoring and controlling |
DE19830858A1 (de) * | 1998-07-10 | 2000-01-13 | Claas Selbstfahr Erntemasch | Vorrichtung und Verfahren zur Bestimmung einer virtuellen Position |
US8478492B2 (en) * | 1998-11-27 | 2013-07-02 | Caterpillar Trimble Control Technologies, Inc. | Method and system for performing non-contact based determination of the position of an implement |
US6711838B2 (en) * | 2002-07-29 | 2004-03-30 | Caterpillar Inc | Method and apparatus for determining machine location |
US9002565B2 (en) | 2003-03-20 | 2015-04-07 | Agjunction Llc | GNSS and optical guidance and machine control |
JPWO2005043433A1 (ja) | 2003-10-31 | 2007-05-10 | 株式会社小松製作所 | 作業機械の管理システム及び作業機械 |
US7139651B2 (en) | 2004-03-05 | 2006-11-21 | Modular Mining Systems, Inc. | Multi-source positioning system for work machines |
FR2886858A1 (fr) * | 2005-06-09 | 2006-12-15 | Ela Medical Soc Par Actions Si | Dispositif medical implantable actif tel que stimulateur cardiaque, cardioverteur et/ou defibrillateur de type aai ou aai/ddd a detection des tachycardies ventriculaires |
JP4100425B2 (ja) | 2005-11-22 | 2008-06-11 | コベルコ建機株式会社 | 作業機械の制御装置 |
JP4931048B2 (ja) | 2006-07-31 | 2012-05-16 | キャタピラー エス エー アール エル | 作業機械の制御装置 |
US8473166B2 (en) * | 2009-05-19 | 2013-06-25 | Topcon Positioning Systems, Inc. | Semiautomatic control of earthmoving machine based on attitude measurement |
JP5603520B1 (ja) * | 2012-10-19 | 2014-10-08 | 株式会社小松製作所 | 油圧ショベルの掘削制御システム |
CA2804408C (en) * | 2013-02-04 | 2014-05-06 | Avant Tecno Oy | Mobile machine, braking system and method of controlling mobile machine |
US9251587B2 (en) * | 2013-04-05 | 2016-02-02 | Caterpillar Inc. | Motion estimation utilizing range detection-enhanced visual odometry |
JP5789279B2 (ja) | 2013-04-10 | 2015-10-07 | 株式会社小松製作所 | 掘削機械の施工管理装置、油圧ショベルの施工管理装置、掘削機械及び施工管理システム |
-
2015
- 2015-05-29 JP JP2015528784A patent/JP6162807B2/ja active Active
- 2015-05-29 DE DE112015000055.0T patent/DE112015000055B4/de active Active
- 2015-05-29 US US14/778,724 patent/US10145088B2/en active Active
- 2015-05-29 WO PCT/JP2015/065637 patent/WO2015167022A1/ja active Application Filing
- 2015-05-29 KR KR1020157024051A patent/KR101833603B1/ko active IP Right Grant
- 2015-05-29 CN CN201580000306.XA patent/CN105518226B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004125580A (ja) * | 2002-10-02 | 2004-04-22 | Hitachi Constr Mach Co Ltd | 作業機械の位置計測システム |
JP2004212294A (ja) * | 2003-01-07 | 2004-07-29 | Hitachi Constr Mach Co Ltd | 走行式建設機械の位置計測システム |
JP2005267568A (ja) * | 2004-03-22 | 2005-09-29 | Kobelco Contstruction Machinery Ltd | 移動式作業機械の盗難防止装置及び同装置を備えた移動式作業機械 |
JP2007147588A (ja) * | 2005-11-01 | 2007-06-14 | Hitachi Constr Mach Co Ltd | 作業機械の位置計測システム |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI579670B (zh) * | 2015-11-10 | 2017-04-21 | 遠東科技大學 | 監控機台異常狀態方法及其系統 |
WO2019044316A1 (ja) * | 2017-09-01 | 2019-03-07 | 株式会社小松製作所 | 作業機械の計測システム、作業機械、及び作業機械の計測方法 |
JPWO2019044316A1 (ja) * | 2017-09-01 | 2020-08-20 | 株式会社小松製作所 | 作業機械の計測システム、作業機械、及び作業機械の計測方法 |
JP7104050B2 (ja) | 2017-09-01 | 2022-07-20 | 株式会社小松製作所 | 作業機械の計測システム、作業機械、及び作業機械の計測方法 |
US11195351B2 (en) | 2017-09-01 | 2021-12-07 | Komatsu Ltd. | Work machine measurement system, work machine, and measuring method for work machine |
JP7419119B2 (ja) | 2020-03-16 | 2024-01-22 | 日立建機株式会社 | 作業機械 |
JP7030149B2 (ja) | 2020-03-27 | 2022-03-04 | 日立建機株式会社 | 作業機械 |
JP2021156011A (ja) * | 2020-03-27 | 2021-10-07 | 日立建機株式会社 | 作業機械 |
WO2021192831A1 (ja) * | 2020-03-27 | 2021-09-30 | 日立建機株式会社 | 作業機械 |
WO2022085688A1 (ja) | 2020-10-20 | 2022-04-28 | 日立建機株式会社 | 建設機械 |
KR20230044502A (ko) | 2020-10-20 | 2023-04-04 | 히다찌 겐끼 가부시키가이샤 | 건설 기계 |
KR20230171035A (ko) | 2021-07-08 | 2023-12-19 | 가부시키가이샤 고마쓰 세이사쿠쇼 | 작업 기계의 제어 시스템, 작업 기계, 및 작업 기계의 제어 방법 |
KR20240009502A (ko) | 2021-07-08 | 2024-01-22 | 가부시키가이샤 고마쓰 세이사쿠쇼 | 작업 기계의 제어 시스템, 작업 기계, 및 작업 기계의 제어 방법 |
DE112022001876T5 (de) | 2021-07-08 | 2024-02-08 | Komatsu Ltd. | Steuersystem für arbeitsmaschine, arbeitsmaschine und verfahren zur steuerung einer arbeitsmaschine |
DE112022002116T5 (de) | 2021-07-08 | 2024-04-11 | Komatsu, Ltd. | Steuersystem für arbeitsmaschine, arbeitsmaschine und verfahren zur steuerung einer arbeitsmaschine |
Also Published As
Publication number | Publication date |
---|---|
DE112015000055T5 (de) | 2016-01-14 |
KR20160140332A (ko) | 2016-12-07 |
CN105518226A (zh) | 2016-04-20 |
DE112015000055B4 (de) | 2019-05-16 |
US10145088B2 (en) | 2018-12-04 |
US20160348343A1 (en) | 2016-12-01 |
JPWO2015167022A1 (ja) | 2017-04-20 |
CN105518226B (zh) | 2018-02-02 |
JP6162807B2 (ja) | 2017-07-12 |
KR101833603B1 (ko) | 2018-02-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6162807B2 (ja) | 作業機械の制御システム及び作業機械 | |
JP5909029B1 (ja) | 作業機械の制御システム及び作業機械の制御方法 | |
JP6289534B2 (ja) | 作業機械の制御システム及び作業機械 | |
JP6058217B2 (ja) | 作業車両、バケット装置及びチルト角度の取得方法 | |
JP5969712B1 (ja) | 作業車両および作業車両の制御方法 | |
US9411325B2 (en) | Excavation control system for hydraulic excavator | |
WO2017047826A1 (ja) | 作業機械の表示システム及び作業機械 | |
CN107109825B (zh) | 挖土机及挖土机的控制方法 | |
US9689145B1 (en) | Work vehicle and method for obtaining tilt angle | |
US10106952B2 (en) | Work machine control system, work machine, and work machine control method | |
CN113167052B (zh) | 作业机械 | |
JP7228450B2 (ja) | ショベル | |
JP7135056B2 (ja) | 作業機械の表示システム及び作業機械 | |
JP7143117B2 (ja) | ショベル | |
WO2021210427A1 (ja) | 施工方法及び施工システム | |
CN117836488A (zh) | 用于控制作业机械的系统以及方法 | |
CN117795165A (zh) | 用于控制作业机械的系统以及方法 | |
CN117836489A (zh) | 用于控制作业机械的系统以及方法 | |
CN117881849A (zh) | 用于控制作业机械的系统、方法以及程序 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
ENP | Entry into the national phase |
Ref document number: 2015528784 Country of ref document: JP Kind code of ref document: A |
|
ENP | Entry into the national phase |
Ref document number: 20157024051 Country of ref document: KR Kind code of ref document: A |
|
WWE | Wipo information: entry into national phase |
Ref document number: 14778724 Country of ref document: US |
|
WWE | Wipo information: entry into national phase |
Ref document number: 1120150000550 Country of ref document: DE Ref document number: 112015000055 Country of ref document: DE |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 15785675 Country of ref document: EP Kind code of ref document: A1 |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 15785675 Country of ref document: EP Kind code of ref document: A1 |