WO2022085688A1 - 建設機械 - Google Patents

建設機械 Download PDF

Info

Publication number
WO2022085688A1
WO2022085688A1 PCT/JP2021/038634 JP2021038634W WO2022085688A1 WO 2022085688 A1 WO2022085688 A1 WO 2022085688A1 JP 2021038634 W JP2021038634 W JP 2021038634W WO 2022085688 A1 WO2022085688 A1 WO 2022085688A1
Authority
WO
WIPO (PCT)
Prior art keywords
angle
calculation
accuracy
required accuracy
imu
Prior art date
Application number
PCT/JP2021/038634
Other languages
English (en)
French (fr)
Inventor
新士 石原
枝穂 泉
靖彦 金成
Original Assignee
日立建機株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 日立建機株式会社 filed Critical 日立建機株式会社
Priority to US18/024,098 priority Critical patent/US20240102266A1/en
Priority to KR1020237007253A priority patent/KR20230044502A/ko
Priority to CN202180053562.0A priority patent/CN116034201A/zh
Priority to EP21882829.1A priority patent/EP4234819A1/en
Publication of WO2022085688A1 publication Critical patent/WO2022085688A1/ja

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/267Diagnosing or detecting failure of vehicles
    • E02F9/268Diagnosing or detecting failure of vehicles with failure correction follow-up actions
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/264Sensors and their calibration for indicating the position of the work tool
    • E02F9/265Sensors and their calibration for indicating the position of the work tool with follow-up actions (e.g. control signals sent to actuate the work tool)
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2025Particular purposes of control systems not otherwise provided for
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2203Arrangements for controlling the attitude of actuators, e.g. speed, floating function
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/24Safety devices, e.g. for preventing overload
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60YINDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2200/00Type of vehicle
    • B60Y2200/40Special vehicles
    • B60Y2200/41Construction vehicles, e.g. graders, excavators
    • B60Y2200/412Excavators
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • E02F3/437Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like providing automatic sequences of movements, e.g. linear excavation, keeping dipper angle constant

Definitions

  • the present invention relates to a construction machine provided with a work device whose position and posture change, and more specifically, an operator operation support based on various information including angle information output from a measuring device attached to the work device or the like. Regarding construction machinery.
  • 3D computerized construction When providing operation support such as machine guidance and machine control, the one that uses the coordinates of the own vehicle at the construction site is called 3D computerized construction (hereinafter referred to as 3D computerized construction).
  • Construction machines that support 3D computerized construction are equipped with a satellite positioning system (Global Navigation Satellite System: GNSS) in order to acquire the position of the own vehicle.
  • GNSS Global Navigation Satellite System
  • GNSS receives positioning signals from a plurality of satellites and measures the three-dimensional position (latitude, longitude, altitude) of the own vehicle.
  • a work device such as a hydraulic excavator
  • a construction machine equipped with two GNSS antennas for receiving positioning signals and specifying the direction of the working device based on the positioning signals received by them is known.
  • IMU Inertial measurement unit
  • the machine guidance calculates the position and posture of the hydraulic excavator by using GNSS and IMU together, and presents the information to the operator. Therefore, if the position information acquired from the GNSS or the angle information acquired from the IMU deviates from the actual information, inaccurate information will be presented to the operator. If the operator continues the excavation work based on inaccurate information, there is a concern that the construction may need to be redone because the ground is dug too much for the target construction surface or the excavation amount is insufficient. ..
  • Patent Document 1 The technique described in Patent Document 1 is known for such a problem.
  • the work machine described in Patent Document 1 accurately and continuously controls a work device (work machine) when executing computerized construction, and displays appropriate information on a work guidance screen at least one of them.
  • a position detection device that detects the position of the own vehicle (working machine) using GNSS
  • IMU state detection device
  • the position information used for generating the position data of the work machine is selected according to the positioning state of the position detection device and the operation state of the work machine.
  • the position information detected by the position detection device is used as the position information, while the positioning is abnormal and the work machine.
  • the position information detected by the position detection device is used as the position information, while the positioning is abnormal and the work machine.
  • both the specific point that serves as a reference for the work machine before the positioning becomes abnormal and the operation information detected by the state detection unit (IMU) are used.
  • the obtained position information is used as the position information.
  • the positioning is abnormal and the work machine is in a non-statically determinate state (in the case of the third mode)
  • the position information is not provided.
  • Patent Document 1 uses the position information as operation support (machine guidance) only when the position information of the work machine used for data generation of the position of the work machine (for example, the position of the cutting edge of the bucket) is accurate. It is to be used.
  • position information of the work machine used for data generation of the position of the work machine for example, the position of the cutting edge of the bucket
  • the IMU may be used as a sensor for acquiring the angle information of the construction machine.
  • the IMU is a device provided with two sensors, an acceleration sensor and an angular velocity sensor, and also has an angle calculation function for calculating an angle by using the acceleration detected by the acceleration sensor and the angular velocity detected by the angular velocity sensor.
  • the IMU calculates the angle by switching or combining the following two calculation methods.
  • the first method is to calculate an angle with respect to a reference plane (for example, a horizontal plane) by comparing the acceleration detected by the acceleration sensor with the gravitational acceleration.
  • the second method calculates the angle by integrating the angular velocity detected by the angular velocity sensor.
  • the second method can only calculate the angle change starting from a certain angle when the construction machine is stationary. Therefore, it is conceivable to mainly use the first calculation method capable of calculating an arbitrary angle of the construction machine when it is stationary.
  • the first calculation method uses the gravitational acceleration as a reference value, it may not be possible to accurately calculate the angle when an acceleration other than the gravitational acceleration occurs.
  • translational acceleration is generated by the start and stop of running motion, and centrifugal acceleration is generated by turning motion.
  • the condition of "comparing the acceleration detected at rest with the gravitational acceleration” is not satisfied, so that the calculation accuracy of the method is lowered. Therefore, in the angle calculation of the IMU, there is known a technique of suppressing deterioration of the accuracy of the calculation result by integrating the two calculation results by the first and second calculation methods with a Kalman filter, a complementary filter, or the like.
  • a technique of suppressing deterioration of the accuracy of the calculation result by integrating the two calculation results by the first and second calculation methods with a Kalman filter, a complementary filter, or the like.
  • the calculation method is switched from the first method to the second method at an appropriate time after the start of the traveling operation.
  • vibration occurs in the vehicle body and acceleration occurs in the vehicle body even when the traveling speed is constant, so that the second calculation method is maintained. Therefore, while the vehicle is running, the angular velocity is calculated by sequentially integrating the angular velocities detected by the angular velocity sensor.
  • the influence of the bias of the angular velocity sensor is accumulated by the integral calculation, and the calculation error gradually increases. ..
  • the angle calculation of the IMU is switched from the second method to the first method at an appropriate time after the stop.
  • the calculation result can be obtained by performing processing such as interpolation processing or filter processing on the calculation result of the second method and the calculation result of the first method. It guarantees continuity. Therefore, even if the construction machine is completely stopped and the IMU angle calculation is switched to the first method, the angle information output by the IMU is due to the second calculation method for a while after the complete stop. Since the error remains, the calculation error of the IMU does not become small immediately.
  • the operation support will be provided based on the inaccurate posture information including the IMU calculation error. Since it is done, there is a concern that the construction surface will be damaged. Therefore, in construction machinery, it is necessary to consider that the accuracy of IMU angle calculation may decrease for a certain period after the transition from the running or turning operating state to the stopped state even in the stopped state. There is.
  • the present invention has been made based on the above matters, and an object thereof is a construction machine capable of suppressing the use of inaccurate posture information in operation support of work equipment such as machine guidance and machine control. Is to provide.
  • the present application includes a plurality of means for solving the above problems, and to give an example thereof, the vehicle body, a work device rotatably attached to the vehicle body, and the vehicle body and the work device are installed.
  • An angle measuring device that detects the acceleration and angular velocity of the installed portion and calculates the angle of the installed portion with respect to the reference plane based on the detection result, and the vehicle body and the vehicle body based on the angle calculated by the angle measuring device.
  • the controller has a second requirement, which is the required accuracy for the angle calculation of the angle measuring device, based on the first required accuracy, which is the required accuracy set for the information used for the operation support of the working device.
  • the required accuracy calculation for calculating the accuracy is performed, and based on the detection result of the angle measuring device, an operation stop determination for determining whether or not the vehicle body has changed from the operating state to the stopped state is performed, and the operation stop determination is performed.
  • An accuracy determination is made to determine whether or not the accuracy of the angle calculation of the angle measuring device satisfies the second required accuracy, and it is determined that the vehicle body has changed from the operating state to the stopped state.
  • the operation support of the working device is stopped or a warning is given.
  • the controller stops the operation support of the work device such as machine guidance and machine control.
  • the operation support of the work device such as machine guidance and machine control.
  • FIG. 3 is a block diagram showing a functional configuration of a positioning calculation unit and a functional configuration of a monitor display unit of the controller shown in FIG. 2.
  • FIG. 3 is a block diagram showing a functional configuration of a required angle precision calculation unit that constitutes a part of the positioning calculation unit of the controller shown in FIG. 4.
  • FIG. 3 is a block diagram showing a functional configuration of an IMU calculation accuracy evaluation unit that constitutes a part of the positioning calculation unit of the controller shown in FIG. 4.
  • It is a flowchart which shows an example of the processing procedure of the determination of the guidance execution in the controller which constitutes the 1st Embodiment of the construction machine of this invention.
  • 6 is a flowchart showing an example of a processing procedure for determining an operating state of a vehicle body in the flowchart shown in FIG. 7.
  • 6 is a flowchart showing an example of a processing procedure for determining the calculation accuracy of the IMU in the flowchart shown in FIG.
  • FIG. 7 is a block diagram which shows the functional structure of the required angle accuracy calculation part which constitutes a part of the positioning calculation part of the controller in the modification of the 1st Embodiment of the construction machine of this invention. It is a block diagram which shows the functional structure of the controller in the 2nd Embodiment of the construction machine of this invention.
  • FIG. 11 is a block diagram showing a functional configuration of an IMU calculation accuracy evaluation unit that constitutes a part of the positioning calculation unit of the controller shown in FIG. 11.
  • FIG. 12 is an explanatory diagram showing a method of accuracy evaluation in the IMU calculation accuracy evaluation unit of the controller according to the second embodiment of the construction machine of the present invention shown in FIG. FIG.
  • FIG. 12 is a flowchart showing an example of a processing procedure of the IMU calculation accuracy evaluation unit of the controller according to the second embodiment of the construction machine of the present invention shown in FIG. It is explanatory drawing which shows the problem in the 2nd Embodiment of the construction machine of this invention. It is a block diagram which shows the functional structure of the controller in the 3rd Embodiment of the construction machine of this invention.
  • FIG. 16 is a block diagram showing a functional configuration of an IMU calculation accuracy evaluation unit that constitutes a part of the positioning calculation unit of the controller shown in FIG. 16.
  • FIG. 17 is a flowchart showing an example of a processing procedure of the IMU calculation accuracy evaluation unit of the controller according to the second embodiment of the construction machine of the present invention shown in FIG.
  • FIG. 3 is a block diagram showing a functional configuration of a required angle precision calculation unit that constitutes a part of the positioning calculation unit of the controller shown in FIG. 20. It is a block diagram which shows the functional structure of the controller in 5th Embodiment of the construction machine of this invention. It is a block diagram which shows the functional structure of the controller in 6th Embodiment of the construction machine of this invention.
  • FIG. 1 is a perspective view showing a hydraulic excavator to which the first embodiment of the construction machine of the present invention is applied.
  • FIG. 2 is a diagram showing a first embodiment of the construction machine of the present invention and a functional block of a controller constituting a part thereof. Here, the direction seen from the operator seated in the driver's seat will be described.
  • a hydraulic excavator as a construction machine is composed of a front work device 1 for performing excavation work and the like, and a vehicle body to which the front work device 1 is rotatably attached.
  • the vehicle body is composed of a self-propelled lower traveling body 2 and an upper turning body 3 mounted on the lower traveling body 2 so as to be able to turn.
  • the vehicle body is displaced with each movement of the lower traveling body 2 and the upper turning body 3.
  • the front work device 1 is an articulated work device configured by connecting a plurality of driven members so as to be rotatable in a vertical direction.
  • the plurality of driven members are composed of, for example, a boom 6, an arm 7, and a bucket 8 as a work tool.
  • the base end portion of the boom 6 is rotatably supported by the front portion of the upper swing body 3.
  • a base end portion of the arm 7 is rotatably supported at the tip end portion of the boom 6.
  • a bucket 8 is rotatably supported at the tip of the arm 7.
  • the boom 6, arm 7, and bucket 8 are driven by the boom cylinder 10, arm cylinder 11, and bucket cylinder 12, which are hydraulic actuators, respectively.
  • the bucket 8 is driven via a link member 13 that rotates in conjunction with the bucket 8.
  • the lower traveling body 2 is provided with, for example, a crawler type traveling device 14 (only one side is shown) on the left and right sides.
  • the traveling device 14 is driven by a traveling hydraulic motor 14a, which is a hydraulic actuator.
  • the upper swivel body 3 is configured to be swiveled with respect to the lower traveling body 2 by, for example, a swivel hydraulic motor 4 which is a hydraulic actuator.
  • the upper swivel body 3 includes a driver's cab 16 on which an operator rides and a machine room 17 for accommodating various devices.
  • the driver's cab 16 is provided with operating devices 18a, 18b, 18c for operating each hydraulic actuator 4, 10, 11, 12, 14a.
  • the operating devices 18a and 18b are, for example, electric operating lever devices having an operating lever that can be tilted back and forth and left and right.
  • the electric operating lever devices 18a and 18b have a detection device (not shown) that electrically detects the tilting direction and tilting amount of the operating lever, that is, the operating direction and the operating amount, and the detected operating direction and the operating amount.
  • An operation signal corresponding to the operation amount is output to the controller 40 (see FIG. 2) via electrical wiring.
  • the operation in the front-rear direction and the operation in the left-right direction of the operation lever devices 18a and 18b are assigned as operations of the hydraulic actuators 4, 10, 11 and 12, respectively. That is, each operation of the operation lever devices 18a and 18b is assigned as an operation of the front working device 1 or a turning operation of the upper swivel body 3.
  • the operating device 18c is an electric operating device having a traveling lever and a traveling pedal that can be tilted back and forth.
  • the operating device 18c is assigned as an operation of the hydraulic actuator 14a, that is, a traveling operation of the left and right traveling devices 14.
  • a monitor 19 (see FIG. 2) capable of displaying and inputting various information is installed.
  • each hydraulic actuator 4 It is configured to drive 10, 11, 12, and 14a.
  • a prime mover 21 such as an engine or an electric motor
  • a hydraulic pump device 22 driven by the prime mover 21, and the like are arranged in the machine room 17.
  • the pressure oil discharged from the hydraulic pump device 22 is supplied to each of the hydraulic actuators 4, 10, 11, 12, and 14a to drive the hydraulic actuators 4, 10, 11, 12, and 14a.
  • the drive of each hydraulic actuator 4, 10, 11, 12, 14a is controlled by the control valve unit 23, which is an assembly of control valves corresponding to each hydraulic actuator 4, 10, 11, 12, 14a.
  • Each control valve constituting the control valve unit 23 controls the direction and flow rate of the pressure oil supplied from the hydraulic pump device 22 to the corresponding hydraulic actuators 4, 10, 11, 12, and 14a.
  • each control valve is controlled, for example, by an operating pilot pressure output from a pilot pump (not shown) via an electromagnetic proportional valve (not shown).
  • Each electromagnetic proportional valve is controlled by the controller 40 based on the operation signal from the operating devices 18a, 18b, 18c, so that the hydraulic actuators 4, 10, 11, 12, are controlled via the control valves of the control valve unit 23.
  • the operation of 14a is controlled.
  • an inertial measurement unit (IMU) 25 for measuring information on the movement and posture of the vehicle body is installed on the upper swivel body 3.
  • Inertial measurement units (IMUs) 26, 27, and 28 that measure information about the postures of the components 6, 7, and 8, respectively, are also attached to the boom 6, arm 7, and bucket 8, which are the components of the front work device 1. is set up.
  • the inertial measurement unit 25 for the upper swing body 3 (vehicle body) is for the vehicle body IMU
  • the inertial measurement unit 26 for the boom 6 is for the boom IMU
  • the arm 7 is set up.
  • the inertial measurement unit 27 is referred to as an arm IMU, and the inertial measurement unit 28 for the bucket 8 is referred to as a bucket IMU.
  • the bucket IMU 28 can be installed not on the bucket 8 but on the link member 13 that rotates in conjunction with the bucket 8.
  • the IMU is a device equipped with two sensors, an acceleration sensor 31 and an angular velocity sensor 32 (both see FIG. 4), and an angle that calculates an angle using the acceleration detected by the acceleration sensor and the angular velocity detected by the angular velocity sensor. It has a calculation function (angle calculation unit 33).
  • the IMU calculates the angle by combining the following two calculation methods.
  • the first method calculates an angle with respect to a reference plane (for example, a horizontal plane) by comparing the acceleration detected by the acceleration sensor with the gravitational acceleration.
  • the second method calculates the angle by integrating the angular velocity detected by the angular velocity sensor.
  • the second method can only calculate the angle change starting from a certain angle when the construction machine is stationary. Therefore, as the angle calculation of the IMU, the first method capable of calculating an arbitrary angle when the construction machine is stationary is mainly used.
  • the vehicle body IMU 25 detects the acceleration and angular velocity generated in the upper swivel body 3 (installed portion), and also performs an angle calculation for calculating the angle of the installed portion 3 with respect to the reference surface based on the detection result (acceleration and angular velocity). .. Specifically, the vehicle body IMU25 has a direction of gravity acceleration (vertically downward direction) detected in the IMU coordinate system set in the vehicle body IMU25 and a mounting state of the vehicle body IMU25 (vehicle body) when the upper swivel body 3 is in a stationary state.
  • the tilt (pitch angle) in the front-rear direction (pitch angle) and the tilt (roll angle) in the left-right direction (width direction) of the upper swivel body 3 with respect to the horizontal plane are calculated. It is possible.
  • the vehicle body IMU25 detects the acceleration and angular velocity of the upper swing body 3 (vehicle body) (information on the operation of the upper swing body 3) and the calculation result of the pitch angle and roll angle (angle information) of the vehicle bodies 2 and 3 (posture of the vehicle body). Information) is output to the controller 40.
  • the boom IMU26, arm IMU27, and bucket IMU28 detect the angular velocity and acceleration of the installation portion (boom 6, arm 7, bucket 8), respectively, and based on the detection results (acceleration and angular velocity) of the installation portion 6, 7, 8
  • the angle calculation is performed to calculate the angle with respect to the reference plane. Similar to the vehicle body IMU25, the boom IMU26, arm IMU27, and bucket IMU28 have the direction of gravitational acceleration detected in the IMU coordinate system set in each IMU26, 27, 28 and each IMU26, 27 when the vehicle body is stationary. , 28, it is possible to calculate the angle information of each component 6, 7, 8 based on the mounting state (relative positional relationship with each component 6, 7, 8 of the front work device 1). ..
  • the boom IMU26, arm IMU27, and bucket IMU28 each have detection results of angular velocity and acceleration of each component 6, 7, 8 and calculation result of angle information of each component 6, 7, 8 (each component 6, 7, 8). Information about the posture of) is output to the controller 40.
  • These four vehicle body IMU25, boom IMU26, arm IMU27, and bucket IMU28 detect the acceleration and angular velocity of each component 6, 7, and 8 of the upper swing body 3 and the front work device 1, and are based on the acceleration and angular velocity of the detection result. By performing the angle calculation, it functions as an angle measuring device that measures information about the posture of the construction machine.
  • the upper swivel body 3 is equipped with two GNSS antennas 36 and 37 as receiving devices capable of receiving positioning signals from a plurality of satellites.
  • the positioning signal received by each of the GNSS antennas 36 and 37 is input to the GNSS receiver 38 shown in FIG.
  • the GNSS receiver 38 Based on the positioning signals received by the GNSS antennas 36 and 37, the GNSS receiver 38 performs positioning calculations such as calculation of antenna coordinates (position of a specific part of the vehicle body) and calculation of the azimuth angle of the upper swivel body 3 (vehicle body). It functions as a positioning calculation device to perform.
  • the GNSS antennas 36 and 37 and the GNSS receiver 38 constitute a positioning system 35 (see FIG. 4) that performs satellite positioning with respect to the hydraulic excavator.
  • the GNSS receiver 38 uses statistical processing for the above-mentioned calculation of the position and the azimuth angle, the variance thereof is calculated at the same time in addition to the position and the azimuth angle. Further, the GNSS receiver 38 can calculate not only the position of the GNSS antennas 36 and 37 (vehicle body) but also the speed. The GNSS receiver 38 outputs the position and speed of the GNSS antennas 36 and 37 (vehicle body), the azimuth angle of the upper swivel body 3 (vehicle body), and their dispersion, which are the calculation results of the positioning calculation, to the controller 40.
  • the GNSS receiver 38 (positioning system 35) can execute RTK (Real Time Kinematic) positioning by connecting to a GNSS fixed station installed in the field via wireless communication.
  • RTK Real Time Kinematic
  • a site without a GNSS fixed station it is possible to perform positioning using a network-type RTK that acquires information on an electronic reference station via the Internet.
  • the GNSS receiver 38 can execute RTK positioning regardless of the presence or absence of a fixed station in the field.
  • the controller 40 controls the operation of the hydraulic excavator based on the calculation result of the GNSS receiver 38, the detection result of the vehicle body IMU25, the boom IMU26, the arm IMU27, the bucket IMU28, the angle calculation result, and the like. And the operator's operation support.
  • the controller 40 includes, for example, a storage device 41 made of RAM, ROM, or the like, and a processing device 42 made of a CPU, MPU, or the like.
  • the storage device 41 stores in advance a program and various information necessary for controlling the operation of the hydraulic excavator.
  • the processing device 42 appropriately reads a program and various information from the storage device 41, and executes processing according to the program to realize various functions including the following functions.
  • the controller 40 has a positioning calculation unit 51, a construction target surface calculation unit 52, a monitor display control unit 53, and a hydraulic system control unit 54 as part of the functions executed by the processing device 42.
  • the positioning calculation unit 51 is based on the calculation result of the GNSS receiver 38, the detection result of the vehicle body IMU25, the boom IMU26, the arm IMU27, and the bucket IMU28, and the calculation result of the angle calculation, and the position (coordinates) of the hydraulic excavator in the work site.
  • the posture calculation is performed to calculate the orientation and the posture information of the front work device 1. In order to calculate the posture information of the front work device 1, it is necessary to calculate the relative angles of the upper swivel body 3 and the two members in the boom 6, arm 7, and bucket 8 constituting the front work device 1, which are connected to each other. There is.
  • the relative angle of the boom 6 is calculated based on the angle of the calculation result of the vehicle body IMU 25 and the angle of the calculation result of the boom IMU 26.
  • the relative angle of the arm 7 is calculated based on the angle of the calculation result of the boom IMU 26 and the angle of the calculation result of the arm IMU 27.
  • the relative angle of the bucket 8 is calculated based on the angle of the calculation result of the arm IMU 27 and the angle of the calculation result of the bucket IMU 28.
  • the positioning calculation unit 51 outputs the calculation result to the construction target surface calculation unit 52, the monitor display control unit 53, and the hydraulic system control unit 54.
  • the accuracy of the calculation result of the positioning calculation unit 51 affects the calculation and control of each of these units 52, 53, 54. Therefore, the calculation result of the positioning calculation unit 51 is required to be highly accurate. The details of the configuration of the positioning calculation unit 51 will be described later.
  • the construction target surface calculation unit 52 is a construction target based on construction information such as a three-dimensional construction drawing stored in advance in the storage device 41, and position information and attitude information of the hydraulic excavator as a calculation result of the positioning calculation unit 51. It calculates the construction target surface that defines the target shape.
  • the construction information is input by the construction manager as an input device via a monitor 19 or the like. Further, the construction target surface calculation unit 52 calculates the distance between the construction target surface and the reference point (for example, the toe of the bucket 8).
  • the construction target surface can also be set on the spot by the operator operating the monitor 19.
  • the construction target surface calculation unit 52 outputs the calculation result to the monitor display control unit 53 and the hydraulic system control unit 54.
  • the monitor display control unit 53 controls the display of the monitor 19 in the driver's cab 16.
  • the monitor display control unit 53 gives an operation support instruction to the operator based on the construction target surface which is the calculation result of the construction target surface calculation unit 52 and the position information and the attitude information of the hydraulic excavator which is the calculation result of the positioning calculation unit 51.
  • the contents are calculated, and the calculation result is displayed on the monitor 19 functioning as a display device.
  • the monitor display control unit 53 functions as a machine guidance system that supports the operator's operation by displaying, for example, the posture of the front work device 1 and the tip position and angle of the bucket 8 of the front work device 1 on the monitor 19. It plays a part.
  • the monitor 19 If the positioning result of the GNSS receiver 38 is abnormal, or if the accuracy of the angle information of the calculation result of any of the four IMUs 25, 26, 27, and 28 does not meet the set required accuracy. It is possible to configure the monitor 19 to stop the execution of the guidance or display a warning of the interruption of the guidance. Further, it is also possible to configure the monitor 19 to give work instructions and alerts by outputting not only screen display but also voice. That is, the monitor display control unit 53 is configured to take a negative measure against the execution of the guidance when there is a problem in the positioning result of the GNSS receiver 38 or the calculation result of the IMUs 25, 26, 27, 28. Has been done.
  • the monitor 19 is not a mere display device but can be used as an input device by providing a touch panel.
  • the monitor 19 can be configured to be installed in the driver's cab 16 or a portable tablet terminal can be detachably installed in the driver's cab 16, for example.
  • the hydraulic system control unit 54 controls a hydraulic system including a hydraulic pump device 22, a plurality of hydraulic actuators 4, 10, 11, 12, 14a, and a control valve unit 23 (both see FIG. 1).
  • the hydraulic system control unit 54 calculates the operation of the hydraulic excavator based on, for example, the construction target surface which is the calculation result of the construction target surface calculation unit 52 and the position information and the attitude information of the hydraulic excavator which is the calculation result of the positioning calculation unit 51. , Control the hydraulic system to realize the operation of the calculation result.
  • the hydraulic system control unit 54 functions as a machine control system that limits the operation so that the tip of the bucket 8 does not approach the construction target surface more than a certain amount, and controls the bucket 8 to move along the construction target surface. It plays a part in.
  • a system that combines the functions of the construction target surface calculation unit 52 and the monitor display control unit 53 will be referred to as a machine guidance system. Further, a system that combines the functions of the construction target surface calculation unit 52 and the hydraulic system control unit 54 is called a machine control system.
  • one controller 40 is configured to execute all the functional units shown in FIG. 2, but it is also possible to configure each functional unit to be executed by a different controller.
  • the aggregate of controllers constituting each functional unit constitutes a controller that calculates the posture information of the hydraulic excavator and executes the operation support of the front work apparatus 1.
  • the positioning calculation unit 51 of the controller 40 uses the satellite positioning signal to calculate the posture information of the hydraulic excavator, and the calculation result of the GNSS receiver 38 (positioning system 35) and the four IMUs 25, 26, 27, 28. The detection result and the calculation result are used.
  • the posture information of the calculation result of the positioning calculation unit 51 is used by the monitor display control unit 53 and the hydraulic system control unit 54.
  • FIG. 3 is an explanatory diagram showing a decrease in accuracy of angle calculation of an inertial measurement unit (IMU) constituting a part of the first embodiment of the construction machine of the present invention.
  • IMU inertial measurement unit
  • the upper figure shows the amount of operation of the operating device (running lever or running pedal)
  • the middle figure shows an example of the combined value of the acceleration detected by the IMU
  • the lower figure shows the calculation result of the IMU angle calculation and the true angle.
  • An example of the difference from (the error of the calculation angle of the IMU) is shown.
  • the IMU is any one of the vehicle body IMU25, the boom IMU26, the arm IMU27, and the bucket IMU28.
  • the traveling lever or the traveling pedal (see FIG. 1) of the operating device 18c is not operated from the initial time t0 to the time t1, and the hydraulic excavator is stopped without traveling. Is. Therefore, as shown in the middle diagram of FIG. 3, the combined value of the acceleration detected by the IMU substantially coincides with the gravitational acceleration g.
  • the first method is used as the method for calculating the angle of the IMU. However, the angle of the calculation result of the IMU does not completely match the true (practically) angle due to the bias (stationary error) of the accelerometer and the quantization error of the accelerometer.
  • the angle error that occurs in the stationary state (between time t0 and time t1 shown in the lower diagram of FIG. 3) is called a minimum error ⁇ min .
  • the minimum error ⁇ min is a value less than the constant specification value (margin of error) ⁇ s with respect to the calculation accuracy of the IMU.
  • the operating device 18c running lever or running pedal
  • the hydraulic excavator shifts from the stopped state to the traveling operation, so that the hydraulic excavator is accelerated.
  • the combined value of the accelerations detected by the IMU does not match the gravitational acceleration g, so that the IMU cannot use the first calculation method. Therefore, the IMU switches the calculation method from the first method to the second method to perform the angle calculation.
  • the error of the calculation angle is prevented from suddenly increasing after the time t1.
  • the angle calculation by the second method integrates the detection result (angular velocity) of the angular velocity sensor, if it is applied for a long time, the influence of the bias of the angular velocity sensor is accumulated and the accuracy of the calculation result is lowered (). The error of the calculation angle becomes large).
  • the first method cannot be used for calculating the angle of the IMU.
  • the second method is continuously used, as shown in the lower part of FIG. 3, the influence of the bias of the angular velocity sensor is accumulated, and the error of the calculation angle gradually increases.
  • the operation of the operating device 18c is stopped at time t3.
  • the hydraulic excavator suddenly decelerates, and as shown in the middle diagram of FIG. 3, the combined value of the acceleration detected by the IMU greatly fluctuates from the gravitational acceleration g again. After that, the translational acceleration of the hydraulic excavator becomes 0, but the vehicle body vibration generated by the sudden deceleration continues. Only at time t4, as shown in the middle diagram of FIG. 3, the hydraulic excavator is completely stopped.
  • the angle calculation of the IMU is switched from the second method to the first method at an appropriate time after the hydraulic excavator is completely stopped.
  • the continuity of the calculation result is ensured by performing processing such as interpolation processing and filter processing on the calculation result by the second method and the calculation result by the first method. Therefore, for this reason, even if the hydraulic excavator is completely stopped and the angle calculation of the IMU is switched to the first method, the angle information output by the IMU is the second calculation method for a while after the complete stop. Since the error caused by the above remains, the error of the calculation angle of the IMU does not immediately become the minimum error ⁇ min at time t4. That is, as shown in the lower figure of FIG. 3, the error of the calculation angle of the IMU gradually decreases even after the time t4 when the vehicle body is completely stopped, and converges to the minimum error ⁇ min at the time t5.
  • the accuracy (error) of the calculation angle of the IMU may not satisfy the specification value (margin of error) ⁇ s in the steady state for a while after the transition from the traveling operation to the stopped state. Therefore, when the machine guidance is executed at time t4 based only on the fact that the running operation is not performed and the vehicle is in the stopped state, the calculation is inaccurate based on the low-precision angle information output by the IMU. Since the operation support is performed according to the posture information, there is a concern that the construction surface may be damaged. This applies not only to the transition from the running motion to the stopped state, but also to the transition from the turning motion to the stopped state.
  • the controller 40 when executing operation support such as machine guidance and machine control, even if the hydraulic excavator is in the stopped state, the calculation angle of the IMU is calculated for a certain period after the transition from the running or turning operating state to the stopped state. It is necessary to consider that the accuracy (error) of the above may not meet the required accuracy (margin of error). Therefore, the controller 40 according to the present embodiment is configured to evaluate whether or not the accuracy of the calculation angle of the IMU is lowered after the traveling operation of the vehicle body (upper turning body 3) and the transition from the turning operation to the stopped state. There is.
  • the accuracy (error) of the calculation angle of the IMU does not satisfy the required accuracy (allowable angle) in order to suppress the use of inaccurate attitude information based on the low-precision angle information output by the IMU. If it is determined, the operation support of the work device 1 such as machine guidance and machine control is stopped or a warning is taken.
  • FIG. 4 is a block diagram showing a functional configuration of the positioning calculation unit of the controller shown in FIG. 2 and a functional configuration of the monitor display unit.
  • FIG. 5 is a block diagram showing a functional configuration of a required angle precision calculation unit that constitutes a part of the positioning calculation unit of the controller shown in FIG.
  • FIG. 6 is a block diagram showing a functional configuration of an IMU calculation accuracy evaluation unit that constitutes a part of the positioning calculation unit of the controller shown in FIG.
  • the controller 40 is configured to input information from the positioning system 35, information from each IMU 25, 26, 27, 28, and information from the required accuracy setting device 19.
  • the positioning system 35 outputs information on the position and its distribution calculated by the GNSS receiver 38 based on the positioning signals from the plurality of satellites received by the GNSS antennas 36 and 37 to the controller 40.
  • Each IMU 25, 26, 27, 28 includes an acceleration sensor 31 for detecting acceleration and an angular velocity sensor 32 for detecting an angular velocity. Further, each IMU 25, 26, 27, 28 has an angle with respect to a reference surface of a portion where each IMU 25, 26, 27, 28 is installed, based on the acceleration detected by the acceleration sensor 31 and the angular velocity detected by the angular velocity sensor 32. It has a function as an angle calculation unit 33 that performs an angle calculation. Each IMU 25, 26, 27, 28 outputs each information of the acceleration detected by the acceleration sensor 313, the angular velocity detected by the angular velocity sensor 23, and the angle calculated by the angle calculation unit 33 to the controller 40.
  • the required accuracy setting device is configured by, for example, a monitor 19 having an input device, and sets the required accuracy for the information used for the operation support of the front work device 1.
  • a dimensional dimension tolerance (allowable dimensional error) can be input by an operator's operation as the finishing accuracy which is the required accuracy for the operation support information.
  • the permissible dimensional error of the finishing accuracy can be set according to the operation of the hydraulic excavator, for example, 10 cm at the time of rough excavation and 2 cm at the time of finish excavation.
  • the positioning calculation unit 51 of the controller 40 calculates the posture calculation unit 61 that calculates the posture information indicating the posture of the hydraulic excavator, and the required angle (second required accuracy) for the angle calculation of the IMUs 25, 26, 27, and 28. It has an accuracy calculation unit 62 and an IMU calculation accuracy evaluation unit 63 for evaluating the accuracy of angle calculation of the IMUs 25, 26, 27, and 28.
  • the attitude calculation unit 61 includes the calculation result (position and azimuth angle and their dispersion) of the positioning system 35, the detection result (acceleration and angular velocity) and the calculation result (angle) of each IMU 25, 26, 27, 28. Is used to calculate the posture information.
  • the posture information is various three-dimensional coordinates necessary for machine guidance and machine control, such as the position of the center of the toe of the bucket 8. Since this operation follows a general geometric relationship, detailed description is omitted.
  • the attitude information of the calculation result of the attitude calculation unit 61 is output to the construction target surface calculation unit 52, the monitor display control unit 53, and the hydraulic system control unit 54, and is used for machine guidance and machine control.
  • the required angle accuracy calculation unit 62 determines whether or not the required accuracy (first required accuracy) is set by the required accuracy setting device 19. Further, when the required accuracy is set, the required accuracy (the required accuracy) for the calculation result of the angle calculation of the IMU 25, 26, 27, 28 based on the required accuracy (first required accuracy) set by the required accuracy setting device 19. The second required accuracy) is calculated.
  • the required angle accuracy calculation unit 62 sets the allowable dimensional error as the required accuracy (first required accuracy) for the operation support information, and the required accuracy (for the calculation result of the angle calculation of IMU25, 26, 27, 28) (1st required accuracy). As the second required accuracy), it is converted into an allowable angle dimension error (allowable angle error). For example, as shown in FIG. 5, the required angle accuracy calculation unit 62 converts an error in the dimension dimension (allowable dimension error) input from the required accuracy setting device 19 into an angle dimension tolerance (allowable angle error). A conversion table 621 is provided.
  • the error conversion table 621 numerically calculates, for example, an allowable angle error of 0.5 degrees when the finishing accuracy (allowable dimensional error) is 10 cm, and an allowable angle error of 0.1 degrees when the finishing accuracy is 2 cm. It is derived from the relationship calculated in advance by.
  • the required angle accuracy calculation unit 62 calculates one allowable angle error (first required accuracy) for the allowable dimensional error as the required accuracy (first required accuracy) set by the required accuracy setting device 19 in the IMU calculation accuracy evaluation unit. Output to 63.
  • the minimum allowable angle error is determined by the specification values of IMU25, 26, 27, 28, and is called the minimum allowable angle error A min . It is desirable to limit the input in the required accuracy setting device 19 to a numerical value smaller than the allowable dimensional error corresponding to the minimum allowable angle error Amin. For example, when the allowable dimensional error corresponding to the minimum allowable angle error A min is 2.0 cm, and the operator operates the required accuracy setting device 19 to input 1.0 cm as the finishing accuracy, the controller 40 performs the required accuracy. It is desirable to output a warning message to the setting device 19 to set the finishing accuracy to 2.0 cm or more.
  • the IMU calculation accuracy evaluation unit 63 affects the accuracy of the angle calculation of the IMU 25, 26, 27, 28 based on the detection results (acceleration and angular velocity) of the IMU 25, 26, 27, 28.
  • the accuracy of the angle calculation of the motion determination unit 65 for determining the presence or absence of the running motion and the turning motion of a few, and the IMU 25, 26, 27, 28 satisfies the second required accuracy of the calculation result of the required angle accuracy calculation unit 62. It is provided with a calculation accuracy determination unit 66 for determining whether or not it is present.
  • the motion determination unit 65 is in a state in which the vehicle bodies 2 and 3 are operating (running state or turning state) or in a stopped state. Is determined. That is, when any of the acceleration and the angular velocity detected by each IMU 25, 26, 27, 28 exceeds the threshold value, it is determined that the vehicle bodies 2 and 3 are in operation, while when it is below the threshold value, it is determined. Is determined to be in a stopped state. Further, the motion determination unit 65 also performs an motion stop determination for determining whether or not the vehicle bodies 2 and 3 have changed from the operating state (running state or turning state) to the stopped state. The operation determination unit 65 outputs the determination result of the operation state of the vehicle bodies 2 and 3 to the calculation accuracy determination unit 66.
  • the x-axis acceleration detected by the vehicle body IMU25 is Ax
  • the y-axis acceleration is Ay
  • the z-axis acceleration is Az. If the combined value Acc of the accelerations of the three axes at this time does not match the gravitational acceleration g, or if the angular velocity of any of the three axes is not 0, the vehicle bodies 2 and 3 are operating (running operation or turning operation). Determined to be in a state. However, since the detected value of the vehicle body IMU25 may have a bias (steady error) or noise, it is desirable to set a threshold value for the determination.
  • the vehicle bodies 2 and 3 operate in the motion determination unit 65. It is determined that the state is in progress.
  • Equation 5 Acc> g + A th ... (Equation 1) Acc ⁇ g-A th ... (Equation 2)
  • ⁇ x, ⁇ y, and ⁇ z are detection values of the angular velocities of the x-axis, y-axis, and z-axis of the vehicle body IMU25, respectively.
  • the calculation accuracy determination unit 66 sets a time threshold to be compared for accuracy determination based on the second required accuracy (allowable angle error) of the calculation result of the required angle accuracy calculation unit 62.
  • the accuracy of the angle calculation of the IMU by comparing the table 661 with the counter 662 that counts the elapsed time t from a certain point in time, the elapsed time t counted by the counter 662, and the time threshold output by the time conversion table 661. Is provided with a comparison determination unit 663 for determining whether or not the second required accuracy is satisfied.
  • the calculation accuracy determination unit 66 compares the outputs of both the IMU mounted on the hydraulic excavator and the high-precision angle sensor, and the error between the operating state of the hydraulic excavator and the calculation angle of the IMU as shown in the lower diagram of FIG. This can be realized by acquiring experimental data showing the relationship between the above in advance and creating a time conversion table 661 based on the relationship of the experimental data. For example, by using an experimental machine equipped with an optical fiber gyroscope (FOG), which is very expensive to mount on a hydraulic excavator but has excellent accuracy, the IMU calculation shown in the lower part of FIG. 3 is performed. It is possible to obtain a time series of angle errors.
  • FOG optical fiber gyroscope
  • the time conversion table 661 defines the relationship of the time threshold value T th corresponding to the permissible angle error ⁇ a , which is the second required accuracy of the calculation result of the required angle accuracy calculation unit 62. Regarding the relationship between the time threshold value and the permissible angle error of the time conversion table 661, the time threshold value becomes smaller as the permissible angle error becomes larger (the second required accuracy becomes lower), while the permissible angle error becomes smaller (the second required accuracy). Has the characteristic that the time threshold value increases as the value increases.
  • the time conversion table 661 outputs a time threshold value to the comparison determination unit with respect to the input of the allowable angle error of the calculation result of the required angle accuracy calculation unit 62.
  • the relationship of the time conversion table 661 is, for example, from the time t4 (when the combined acceleration detected by the IMU substantially matches the gravity acceleration) in the lower diagram of FIG. 3 to the time t5 (the error of the calculation angle of the IMU is the minimum error ⁇ min ). It is obtained from the experimental data showing the time transition of the error of the calculation angle up to (the time when it becomes). That is, it is defined based on the time transition of the error of the calculation angle from the timing when the vehicle body of the hydraulic excavator changes from the running state or the turning state to the stopped state to the time when the minimum error ⁇ min is reached.
  • the relationship of the time conversion table 661 requires a certain amount of time to elapse within the required accuracy even if the vehicle body changes from the running state or the turning state to the stopped state. It shows that.
  • the time threshold t max for reaching the minimum allowable angle error ⁇ min (elapsed time from time t4 to time t5 in the lower diagram of FIG. 3) regardless of the input from the required angle accuracy calculation unit 62.
  • the period corresponding to) is predetermined.
  • the counter 662 counts the elapsed time from the time when the motion determination unit 65 determines that the vehicle bodies 2 and 3 have changed from the traveling state or the turning state to the stopped state.
  • the counter 662 outputs the counted elapsed time t to the comparison determination unit 663.
  • the comparison determination unit 663 compares the elapsed time t counted by the counter 662 with the time threshold value T th output by the time conversion table 661, so that the accuracy of the angle calculation of the IMUs 25, 26, 27, and 28 is the required angle accuracy calculation. It is for determining whether or not the second required accuracy of the calculation result of 62 is satisfied. When the elapsed time t of the counter 662 is smaller than the time threshold T th of the time conversion table 661, the comparison determination unit 663 does not satisfy the second required accuracy in the angle calculation accuracy of the IMUs 25, 26, 27, and 28. And enable the low precision flag indicating that the angle calculation of the IMU does not meet the required accuracy.
  • the comparison determination unit 663 outputs the validity or invalidity of the low-precision flag set according to the comparison determination to the monitor display control unit 53.
  • the monitor display control unit 53 of the controller 40 includes a guidance execution unit 531 that displays the posture information of the hydraulic excavator as the calculation result of the posture calculation unit 61 of the positioning calculation unit 51 on the monitor 19.
  • the guidance execution unit 531 also determines whether to continue or stop the execution of the machine guidance according to the validity or invalidity of the low accuracy flag of the evaluation result of the IMU calculation accuracy evaluation unit 63. If the low precision flag is enabled, stop executing machine guidance.
  • the guidance execution unit 531 may be configured to display a warning for the execution of the machine guidance or an instruction for urging the work to be stopped on the monitor instead of stopping the execution of the machine guidance. That is, the guidance execution unit 531 is configured to take a negative measure against the execution of the machine guidance when the low accuracy flag is valid.
  • FIG. 7 is a flowchart showing an example of a processing procedure for determining guidance execution in the controller constituting the first embodiment of the construction machine of the present invention.
  • FIG. 8 is a flowchart showing an example of a processing procedure for determining the operating state of the vehicle body in the flowchart shown in FIG. 7.
  • FIG. 9 is a flowchart showing an example of a processing procedure for determining the calculation accuracy of the IMU in the flowchart shown in FIG. 7.
  • the positioning calculation unit 51 of the controller 40 shown in FIG. 4 first takes in the calculation result (position and its distribution) from the positioning system 35 (GNSS receiver 38), and from the IMUs 25, 26, 27, and 28, respectively.
  • the detection result (acceleration and angular velocity) and the calculation result (angle) are taken in (step S10).
  • the posture calculation unit 61 of the positioning calculation unit 51 calculates the posture information of the hydraulic excavator based on the position of the calculation result of the positioning system 35 and the angle of the calculation result of each IMU 25, 26, 27, 28 (step S20). ).
  • step S30 If the first required accuracy is set (YES), the process proceeds to step S40, while if the first required accuracy is not set (NO), the process proceeds to step S90.
  • step S90 the guidance execution unit 531 of the monitor display control unit 53 of the controller 40 executes guidance based on the posture information of the calculation result of the posture calculation unit 61 (step S90).
  • the controller 40 executes the function of the machine guidance as in the conventional case.
  • the required angle accuracy calculation unit 62 calculates the required error for the accuracy of the angle calculation of IMU25, 26, 27, 28 (step S40). Specifically, the required angle accuracy calculation unit 62 calculates the allowable angle error, which is the second required accuracy, from the allowable dimensional error (finishing accuracy) set by the required accuracy setting device 19 with reference to the error conversion table 621. do.
  • step S50 the operation determination unit 65 of the IMU calculation accuracy evaluation unit 63 of the positioning calculation unit 51 determines the operation state of the vehicle bodies 2 and 3 (step S50).
  • step S50 roughly, the motion determination unit 65 determines whether or not the vehicle bodies 2 and 3 are in a traveling state or a turning state based on the acceleration and the angular velocity detected by the IMUs 25, 26, 27, and 28.
  • the motion determination unit 65 calculates the combined acceleration based on the accelerations in the three axial directions detected by the IMUs 25, 26, 27, and 28 (step S510).
  • step S520 it is determined whether or not the calculated combined acceleration matches the gravitational acceleration g within a range of a predetermined threshold value. This determination corresponds to Equations 1 and 2 described above.
  • step S520 when the combined acceleration does not match the gravitational acceleration g within the threshold range, that is, when any of the above equations 1 and 2 holds (NO), the vehicle bodies 2, 3
  • the traveling flag indicating that the operating state of is determined to be the traveling state is enabled (step S530), and then the process proceeds to step S540.
  • the process proceeds to step S540 without enabling the traveling flag.
  • step S540 the operation determination unit 65 calculates the absolute value of the angular velocity in each axial direction based on the angular velocity in each axial direction detected by the IMUs 25, 26, 27, and 28. Next, it is determined whether or not the calculated absolute value of the angular velocity is equal to or less than a preset threshold value (bias of the angular velocity sensor) (step S550). This determination corresponds to the above-mentioned equations 3 to 5. In step S550, when the absolute value of the angular velocity is larger than the threshold value, that is, when any of the above equations 3 to 5 is satisfied (NO), the operating states of the vehicle bodies 2 and 3 are in the turning state.
  • a preset threshold value bias of the angular velocity sensor
  • step S560 The turning flag indicating that it is determined to be present is enabled (step S560), and then the process proceeds to step S570.
  • the process proceeds to step S570 without enabling the turning flag.
  • step S570 the operation determination unit 65 compares the travel flags of the previous and current control cycles to determine whether the travel flags have changed from valid to invalid, and at the time of the previous and current control cycles. Compare the swivel flags of to determine if the swivel flag has changed from valid to invalid. That is, it is determined whether or not the operating state of the vehicle bodies 2 and 3 has changed from the running state to the stopped state, and whether or not the change from the turning state to the stopped state has occurred. In this state, there is a concern that the accuracy of the IMU angle calculation may decrease even when the vehicle bodies 2 and 3 are stopped.
  • the operation determination unit 65 performs OR processing for determining whether or not the traveling flag has changed from valid to invalid and whether or not the turning flag has changed from valid to invalid, so that the operating states of the vehicle bodies 2 and 3 are in operation. Integrates into one signal information indicating that the IMU 25, 26, 27, 28 is in a predetermined state that reduces the accuracy of the angle calculation. Step S50 ends when the operation determination unit 65 executes the procedure of step S570.
  • the IMU calculation accuracy evaluation unit 63 evaluates the accuracy of the angle calculation of the IMUs 25, 26, 27, and 28 (step S60). In step S60, roughly, the IMU calculation accuracy evaluation unit 63 evaluates whether or not the accuracy of the angle of the calculation result of the IMU 25, 26, 27, 28 satisfies the second required accuracy calculated in step S40.
  • the motion determination unit 65 determines whether or not the motion states of the vehicle bodies 2 and 3 are in a predetermined stop state in which the accuracy of the angle calculation of the IMU is lowered (). Step S610). That is, it is determined whether the vehicle bodies 2 and 3 have changed from the traveling state to the stopped state or from the turning state to the stopped state. Specifically, this determination is made based on the results of the determination of whether or not the traveling flag has changed from valid to invalid and the determination of whether or not the turning flag has changed from valid to invalid.
  • step S610 If the motion determination unit 65 determines in step S610 that the vehicle bodies 2 and 3 are in a stopped state (YES) that reduces the accuracy of the angle calculation of the IMU, the process proceeds to step S620.
  • step S620 the calculation accuracy determination unit 66 calculates the time threshold T th corresponding to the permissible angle error ⁇ a , which is the calculation result of the request angle calculation unit 62, by referring to the time conversion table 661.
  • step S630 the counter 662 of the calculation accuracy determination unit 66 is activated and counts the elapsed time t (step S630). This counts the elapsed time t from the time when the vehicle bodies 2 and 3 change from the traveling state or the turning state to the stopped state.
  • the comparison determination unit 663 of the calculation accuracy determination unit 66 determines whether or not the elapsed time t counted by the counter 662 is smaller than the time threshold value Tth , which is the output of the time conversion table 661 (step S640). This changes from the operating state to the stopped state of the vehicle bodies 2 and 3 as shown in the time series of the error of the calculation angle of the IMU from the time t4 to the time t5 in the lower figure of FIG. It is to determine whether the elapsed time since then has reached the recovery time of the calculation accuracy of the IMU.
  • step S640 if the elapsed time t of the counter is smaller than the time threshold T th (YES), the process proceeds to step S650, and the comparison determination unit 663 determines the accuracy of the angle calculation of IMU 25, 26, 27, 28. Enable the low precision flag to indicate that the required precision is not met.
  • the process proceeds to step S660, and the comparison determination unit 663 invalidates the low precision flag.
  • step S610 determines in step S610 that the operating states of the vehicle bodies 2 and 3 are not in a stopped state that lowers the calculation accuracy of the IMU
  • the process proceeds to step S660 and the IMU is performed. Since it is not necessary to determine the calculation accuracy, the calculation accuracy determination unit 66 invalidates the low accuracy flag.
  • step S60 is completed by the end of step S650 or step S660. As a result, the controller 40 proceeds to the procedure of step S70.
  • step S70 shown in FIG. 7 the calculation accuracy determination unit 66 determines whether or not the accuracy of the angle calculation of the IMUs 25, 26, 27, and 28 satisfies the second required accuracy. Specifically, the calculation accuracy determination unit 66 determines whether or not the low accuracy flag is valid. If the low precision flag is valid (YES), the process proceeds to step S80. On the other hand, if the low precision flag is invalid (NO), the process proceeds to step S90.
  • step S80 the guidance execution unit 531 of the monitor display control unit 53 stops executing the guidance. This is because even if the vehicle bodies 2 and 3 are stopped, if the operation support is performed according to the inaccurate posture information based on the low-precision calculation angles of the IMU 25, 26, 27, 28, the construction surface will be damaged. This is because there is a concern that it will end up.
  • step S90 since it is determined that the accuracy of the angle calculation of IMU 25, 26, 27, 28 satisfies the required accuracy, the guidance execution unit 531 of the monitor display control unit 53 executes the guidance.
  • step S80 or step S90 the controller 40 returns to the start.
  • the positioning calculation unit 51 and the monitor display control unit 53 execute and stop the machine guidance, which is one of the operation support, by repeatedly executing the control cycle having steps S10 to S90 as one cycle.
  • the controller 40 determines whether or not the vehicle bodies 2 and 3 are in a predetermined stop state that reduces the calculation accuracy of the IMUs 25, 26, 27, and 28, and determines whether or not the vehicle bodies 2 and 3 are in a predetermined stopped state.
  • 3 is in the prescribed stop state, by taking negative measures for work support such as stopping the execution of machine guidance and warning, inaccurate posture information can be used when executing machine guidance. It can be suppressed.
  • the hydraulic excavator (construction machine) includes the vehicle bodies 2, 3 and the front work device 1 (work) rotatably attached to the vehicle bodies 2, 3.
  • the device), the vehicle body 2, 3 and the front work device 1 (work device) are installed, and the acceleration and angular velocity of the installation part are detected, and the angle calculation is performed to calculate the angle of the installation part with respect to the reference surface based on the detection result.
  • the postures of the vehicle body 2, 3 and the front work device 1 (work device) are set based on the angles calculated by the IMU 25, 26, 27, 28 (angle measurement device) and the IMU 25, 26, 27, 28 (angle measurement device).
  • the controller 40 of the IMU 25, 26, 27, 28 (angle measuring device) is based on the first required accuracy, which is the required accuracy set for the information used for the operation support of the front working device 1 (working device).
  • the required accuracy calculation for calculating the second required accuracy, which is the required accuracy for the angle calculation, is performed, and based on the detection results of the IMU 25, 26, 27, 28 (angle measuring device), the vehicle bodies 2 and 3 are in operation.
  • the operation stop determination for determining whether or not the state has changed to the stopped state is performed, and it is determined whether or not the accuracy of the angle calculation of the IMU 25, 26, 27, 28 (angle measuring device) satisfies the second required accuracy.
  • the accuracy is determined, it is determined that the vehicle body has changed from the operating state to the stopped state, and the accuracy of the angle calculation of IMU25, 26, 27, 28 (angle measuring device) satisfies the second required accuracy. If it is determined that there is no such thing, the operation support of the front work device 1 (work device) is stopped or a warning is given.
  • the controller 40 gives machine guidance. Inaccurate posture information is used when executing the operation support of the front work device 1 (work device) because the operation support of the front work device 1 (work device) such as machine control is stopped or a warning is taken. Can be suppressed.
  • the accuracy determination of the controller 40 is requested by using a time conversion table 661 (conversion table) predetermined so that the time threshold value Th increases as the second required accuracy increases.
  • the time threshold value Tth is set from the second required accuracy calculated by the accuracy calculation, and the elapsed time t from the time when it is determined that the vehicle bodies 2 and 3 have changed from the operating state to the stopped state in the operation stop determination is set. It is performed by counting and comparing the counted elapsed time t with the set time threshold T th , and when the counted elapsed time t is smaller than the set time threshold T th , IMU 25, 26, 27. , 28 (angle measuring device) determines that the accuracy of the angle calculation does not satisfy the second required accuracy.
  • the operation of the vehicle bodies 2 and 3 is stopped without using the calculation results of IMU25, 26, 27, 28 (angle measuring device).
  • the accuracy of the angle calculation of the IMU 25, 26, 27, 28 (angle measuring device) can be evaluated by the elapsed time t from the time of transition to.
  • FIG. 10 is a block diagram showing a functional configuration of a required angle accuracy calculation unit that constitutes a part of a positioning calculation unit of a controller in a modification of the first embodiment of the construction machine of the present invention.
  • those having the same reference numerals as those shown in FIGS. 1 to 9 have the same reference numerals, and therefore detailed description thereof will be omitted.
  • the modification of the first embodiment of the construction machine of the present invention is different from the first embodiment in that the functional configuration of the required angle accuracy calculation unit 62A in the positioning calculation unit 51 of the controller 40 is different. It is that you are.
  • the required angle accuracy calculation unit 62 according to the first embodiment has one allowable angle error (second required accuracy) for one allowable dimensional error (first required accuracy) input from the required accuracy setting device 19. Is output (see FIG. 5).
  • the required angle accuracy calculation unit 62A according to the modified example of the first embodiment has each IMU 25 installed in the upper swing body 3, the boom 6, the arm 7, and the bucket 8.
  • the boom 6 In hydraulic excavators, the boom 6 generally has a larger length than the bucket 8, so even if the error (accuracy) of the angle calculation of each IMU 25, 26, 27, 28 is the same, the bucket claws.
  • the effect on the calculation of the previous position information is different. For example, when the accuracy of the angle calculation of the boom IMU 26 decreases by 0.5 degrees, the calculation result of the tip position of the bucket 8 changes by 5 cm, while the accuracy of the angle calculation of the bucket IMU 28 decreases by 0.5 degrees. However, the calculation result of the toe position changes only 1 cm.
  • the required angle accuracy calculation unit 62A takes this into consideration, and an error (accuracy) in the angle calculation of the vehicle body IMU25 and the boom IMU26 related to the calculation of the relative angle of the boom 6. ) Is configured to be different from the error (accuracy) of the angle calculation of the arm IMU27 and the bucket IMU28 related to the calculation of the relative angle of the bucket 8.
  • the first to fourth error conversion tables 6211, 6212, 6213, 6214 for each IMU 25, 26, 27, 28 are error conversion tables in the required angle accuracy calculation unit 62 according to the first embodiment shown in FIG. Similar to 621, the tolerance of the dimension dimension (allowable dimension error) input from the required precision setting device 19 is converted into the tolerance of the angle dimension (allowable angle error). However, the first to fourth conversion tables 6211, 6212, 6213, 6214 have different sizes of allowable dimensional errors input according to the calculation result of the required accuracy distribution calculation unit 622.
  • the required accuracy distribution calculation unit 622 allocates the finishing accuracy set by the required accuracy setting device 19, that is, the allowable dimensional error, to the boom 6, arm 7, and bucket 8 constituting the front work device 1. .. It is desirable that this allocation is set according to the dimensions of the constituent members 6, 7, and 8 of the front working device 1. For example, when the finishing accuracy set by the required accuracy setting device 19 is 10 cm, the required accuracy distribution calculation unit 622 has a boom part of 5 cm and an arm part according to the dimensional ratios of the three constituent members 6, 7, and 8. Is assigned to 3 cm and the bucket part is assigned to 2 cm.
  • the required accuracy allocation calculation unit 622 outputs the allowable dimensional error assigned to each part to the error conversion tables 6211, 6212, 6213, 6214 corresponding to each part. As a result, each error conversion table 6211, 6212, 6213, 6214 calculates the permissible angle error for each IMU 25, 26, 27, 28.
  • the error of the boom part is determined by the accuracy of the angle calculation of the vehicle body IMU25 and the boom IMU26. Therefore, the reference values for the first and second error conversion tables 6211 and 6212 are determined by the error for the boom part.
  • the error of the arm part is determined by the accuracy of the boom IMU26 and the arm IMU27, but since the allowable angle error with respect to the boom IMU26 has already been determined, it can be determined only by the accuracy of the arm IMU27.
  • the error of the bucket part like the error of the arm part, can be determined only by the accuracy of the bucket IMU 28.
  • IMU25, 26, 27 even when the vehicle bodies 2, 3 are stopped, as in the first embodiment described above. If the accuracy of the angle calculation of 28 (angle measuring device) does not meet the required accuracy, the controller 40 stops or warns the operation support of the front working device 1 (working device), so that the front working device 1 ( It is possible to suppress the use of inaccurate posture information when executing the operation support of the work device).
  • the required accuracy calculation of the controller 40 in this modification is performed for each component member 6, 7 for the operation support information (information on the tip position of the bucket 8) of the front work device 1 for each IMU 25, 26, 27, 28.
  • 8 IMUs 25, 26, which allocate the permissible dimensional error as the first required accuracy according to the degree of influence of the attitude information, and the permissible angle error increases as the permissible dimensional error increases.
  • the allowable dimensional error (first requirement) depends on the degree of influence of the posture information of each component member 6, 7, 8 on the operation support information of the front work device 1 (information on the tip position of the bucket 8).
  • the required accuracy (second required accuracy) for the angle calculation of each IMU 25, 26, 27, 28 can be obtained as the operation support information of the front work device 1 (information on the tip position of the bucket 8). Since it can be changed according to the degree of influence of the above, it is possible to further suppress the use of inaccurate posture information when executing the operation support of the front work apparatus 1.
  • FIG. 11 is a block diagram showing a functional configuration of a controller according to a second embodiment of the construction machine of the present invention.
  • FIG. 12 is a block diagram showing a functional configuration of an IMU calculation accuracy evaluation unit that constitutes a part of the positioning calculation unit of the controller shown in FIG.
  • FIG. 13 is an explanatory diagram showing a method of accuracy evaluation in the IMU calculation accuracy evaluation unit of the controller of the second embodiment of the construction machine of the present invention shown in FIG. FIG.
  • FIG. 14 is a flowchart showing an example of a processing procedure of the IMU calculation accuracy evaluation unit of the controller according to the second embodiment of the construction machine of the present invention shown in FIG.
  • FIGS. 11 to 14 those having the same reference numerals as those shown in FIGS. 1 to 10 have the same reference numerals, and therefore detailed description thereof will be omitted.
  • the difference between the second embodiment of the construction machine of the present invention shown in FIGS. 11 and 12 from the first embodiment is that the IMU calculation accuracy evaluation unit 63B in the positioning calculation unit 51 of the controller 40 is calculated.
  • the functional configuration of the accuracy determination unit 66B is different.
  • the calculation accuracy determination unit 66 acquires in advance a time series of an error (accuracy) in the calculation angle of the IMU after the vehicle bodies 2 and 3 have changed from the operating state to the stopped state. By doing so, the time conversion table 661 showing the relationship between the error (accuracy) of the calculation angle of IMU 25, 26, 27, 28 and the time to reach within the allowable angle error is used (see FIG. 6).
  • the calculation accuracy determination unit 66 compares the elapsed time t after the vehicle bodies 2 and 3 have changed from the operating state to the stopped state with the time threshold value Tth set by referring to the time conversion table 661, and thereby the IMU25. , 26, 27, 28 are determined whether the calculation accuracy satisfies the required accuracy (see FIG. 6).
  • the calculation accuracy determination unit 66B uses the angles of the calculation results of IMU25, 26, 27, 28, thereby using the IMU25, 26, It is for determining whether the accuracy of the angle calculation of 27 and 28 satisfies the required accuracy.
  • the calculation accuracy determination unit 66B has a second required accuracy of the calculation result of the required angle accuracy calculation unit 62 in addition to the operation determination unit 65 similar to the first embodiment. Calculates the amount of change over time ⁇ with respect to the angle threshold conversion table 661B that sets the angle threshold ⁇ th, which is the comparison target for accuracy determination, based on (allowable angle error), and the angle of the calculation result of IMU25, 26, 27, 28.
  • the IMU25, 26, 27 by comparing the angle change amount calculation unit 662B, the temporal change amount ⁇ of the angle calculated by the angle change amount calculation unit 662B , and the angle threshold value ⁇ th output by the angle threshold value conversion table 661B. , 28 is provided with a comparison determination unit 663B for determining whether or not the accuracy of the angle calculation satisfies the second required accuracy.
  • the calculation accuracy determination unit 66B is realized based on the following contents.
  • FIG. 13 is a diagram in which the error of the angle calculation of the IMU after the time t4 in the lower diagram of FIG. 3 is enlarged.
  • the angle of the calculation result of the IMU continues to take a certain value ⁇ true including the influence of the bias of the IMU.
  • the IMU angle calculation error during the vehicle body operation is accumulated, so the angle of the IMU calculation result deviates from the predetermined value ⁇ true . It is a value.
  • the angle of the calculation result of the IMU gradually approaches the predetermined value ⁇ true because the stopped state of the vehicle body continues, and the error of the angle calculation of the IMU gradually decreases.
  • the time t5 the angle output by the IMU almost coincides with the predetermined value ⁇ true .
  • ⁇ ⁇
  • the angle threshold value conversion table 661B sets the angle threshold value ⁇ th , which is a criterion for determining whether or not the angle change amount ⁇ ⁇ of the angle calculation of the IMU has converged.
  • the angle threshold value conversion table 661B defines the relationship of the angle threshold value ⁇ th corresponding to the allowable angle error ⁇ a , which is the second required accuracy of the calculation result of the required angle accuracy calculation unit 62.
  • the permissible angle error increases while the permissible angle error increases (the second required accuracy decreases), while the permissible angle error decreases.
  • the angle threshold value conversion table 661B outputs the angle threshold value to the comparison determination unit 663B with respect to the input of the allowable angle error of the calculation result of the required angle accuracy calculation unit 62.
  • the angle change amount calculation unit 662B is the calculation result of the IMU25, 26, 27, 28 captured at the time k + 1 and the calculation result of the IMU25, 26, 27, 28 captured at the previous time k.
  • the amount of change over time ⁇ ⁇ of the angle which is the absolute value of the difference from the angle ⁇ k , is calculated.
  • the angle change amount ⁇ is an index as to whether or not the calculation accuracy of the IMUs 25, 26, 27, and 28 satisfies the required accuracy.
  • the comparison determination unit 663B compares the angle change amount ⁇ ⁇ calculated by the angle change amount calculation unit 662B with the angle threshold ⁇ th output by the angle threshold conversion table 661B to calculate the angles of the IMUs 25, 26, 27, and 28. It is for determining whether or not the accuracy satisfies the second required accuracy of the calculation result of the required angle accuracy calculation unit 62. In the comparison determination unit 663B, when the angle change amount ⁇ of the angle change amount calculation unit 662B is larger than the angle threshold value ⁇ th of the angle threshold value conversion table 661B, the accuracy of the angle calculation of IMU25, 26, 27, 28 is second. It is determined that the required accuracy is not satisfied, and the low accuracy flag is enabled.
  • step S60 is a procedure for evaluating the accuracy of the angle calculation of IMU 25, 26, 27, 28 of the IMU calculation accuracy evaluation unit 63 of the first embodiment
  • step S60B shown in FIG. 14 is executed. Will be done.
  • step S610 which is the same as in the case of the first embodiment, the vehicle body 2 and 3 are in a stopped state so as to reduce the accuracy of the angle calculation of the IMU (YES), and the operation determination unit 65 determines. If it is determined, the process proceeds to step S620B.
  • step S620B the calculation accuracy determination unit 66 calculates the angle threshold value ⁇ th corresponding to the allowable angle error ⁇ A , which is the calculation result of the request angle calculation unit 62, by referring to the angle threshold value conversion table 661B.
  • step S630B the angle change amount calculation unit 662B of the calculation accuracy determination unit 66 calculates the angle change amount ⁇ (step S630B). This starts the calculation when the vehicle bodies 2 and 3 change from the traveling state or the turning state to the stopped state.
  • the comparison determination unit 663B of the calculation accuracy determination unit 66 determines whether or not the angle change amount ⁇ calculated by the angle change amount calculation unit 662B is larger than the angle threshold value ⁇ th which is the output of the angle threshold value conversion table 661B (. Step S640B). This is because, as shown in the time series of the error of the calculation angle of the IMU after the time t5 in FIG. 13, the vehicle bodies 2 and 3 change to the stopped state and the calculation angle of the IMU converges to the vicinity of the predetermined value. It is to determine if you are doing it.
  • step S640B If the angle change amount ⁇ ⁇ is larger than the angle threshold value ⁇ th in step S640B (YES), the process proceeds to step S650, and the comparison determination unit 663B enables the low accuracy flag. On the other hand, when the angle change amount ⁇ ⁇ is equal to or less than the angle threshold value ⁇ th (NO), the process proceeds to step S660, and the comparison determination unit 663B invalidates the low accuracy flag.
  • the procedure of step S60B ends with the end of step S650 or step S660.
  • IMU25, 26, 27, 28 (similar to the first embodiment described above) even when the vehicle bodies 2, 3 are stopped. If the accuracy of the angle calculation of the angle measuring device) does not meet the required accuracy, the controller 40 stops or warns the operation support of the front working device 1 (working device), so that the front working device 1 (working device) It is possible to suppress the use of inaccurate posture information when executing the operation support of.
  • the accuracy determination of the controller 40 is calculated by the required accuracy calculation using the angle threshold conversion table 661B predetermined so that the angle threshold ⁇ th becomes smaller as the second required accuracy becomes higher.
  • the angle threshold ⁇ th is set from the second required accuracy, and the time change amount ⁇ of the angle calculated by IMU25 , 26, 27, 28 (angle measuring device) is calculated, and the time change amount of the calculated angle is calculated. It is performed by comparing ⁇ ⁇ with the set angle threshold ⁇ th , and when the amount of change over time ⁇ ⁇ of the calculated angle is larger than the set angle threshold ⁇ th , IMU 25, 26, 27, 28 (angle measuring device). ), It is determined that the accuracy of the angle calculation does not satisfy the second required accuracy.
  • the experimental data acquired by the conversion table for setting the threshold value to be compared with the accuracy judgment of the angle calculation of the IMU 25, 26, 27, 28 (angle measuring device) using an expensive sensor is obtained.
  • the angle threshold conversion table 661B for setting the threshold value to be compared for accuracy determination is defined without acquiring experimental data in advance. Therefore, it does not require a large number of steps to be mounted on the controller 40.
  • FIG. 15 is an explanatory diagram showing a problem in the second embodiment of the construction machine of the present invention.
  • FIG. 16 is a block diagram showing a functional configuration of a controller according to a third embodiment of the construction machine of the present invention.
  • FIG. 17 is a block diagram showing a functional configuration of an IMU calculation accuracy evaluation unit that constitutes a part of the positioning calculation unit of the controller shown in FIG.
  • FIG. 18 is a flowchart showing an example of a processing procedure of the IMU calculation accuracy evaluation unit of the controller according to the third embodiment of the construction machine of the present invention shown in FIG. FIG.
  • FIGS. 15 to 19 is an explanatory diagram showing the operation and effect of the third embodiment of the construction machine of the present invention.
  • FIGS. 15 to 19 those having the same reference numerals as those shown in FIGS. 1 to 14 have the same reference numerals, and therefore detailed description thereof will be omitted.
  • the IMU calculation accuracy evaluation unit 63B of the second embodiment evaluates the accuracy of the angle calculation of the IMU 25, 26, 27, 28 based on the time change amount ⁇ of the angle of the calculation result of the IMU 25, 26, 27, 28. ing.
  • the evaluation of calculation accuracy may be erroneous. For example, it is a case where the calculation characteristic of the IMU has the characteristic as shown in FIG.
  • the angle ⁇ of the calculation result (output value) of the IMU does not approach the predetermined value ⁇ true monotonically, but the temporal change of the angle ⁇ temporarily stops between the time ta and the time tb, and then the time. After t5, it almost coincides with the predetermined value ⁇ true .
  • the time change amount ⁇ of the angle in the IMU calculation accuracy evaluation unit 63B of the controller 40 is equal to or less than the angle threshold value ⁇ th between the time ta and the time tb. It is determined that the calculation accuracy of 26, 27, and 28 satisfies the required accuracy. However, at this time, since the angle of the calculation result of IMU 25, 26, 27, 28 has an error of ⁇ a with respect to the predetermined value ⁇ true , the calculation accuracy of IMU 5, 26, 27, 28 determines the required accuracy. It may not meet.
  • the third embodiment maintains the advantage of the second embodiment that it is not necessary to acquire experimental data using an expensive sensor in advance, and the IMU has few judgment errors by simple calculation. This is to evaluate the calculation accuracy of.
  • the difference between the third embodiment of the construction machine of the present invention shown in FIG. 16 from the second embodiment is that the IMU calculation accuracy evaluation unit 63C of the controller 40 has an operation determination unit 65 and a calculation accuracy determination unit.
  • the tilt angle calculation unit 67 is provided, and the functional configuration of the calculation accuracy determination unit 66C is different.
  • the tilt angle calculation unit 67 calculates the tilt angle ⁇ s, which is the angle with respect to the reference plane, based on the accelerations detected by the IMUs 25, 26, 27, and 28. This calculation is nothing but the same as the first method of the above-mentioned angle calculation of IMU25, 26, 27, 28 with the gravitational acceleration g as a reference value.
  • the calculation accuracy determination unit 66C includes an angle difference calculation unit 662C instead of the angle change amount calculation unit 662B of the second embodiment. Further, the comparison determination unit 663C for determining the calculation accuracy of the IMU 25, 26, 27, 28 by a determination method different from the comparison determination unit 663B of the second embodiment is provided. The calculation accuracy determination unit 66C does not require the angle threshold value conversion table 661B of the second embodiment, and the comparison determination unit 663C is configured so that the allowable angle error of the calculation result of the required angle accuracy calculation unit 62 is directly input. Has been done.
  • the angle difference calculation unit 662C calculates the angle difference ⁇ s, which is the absolute value of the difference between the angle ⁇ of the calculation results (output values) of the IMU 25, 26, 27, and 28 and the tilt angle ⁇ s of the calculation result of the tilt angle calculation unit 67. do. Since the tilt angle ⁇ s of the calculation result of the tilt angle calculation unit is the true value of the calculation angles of the IMUs 25, 26, 27, and 28 when the vehicle bodies 2 and 3 are stationary, the calculation accuracy of the IMU determines the required accuracy for the angle difference ⁇ s. It is an index of whether or not it is satisfied. The angle difference calculation unit 662C outputs the calculated angle error ⁇ s to the comparison determination unit 663C.
  • the comparison determination unit 663C compares the angle difference ⁇ s calculated by the angle difference calculation unit 662C with the permissible angle error of the calculation result of the required angle accuracy calculation unit 62, so that the calculation accuracy of the IMU 25, 26, 27, 28 is the second. 2 It is for determining whether or not the required accuracy is satisfied.
  • the comparison determination unit 663C secondly requests the accuracy of the angle calculation of the IMU 25, 26, 27, 28. It is determined that the accuracy is not satisfied, and the low accuracy flag is enabled.
  • step S60 is a procedure for evaluating the accuracy of the angle calculation of IMU 25, 26, 27, 28 of the IMU calculation accuracy evaluation unit 63 of the first embodiment
  • step S60C shown in FIG. 18 is executed. Will be done.
  • the tilt angle calculation unit 67 of the IMU calculation accuracy evaluation unit 63C calculates the tilt angle ⁇ s based on the accelerations detected by the IMUs 25, 26, 27, and 28 (step S620C).
  • the angle difference calculation unit 662C of the calculation accuracy determination unit 66C of the IMU calculation accuracy evaluation unit 63C determines the angle ⁇ of the calculation result of the IMU 25, 26, 27, 28 and the tilt angle ⁇ s of the calculation result of the tilt angle calculation unit 67.
  • the angle difference ⁇ s which is the absolute value of the difference, is calculated (step S630C), and the process proceeds to step S635.
  • step S635 the same determination as in step S610 in the case of the first embodiment is performed. That is, the operation determination unit 65 determines whether or not the operation state of the vehicle bodies 2 and 3 is a predetermined stop state in which the accuracy of the angle calculation of the IMU is lowered. When the operation determination unit 65 determines that the vehicle bodies 2 and 3 are in a predetermined stopped state (YES), the process proceeds to step S640C. On the other hand, if it is determined as NO, the process proceeds to step S660 as in the case of the first embodiment.
  • step S640C it is determined whether or not the angle difference ⁇ s calculated by the angle difference calculation unit 662C is larger than the allowable angle error ⁇ a of the required angle accuracy calculation unit 62. If the angle difference ⁇ s is larger than the allowable angle error ⁇ a (YES) in step S640C, the process proceeds to step S650, and the comparison determination unit 663C enables the low accuracy flag. On the other hand, when the angle difference ⁇ s is equal to or less than the allowable angle error ⁇ a (NO), the process proceeds to step S660, and the comparison determination unit 663B invalidates the low accuracy flag.
  • the procedure of step S60C is completed by the end of step S650 or step S660.
  • the thick broken line shows the IMU calculation angle ⁇ (output value)
  • the solid line shows the tilt angle ⁇ s of the calculation result of the tilt angle calculation unit of the IMU calculation accuracy evaluation unit.
  • the vehicle bodies 2 and 3 vibrate, so that acceleration is generated in various directions.
  • the tilt angle ⁇ s calculated by the tilt angle calculation unit 67 of the IMU calculation accuracy evaluation unit 63C of the controller 40 becomes a vibrational behavior.
  • the detection result of the angular velocity sensor 32 is mainly used to suppress that the angle ⁇ of the calculation result becomes oscillating.
  • the calculation angle ⁇ deviates from the true value ⁇ true due to the effect of smoothing.
  • the acceleration due to the vibration does not occur, so that the inclination angle ⁇ s of the calculation result of the inclination angle calculation unit 67 substantially coincides with the true value ⁇ true .
  • the angle ⁇ of the calculation results of the IMUs 25, 26, 27, and 28 is different from the true value ⁇ true .
  • the acceleration due to vibration is extremely small or no acceleration occurs, so that the temporal change of the angle ⁇ of the calculation results of IMU25, 26, 27, 28 temporarily stops. ing.
  • the angle change amount ⁇ of the calculation result of the angle change amount calculation unit 662B of the calculation accuracy determination unit 66B of the controller 40 is the angle threshold ⁇ th between the time ta and the time tb. It becomes as follows. Therefore, the comparison determination unit 663B of the calculation accuracy determination unit 66B makes an erroneous determination that the calculation accuracy of the IMUs 25, 26, 27, and 28 satisfies the required accuracy.
  • the angle difference ⁇ s of the calculation result of the angle difference calculation unit 662C of the calculation accuracy determination unit 66C becomes larger than the allowable angle error ⁇ a between the time ta and the time tb. There is. Therefore, the comparison determination unit 663C can correctly determine that the calculation accuracy of the IMUs 25, 26, 27, and 28 does not satisfy the required accuracy. As described above, in the third embodiment, it is possible to suppress the erroneous determination as in the second embodiment.
  • the comparison determination unit 663C can correctly determine that the calculation accuracy of the IMUs 25, 26, 27, and 28 satisfies the required accuracy. ..
  • the controller 40 stops or warns the operation support of the front work device 1, so that the posture information is inaccurate when the operation support of the front work device 1 is executed. Can be suppressed from being used.
  • the required accuracy calculation of the controller 40 calculates the allowable angle error ⁇ a, which is the allowable error of the angle dimension as the second required accuracy
  • the accuracy determination of the controller 40 is the IMU25.
  • 26, 27, 28 calculates the angle ⁇ s with respect to the reference plane, and the angle ⁇ s calculated by the controller 40 and IMU25, 26, 27, 28 (angle measuring device) calculates. It is performed by calculating the angle difference ⁇ s, which is the absolute value of the difference from the calculated angle ⁇ , and comparing the calculated angle difference ⁇ s with the allowable angle error ⁇ a, and when the calculated angle difference ⁇ s is larger than the allowable angle error ⁇ a.
  • it is determined that the accuracy of the angle calculation of the IMUs 25, 26, 27, 28 (angle measuring device) does not satisfy the second required accuracy.
  • a conversion table for setting a comparison target for accuracy determination of angle calculation of IMU25, 26, 27, 28 is defined based on experimental data acquired by using an expensive sensor.
  • a conversion table is unnecessary, a large number of man-hours are not required for mounting on the controller 40.
  • the angle ⁇ s calculated by the controller 40 based on the acceleration of the detection result of IMU25, 26, 27, 28 (angle measuring device) and the angle ⁇ of the calculation result of IMU25, 26, 27, 28 (angle measuring device) Since the accuracy of the angle calculation of the IMU25, 26, 27, 28 (angle measuring device) is determined based on the difference, the calculation result of the IMU25, 26, 27, 28 (angle measuring device) is low in accuracy and its time. Even if the amount of change does not change temporarily, it is possible to make a judgment with few errors by a simple calculation.
  • FIG. 20 is a block diagram showing a functional configuration of a controller according to a fourth embodiment of the construction machine of the present invention.
  • FIG. 21 is a block diagram showing a functional configuration of a required angle precision calculation unit that constitutes a part of the positioning calculation unit of the controller shown in FIG. 20.
  • those having the same reference numerals as those shown in FIGS. 1 to 19 have the same reference numerals, and therefore detailed description thereof will be omitted.
  • the fourth embodiment of the construction machine of the present invention shown in FIGS. 20 and 21 differs from the first embodiment in that the function of the calculation request angle calculation unit 62D in the positioning calculation unit 51 of the controller 40.
  • the composition is different.
  • the calculation request angle calculation unit 62 (same for the second and third embodiments) according to the first embodiment has the required accuracy (allowable dimensional error as finishing accuracy) set by the requirement accuracy setting device 19. ), The required accuracy (allowable angle error) for the angle calculation of the IMU is calculated.
  • the attitude information of the hydraulic excavator provided by the machine guidance is determined by both the position information of the positioning system 35 and the angle information of the IMUs 25, 26, 27, and 28.
  • the required angle calculation unit 62D in the present embodiment sets the required accuracy of the angle calculation of the IMUs 25, 26, 27, and 28 in consideration of the accuracy of the position information of the positioning system 35. ..
  • the required angle accuracy calculation unit 62D has the same error conversion table 621 as in the first embodiment, as well as the first required accuracy (allowable dimensional error) set by the required accuracy setting device 19. Therefore, it has a configuration for calculating the required accuracy to be compensated by the calculation of IMU25, 26, 27, 28 using the dispersion value (value corresponding to the calculation error) of the position and speed of the positioning calculation of the GNSS receiver 38. .. That is, when the error in the positioning calculation of the GNSS receiver 38 is large, the required angle accuracy calculation unit 62D adjusts so as to increase the required accuracy of the angle calculation of the IMUs 25, 26, 27, and 28 by that amount. ..
  • the standard deviation (square root of the variance ⁇ 2 ) of the positioning calculation is about 2 cm even when the reception environment of the satellite positioning signal is good and RTK positioning is executed. Therefore, it is difficult to use the standard deviation (square root of variance) of the positioning calculation as it is with respect to the required accuracy (allowable dimensional error) of the required accuracy setting device 19. This is because when the required accuracy at the time of finishing work is set to 2 cm, if the standard deviation of the positioning calculation is simply subtracted from the required accuracy of the required accuracy setting device 19, it should be compensated by the angle calculation of IMU25, 26, 27, 28. Since the dimensional accuracy is 0 cm, no error is allowed in the angle calculation of IMU25, 26, 27, 28.
  • the required angle accuracy calculation unit 62D includes a conversion table 624 that converts the variance value of the positioning calculation of the GNSS receiver 38 into the adjustment dimension.
  • the adjustment dimension indicates the magnitude of the tolerance of the dimension of the dimension to be adjusted with respect to the error of the positioning calculation of the GNSS receiver 38 in the angle calculation of IMU 25, 26, 27, 28.
  • the adjustment dimension is 0 when the variance value of the positioning operation is the predetermined value ⁇ 2 th or less, and the variance value becomes large when the variance value is larger than the predetermined value ⁇ 2 th . It has the characteristic that the adjustment dimension increases accordingly. That is, if the positioning state of the positioning system 35 is good, the adjustment dimension is set to 0 cm. On the other hand, when the positioning state deteriorates and the variance value of the positioning calculation becomes large, the adjustment dimension becomes a value corresponding to the magnitude of the variance value.
  • the required accuracy calculation unit 62D requests the angle calculation of the IMU 25, 26, 27, 28 by subtracting the adjustment dimension set in the conversion table 624 from the allowable dimensional error set in the required accuracy setting device 19. It is provided with a tolerance adjusting unit 625 for adjusting the accuracy.
  • the permissible error adjusting unit 625 calculates the permissible dimensional error, which is the required accuracy of the dimensional dimension for the angle calculation of the IMU 25, 26, 27, 28, according to the error of the position information of the GNSS receiver 38.
  • the tolerance adjustment unit 625 outputs the allowable dimensional error of the calculation result to the conversion table 621.
  • the tolerance adjustment unit 625 is configured so as to instruct the monitor display control unit 53 (guidance execution unit 531) to execute the warning display.
  • the conversion table 621 is the same as the conversion table of the first embodiment, and the allowable angle error is set according to the allowable dimensional error from the allowable error adjusting unit 625.
  • the set allowable angle error is output to the IMU calculation accuracy evaluation unit 63.
  • the controller 40 stops or warns the operation support of the front work device 1, so that the posture information is inaccurate when the operation support of the front work device 1 is executed. Can be suppressed from being used.
  • the hydraulic excavator (construction machine) is attached to the vehicle bodies 2 and 3, and has GNSS antennas 36 and 37 (receivers) that receive positioning signals from a plurality of satellites and GNSS antennas 36 and 37. Further equipped with a GNSS receiver 38 (positioning calculation device) that calculates the dispersion value of the positions of the vehicle bodies 2 and 3 and the positions of the vehicle bodies 2 and 3 based on the positioning signals from a plurality of satellites received by the (receiver). There is. Further, the required accuracy calculation of the controller 40 is performed when the dispersion value of the positions of the vehicle bodies 2 and 3 is larger than the predetermined value ⁇ 2th when the accuracy of the dimension dimension is set as the first required accuracy.
  • the allowable accuracy of the dimension dimension for the angle calculation of IMU25, 26, 27, 28 (angle measuring device). Allowable dimensional error calculated by calculating the allowable dimensional error Using the conversion table 621 pre-defined so that the second required accuracy decreases as the allowable dimensional error increases, the allowable dimensional error calculated by the allowable error calculation is performed. The second required precision is calculated from.
  • the adjustment dimension set according to the dispersion value of the position of the calculation result of the GNSS receiver 38 (positioning calculation device) is subtracted from the first required accuracy set for the operation support. Since the second required accuracy is set based on the above, the required accuracy of the angle calculation of the IMU25, 26, 27, 28 (angle measuring device) according to the magnitude of the calculation error of the position information of the GNSS receiver 38 (positioning calculation device). You can adjust the height of.
  • the position information of the GNSS receiver 38 (positioning calculation device) is low accuracy, the required accuracy of the angle calculation of IMU25, 26, 27, 28 (angle measurement device) is made stricter, which makes it impossible to execute operation support. The use of accurate posture information can be further suppressed.
  • FIG. 22 is a block diagram showing a functional configuration of a controller according to a fifth embodiment of the construction machine of the present invention.
  • those having the same reference numerals as those shown in FIGS. 1 to 21 have the same reference numerals, and therefore detailed description thereof will be omitted.
  • the fifth embodiment of the construction machine of the present invention shown in FIG. 22 differs from the second embodiment in that the calculation accuracy of the IMU calculation accuracy evaluation unit 63E in the positioning calculation unit 51 of the controller 40 is determined. The result is output to the hydraulic system control unit 54, and the control of the hydraulic system control unit 54 is changed according to the determination result of the calculation accuracy.
  • the error of the calculation angle of the IMU is not large immediately after the running operation or the turning operation of the vehicle body is started (immediately after the time t1). However, if the operation is continued, the error of the calculation angle gradually increases due to the influence of the sensor bias of the IMU. On the contrary, if the operation is not continued, the calculation accuracy of the IMU does not deviate from the required accuracy, so that the work can be continued.
  • the calculation accuracy of the IMU 25, 26, 27, 28 if the calculation accuracy of the IMU 25, 26, 27, 28 deviates from the required accuracy due to the traveling motion or the turning motion of the vehicle bodies 2, 3, the calculation accuracy of the IMU 25, 26, 27, 28 is lowered. Immediately stop the traveling motion or turning motion that is a factor. Specifically, when it is determined by the operation determination unit 65E of the IMU calculation accuracy evaluation unit 63E that the running or turning operation continues for a certain predetermined period or longer, the angle calculation of the IMU 25, 26, 27, 28 is performed. When the IMU calculation accuracy evaluation unit 63E evaluates that the accuracy of the above does not satisfy the required accuracy, the hydraulic system control unit 54 of the controller 40 controls the hydraulic system so as to stop the operation.
  • step S570 the operation determination unit 65E determines whether or not the travel flag is valid for a predetermined period or longer during the continuation of the control cycle, and the swivel flag is valid for a predetermined period or longer. It may be configured to determine whether or not it is present.
  • the operation determination unit 65E performs OR processing on the determination of whether or not the traveling flag is valid and whether or not the turning flag is valid, and the operating state of the vehicle bodies 2 and 3 is predetermined. The information indicating that it has continued for a period or more is integrated into one signal.
  • this control be configured so that it can be switched between valid and invalid at any timing by a tablet terminal or the like.
  • the operating states of the vehicle bodies 2 and 3 are continuously continued for a predetermined period or more based on the detection results of the IMU 25, 26, 27, 28 (angle measuring device).
  • IMU25, 26, 27, 28 (angle measuring device) when it is determined that the operating state of the vehicle bodies 2 and 3 has continued for a predetermined period or more by performing an operation continuation determination for determining whether or not the vehicle body has been operated. If it is determined that the accuracy of the angle calculation of the above does not satisfy the second required accuracy, the operation of the vehicle bodies 2 and 3 is stopped.
  • FIG. 23 is a block diagram showing a functional configuration of a controller according to a sixth embodiment of the construction machine of the present invention.
  • those having the same reference numerals as those shown in FIGS. 1 to 22 have the same reference numerals, and therefore detailed description thereof will be omitted.
  • the sixth embodiment of the construction machine of the present invention shown in FIG. 23 is different from the first embodiment in that the required angle accuracy calculation unit 62F in the positioning calculation unit 51 of the controller 40 is the construction management system 100. It is to calculate the permissible angle error which is the second required accuracy based on the construction information managed in.
  • the construction management system 100 is, for example, a cloud system that manages the progress of construction at the site such as construction information.
  • the construction information includes permissible dimensional error, which is the required accuracy of the dimensional dimension as design information.
  • the required angle accuracy calculation unit 62F has IMUs 25, 26, 27 based on the required accuracy included in the construction information input from the construction management system 100 to the construction target surface calculation. , 28 Calculate the required accuracy of the dimension of the angle for the angle calculation.
  • the controller 40 can be configured to change the required accuracy (first required accuracy) included in the construction information according to the progress of the construction managed by the construction management system 100. For example, as the progress of the construction managed by the construction management system 100 progresses, the permissible dimensional error as design information is changed to be smaller (increasing the required accuracy).
  • the set value for rough excavation for example, 10 cm
  • finish excavation gradually progresses as the construction progresses.
  • the set value of for example, 2 cm
  • the first required accuracy (allowable dimensional error) is set via the required accuracy setting device 19 by the operator's own operation.
  • the operator needs to change the required accuracy according to the operation such as rough excavation and finish excavation, so that the operator's operation becomes complicated.
  • the controller 40 manages the construction with the required accuracy included in the construction information managed by the construction management system 100 that manages the progress state of the construction at the site as the first required accuracy. It is configured to take in from the system 100 and increase the first required accuracy as the progress of the construction managed by the construction management system 100 progresses.
  • the first required accuracy is set regardless of the operation of the operator, so that the time and effort of the operation of the operator can be reduced. Further, since the controller 40 automatically changes the first required accuracy according to the progress of construction, the operator does not need to reset the required dimensional accuracy according to operations such as rough excavation and finish excavation, and the operator does not need to reset the required dimensional accuracy. The time and effort of operation can be reduced.
  • the present invention is not limited to the present embodiment, and includes various modifications.
  • the above-described embodiments have been described in detail in order to explain the present invention in an easy-to-understand manner, and are not necessarily limited to those having all the described configurations. It is possible to replace a part of the configuration of one embodiment with the configuration of another embodiment, and it is also possible to add the configuration of another embodiment to the configuration of one embodiment. It is also possible to add, delete, or replace a part of the configuration of each embodiment with another configuration.

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Mechanical Engineering (AREA)
  • Operation Control Of Excavators (AREA)
  • Component Parts Of Construction Machinery (AREA)

Abstract

建設機械は、車体及び作業装置への設置部分の加速度及び角速度を検出すると共に検出結果に基づき当該設置部分の基準面に対する角度を演算する角度計測装置と、角度計測装置からの角度に基づき演算した車体及び作業装置の姿勢情報を基に作業装置の操作支援を実行するコントローラを備える。コントローラは、操作支援に対して設定された第1要求精度に基づき角度計測装置の角度演算に対する第2要求精度を演算し、角度計測装置の検出結果に基づき車体が動作中から停止状態へ変化しているかを判定し、角度計測装置の演算精度が第2要求精度を満たしているかを判定し、車体が停止状態へ変化した場合かつ演算精度が第2要求精度を満たしていない場合に作業装置の操作支援の停止または警告を講じる。

Description

建設機械
 本発明は、位置や姿勢が変化する作業装置を備えた建設機械に係り、更に詳しくは、作業装置などに取り付けられた計測装置から出力される角度情報を含む各種情報を基にオペレータの操作支援を行う建設機械に関する。
 油圧ショベルなどの建設機械の分野では、近年、建設施工に情報通信技術を適用することで多様な情報を効率的に活用して施工の合理化を図る情報化施工の導入が進められている。例えば、ブーム、アーム及びバケットなどの複数部材を連結した多関節型の作業装置の位置や姿勢をオペレータへ表示するマシンガイダンスや、当該作業装置を目標施工面に沿って動くように制御するマシンコントロールなどのオペレータの操作を支援する機能を有するものがある。
 マシンガイダンスやマシンコントロールなどの操作支援を行うときに、施工現場における自車の座標を利用するものを3次元情報化施工(以下、3D情報化施工と称す)という。3D情報化施工に対応する建設機械では、自車の位置を取得するために、衛星測位システム(Global Navigation Satellite System:GNSS)を備えている。GNSSは、複数の衛星からの測位信号を受信して自車の3次元位置(緯度、経度、高度)を測定するものである。油圧ショベルのように作業装置を備える建設機械では、自車の位置だけでなく、作業装置が向いている方向(方位)も操作支援に必要である。そのため、測位信号を受信するGNSSアンテナを2つ搭載し、それらが受信した測位信号を基に作業装置の方位を特定する建設機械が公知である。
 マシンガイダンスでは、バケット(作業具)のつめ先(先端位置)を施工目標面に沿って動作させるための各種情報をオペレータに提示するので、自車の位置情報だけでなく、作業装置の姿勢情報も重要である。そこで、作業装置を構成するブーム、アーム、バケットにはそれぞれ、角度を取得するためのセンサが取り付けられている。当該センサとして、取付の容易性や応答性の観点から、慣性計測装置(Inertial Measurement Unit:IMU)が選定されることが多い。
 マシンガイダンスは、上述の通り、GNSSとIMUを併用して油圧ショベルの位置や姿勢を算出し、それらの情報をオペレータに提示する。したがって、GNSSから取得した位置やIMUから取得した角度の情報が実際の情報から乖離している場合には、不正確な情報がオペレータに対して提示されることになる。オペレータが不正確な情報に基づいて掘削作業を継続すると、目標とする施工面に対して地面を掘り過ぎてしまったり掘削量が不足したりすることで、施工のやり直しが必要になる懸念がある。
 このような課題に対して、特許文献1に記載の技術が知られている。特許文献1に記載の作業機械は、情報化施工の実行の際に作業装置(作業機)を的確に継続して制御すること及び作業のガイダンス画面に適正な情報を表示することのうち少なくとも1つを実現するために、GNSSを利用して自車(作業機械)の位置を検出する位置検出装置、及び、作業機械の動作を示す動作情報を検出する状態検出装置(IMU)を備えており、作業機の位置データの生成に用いる位置情報を位置検出装置の測位の状態及び作業機械の動作状態に応じて選択している。具体的には、位置検出装置による測位が正常である場合(第1モードの場合)には、位置検出装置により検出された位置の情報が当該位置情報として用いられる一方、測位が異常かつ作業機械が静定状態である場合(第2モードの場合)には、測位が異常となる前における作業機械の基準となる特定点及び状態検出装置(IMU)により検出された動作情報の両方を用いて求めた位置の情報が当該位置情報として用いられる。なお、測位が異常かつ作業機械が非静定状態である場合(第3モードの場合)には、位置情報が提供されないようになっている。
国際公開第2015/167022号
 特許文献1に記載の技術は、作業機の位置(例えば、バケットの刃先位置)のデータ生成に用いる作業機械の位置情報が正確である場合に限り、当該位置情報を操作支援(マシンガイダンス)に利用するものである。しかし、特許文献1に記載の技術においても、作業機の位置(バケットの刃先位置)のデータを生成するためには、作業機械の位置情報に加えて作業機械の角度情報を用いる必要がある。したがって、作業機械の角度情報が不正確である場合には、上述の作業機械の位置情報が正確であっても、バケットの刃先位置を正確に算出することは困難である。
 ところで、前述したように、建設機械の角度情報を取得するセンサとして、IMUが用いられることがある。IMUは、加速度センサ及び角速度センサの2つのセンサを備えた装置であり、加速度センサにより検出された加速度及び角速度センサにより検出された角速度を用いることで角度を演算する角度演算機能も備えている。IMUは、次の2つの演算方法を切り替え、または、組み合わせて角度を演算している。第1の方法は、加速度センサによって検出された加速度と重力加速度とを比較することで基準面(例えば、水平面)に対する角度を算出するものである。第2の方法は、角速度センサによって検出された角速度を積分することで角度を算出するものである。ただし、第2の方法は、建設機械が静止状態のときの或る角度を起点とした角度変化しか算出することができない。このため、建設機械の静止時の任意の角度を算出可能な第1の演算方法を主に用いることが考えられる。
 しかし、第1の演算方法は、重力加速度を参照値として用いるので、重力加速度以外の加速度が生じると角度を正確に算出することができなくなる場合がある。建設機械では、走行動作の開始や停止などによって並進加速度が生じると共に、旋回動作によって遠心加速度が生じる。このような状況下では、第1の演算方法では、「静止時に検出した加速度と重力加速度を比較する」という条件が成立していないので、当該方法の演算精度は低下する。このため、IMUの角度演算では、第1及び第2の演算方法による2つの演算結果をカルマンフィルタや相補フィルタなどにより統合することで演算結果の精度低下を抑制する技術が知られている。しかし、このような技術を用いても、IMUの角度演算の精度低下を無効化することは極めて困難である。
 IMUの角度演算の精度低下について以下に具体的に説明する。建設機械が停止状態から走行動作を開始すると、車体に加速度が生じるので、IMUが検出した加速度の合成値が重力加速度と一致しない。この場合、IMUの角度演算として第1の方法を用いることができないので、走行動作の開始後の適切な時期に、演算方法が第1の方法から第2の方法へと切り替わる。走行中は、走行速度が一定の場合でも車体に振動が生じて車体に加速度が生じるので、第2の演算方法が維持される。このため、走行継続中は、角速度センサにより検出された角速度を逐次積分することで角度演算が行われるので、角速度センサのバイアスの影響が積分演算により積み重なることで演算誤差が徐々に大きくなってしまう。その後、建設機械が走行状態から完全に停止すると、停止後の適切な時期にIMUの角度演算が第2の方法から第1の方法へと切り替わる。第2の方法から第1の方法へ演算方法を切り替えても、第2の方法の演算結果と第1の方法の演算結果に対して補間処理やフィルタ処理などの処理を行うことで演算結果の連続性を担保している。このため、建設機械が完全に停止してIMUの角度演算が第1の方法に切り替わったとしても、完全な停止後の暫くの間、IMUが出力する角度情報には第2の演算方法に起因した誤差が残存するので、IMUの演算誤差が直ちに小さくなることはない。
 IMUの演算結果における上述の誤差を考慮せずに、走行動作が行われていないことのみを判断材料としてマシンガイダンスを実行すると、IMUの演算誤差を含む不正確な姿勢情報に基づいて操作支援が行われるので、施工面を傷つけてしまう懸念がある。したがって、建設機械では、停止状態であっても、走行や旋回の動作状態から停止状態への移行後の一定期間は、IMUの角度演算の精度が低下している場合があることを考慮する必要がある。
 本発明は、上記の事柄に基づいてなされたもので、その目的は、マシンガイダンスやマシンコントロールなどの作業装置の操作支援において不正確な姿勢情報が利用されることを抑制することができる建設機械を提供することである。
 本願は上記課題を解決する手段を複数含んでいるが、その一例を挙げるならば、車体と、前記車体に対して回動可能に取り付けられた作業装置と、前記車体及び前記作業装置に設置され、設置部分の加速度及び角速度を検出すると共に検出結果に基づき当該設置部分の基準面に対する角度を演算する角度演算を行う角度計測装置と、前記角度計測装置により演算された角度に基づいて前記車体及び前記作業装置の姿勢を示す姿勢情報を演算し、演算された姿勢情報を表示装置に表示させると共に、演算された姿勢情報に基づいて前記作業装置の操作支援を実行するコントローラとを備えた建設機械において、前記コントローラは、前記作業装置の操作支援に用いられる情報に対して設定された要求精度である第1要求精度に基づいて、前記角度計測装置の前記角度演算に対する要求精度である第2要求精度を演算する要求精度演算を行い、前記角度計測装置の検出結果に基づいて、前記車体が動作している状態から停止状態へと変化しているか否かを判定する動作停止判定を行い、前記角度計測装置の前記角度演算の精度が前記第2要求精度を満たしているか否かを判定する精度判定を行い、前記車体が動作している状態から停止状態へと変化したと判定し、且つ、前記角度計測装置の前記角度演算の精度が前記第2要求精度を満たしてないと判定した場合には、前記作業装置の操作支援の停止または警告を講じることを特徴とする。
 本発明によれば、車体が停止状態であっても、角度計測装置の角度演算の精度が要求精度を満たしていない場合には、コントローラがマシンガイダンスやマシンコントロールなどの作業装置の操作支援の停止または警告を講じるので、作業装置の操作支援の実行の際に不正確な姿勢情報が利用されることを抑制することができる。
  上記した以外の課題、構成及び効果は、以下の実施形態の説明により明らかにされる。
本発明の建設機械の第1の実施の形態を適用した油圧ショベルを示す斜視図である。 本発明の建設機械の第1の実施の形態及びその一部を構成するコントローラの機能ブロックを示す図である。 本発明の建設機械の第1の実施の形態の一部を構成する慣性計測装置(IMU)の角度演算の精度低下を示す説明図である。 図2に示すコントローラのポジショニング演算部の機能構成及びモニタ表示部の機能構成を示すブロック図である。 図4に示すコントローラのポジショニング演算部の一部を構成する要求角度精度演算部の機能構成を示すブロック図である。 図4に示すコントローラのポジショニング演算部の一部を構成するIMU演算精度評価部の機能構成を示すブロック図である。 本発明の建設機械の第1の実施の形態を構成するコントローラにおけるガイダンス実行の判断の処理手順の一例を示すフローチャートである。 図7に示すフローチャートにおける車体の動作状態の判定の処理手順の一例を示すフローチャートである。 図7に示すフローチャートにおけるIMUの演算精度の判定の処理手順の一例を示すフローチャートである。 本発明の建設機械の第1の実施の形態の変形例におけるコントローラのポジショニング演算部の一部を構成する要求角度精度演算部の機能構成を示すブロック図である。 本発明の建設機械の第2の実施の形態におけるコントローラの機能構成を示すブロック図である。 図11に示すコントローラのポジショニング演算部の一部を構成するIMU演算精度評価部の機能構成を示すブロック図である。 図12に示す本発明の建設機械の第2の実施の形態のコントローラのIMU演算精度評価部における精度評価の方法を示す説明図である。 図12に示す本発明の建設機械の第2の実施の形態におけるコントローラのIMU演算精度評価部の処理手順の一例を示すフローチャートである。 本発明の建設機械の第2の実施の形態における問題点を示す説明図である。 本発明の建設機械の第3の実施の形態におけるコントローラの機能構成を示すブロック図である。 図16に示すコントローラのポジショニング演算部の一部を構成するIMU演算精度評価部の機能構成を示すブロック図である。 図17に示す本発明の建設機械の第2の実施の形態におけるコントローラのIMU演算精度評価部の処理手順の一例を示すフローチャートである。 本発明の建設機械の第3の実施の形態の作用及び効果を示す説明図である。 本発明の建設機械の第4の実施の形態におけるコントローラの機能構成を示すブロック図である。 図20に示すコントローラのポジショニング演算部の一部を構成する要求角度精度演算部の機能構成を示すブロック図である。 本発明の建設機械の第5の実施の形態におけるコントローラの機能構成を示すブロック図である。 本発明の建設機械の第6の実施の形態におけるコントローラの機能構成を示すブロック図である。
 以下、本発明の建設機械の実施の形態について図面を用いて説明する。本実施の形態においては、建設機械の一例として油圧ショベルを例に挙げて説明する。
 [第1の実施の形態]
  まず、本発明の建設機械の第1の実施の形態としての油圧ショベルの構成について図1及び図2を用いて説明する。図1は本発明の建設機械の第1の実施の形態を適用した油圧ショベルを示す斜視図である。図2は本発明の建設機械の第1の実施の形態及びその一部を構成するコントローラの機能ブロックを示す図である。ここでは、運転席に着座したオペレータから見た方向を用いて説明する。
 図1において、建設機械としての油圧ショベルは、掘削作業等を行うためのフロント作業装置1と、フロント作業装置1が回動可能に取り付けられた車体とで構成されている。車体は、自走可能な下部走行体2と、下部走行体2上に旋回可能に搭載された上部旋回体3とで構成されている。車体は、下部走行体2の走行動作や上部旋回体3の旋回動作の各動作に伴い変位するものである。
 フロント作業装置1は、複数の被駆動部材を垂直方向に回動可能に連結することで構成された多関節型の作業装置である。複数の被駆動部材は、例えば、ブーム6、アーム7、作業具としてのバケット8とで構成されている。ブーム6の基端部は、上部旋回体3の前部に回動可能に支持されている。ブーム6の先端部には、アーム7の基端部が回動可能に支持されている。アーム7の先端部には、バケット8が回動可能に支持されている。ブーム6、アーム7、バケット8はそれぞれ、油圧アクチュエータであるブームシリンダ10、アームシリンダ11、バケットシリンダ12によって駆動される。なお、バケット8は、バケット8と連動して回動するリンク部材13を介して駆動される。
 下部走行体2は、例えば、左右にクローラ式の走行装置14(一方側のみ図示)を備えている。走行装置14は、油圧アクチュエータである走行油圧モータ14aによって駆動する。
 上部旋回体3は、例えば、油圧アクチュエータである旋回油圧モータ4によって下部走行体2に対して旋回駆動されるように構成されている。上部旋回体3は、オペレータが搭乗する運転室16と、各種機器を収容する機械室17とを備えている。
 運転室16には、各油圧アクチュエータ4、10、11、12、14aを操作するための操作装置18a、18b、18cが設けられている。操作装置18a、18bは、例えば、前後左右に傾倒可能な操作レバーを有する電気式の操作レバー装置である。電気式の操作レバー装置18a、18bは、操作レバーの傾倒方向および傾倒量、すなわち操作方向および操作量を電気的に検出する検出装置(図示せず)を有しており、検出した操作方向および操作量に応じた操作信号をコントローラ40(図2参照)へ電気配線を介して出力する。操作レバー装置18a、18bの前後方向の操作および左右方向の操作はそれぞれ、各油圧アクチュエータ4、10、11、12の操作として割り当てられている。すなわち、操作レバー装置18a、18bの各操作は、フロント作業装置1の操作や上部旋回体3の旋回操作などとして割り当てられている。操作装置18cは、前後に傾倒可能な走行レバー及び走行ペダルを有する電気式の操作装置である。操作装置18cは、油圧アクチュエータ14aの操作、すなわち、左右の走行装置14の走行操作として割り当てられている。また、運転室16には、各種情報の表示や入力が可能なモニタ19(図2参照)が設置されている。
 なお、操作装置18a、18b、18cは、電気式でなく、油圧式で構成することも可能である。この構成の場合、各操作装置18a、18b、18cの操作方向及び操作量に応じた操作パイロット圧を制御弁ユニット23の各制御弁に対して駆動信号として供給することで、各油圧アクチュエータ4、10、11、12、14aを駆動させるように構成する。
 機械室17には、エンジンや電動機などの原動機21や原動機21により駆動される油圧ポンプ装置22などが配置されている。油圧ポンプ装置22から吐出された圧油が油圧アクチュエータ4、10、11、12、14aの各々に供給されることで各油圧アクチュエータ4、10、11、12、14aが駆動する。各油圧アクチュエータ4、10、11、12、14aの駆動は、各油圧アクチュエータ4、10、11、12、14aに対応する制御弁の集合体である制御弁ユニット23によって制御される。制御弁ユニット23を構成する各制御弁は、対応する油圧アクチュエータ4、10、11、12、14aに対して油圧ポンプ装置22から供給される圧油の方向及び流量を制御するものである。各制御弁の駆動は、例えば、パイロットポンプ(図示せず)から電磁比例弁(図示せず)を介して出力される操作パイロット圧により制御される。各電磁比例弁が操作装置18a、18b、18cからの操作信号に基づいてコントローラ40により制御されることで、制御弁ユニット23の各制御弁を介して各油圧アクチュエータ4、10、11、12、14aの動作が制御される。
 上部旋回体3には、図1及び図2に示すように、車体の動作及び姿勢に関する情報を計測する慣性計測装置(Inertial Measurement Unit:IMU)25が設置されている。また、フロント作業装置1の構成部材であるブーム6、アーム7、バケット8にもそれぞれ、各構成部材6、7、8の姿勢に関する情報を計測する慣性計測装置(IMU)26、27、28が設置されている。これら4つの慣性計測装置25、26、27、28を区別するため、上部旋回体3(車体)用の慣性計測装置25を車体IMU、ブーム6用の慣性計測装置26をブームIMU、アーム7用の慣性計測装置27をアームIMU、バケット8用の慣性計測装置28をバケットIMUと称する。なお、バケットIMU28は、バケット8ではなく、バケット8と連動して回動するリンク部材13に設置することも可能である。
 IMUは、加速度センサ31及び角速度センサ32(ともに図4参照)の2つのセンサを備えた装置であり、加速度センサにより検出された加速度及び角速度センサにより検出された角速度を用いて角度を演算する角度演算機能(角度演算部33)を有している。IMUは、次の2つの演算方法を組み合わせて角度を演算している。第1の方法は、加速度センサが検出した加速度と重力加速度とを比較することで、基準面(例えば、水平面)に対する角度を演算するものである。第2の方法は、角速度センサが検出した角速度を積分することで角度を演算するものである。ただし、第2の方法は、建設機械が静止状態のときの或る角度を起点とした角度変化しか算出することができない。このため、IMUの角度演算としては、建設機械の静止時の任意の角度を算出可能な第1の方法が主に用いられる。
 車体IMU25は、上部旋回体3(設置部分)に生じる加速度及び角速度を検出すると共に、検出結果(加速度及び角速度)に基づき当該設置部分3の基準面に対する角度を演算する角度演算を行うものである。具体的には、車体IMU25は、上部旋回体3が静止状態のとき、車体IMU25に設定されたIMU座標系において検出された重力加速度の方向(鉛直下向きの方向)および車体IMU25の取付状態(車体IMU25と上部旋回体3との相対的な位置関係)に基づき、水平面に対する上部旋回体3の前後方向への傾き(ピッチ角)および左右方向(幅方向)への傾き(ロール角)を演算することが可能である。車体IMU25は、上部旋回体3(車体)の加速度及び角速度の検出結果(上部旋回体3の動作に関する情報)及び車体2、3のピッチ角及びロール角(角度情報)の演算結果(車体の姿勢に関する情報)をコントローラ40へ出力する。
 ブームIMU26、アームIMU27、バケットIMU28はそれぞれ、設置部分(ブーム6、アーム7、バケット8)の角速度及び加速度を検出すると共に、検出結果(加速度及び角速度)に基づき当該設置部分6、7、8の基準面に対する角度を演算する角度演算を行うものである。ブームIMU26、アームIMU27、バケットIMU28は、車体IMU25と同様に、車体が静止している場合、各IMU26、27、28に設定されたIMU座標系において検出された重力加速度の方向および各IMU26、27、28の取付状態(フロント作業装置1の各構成部材6、7、8との相対的な位置関係)に基づいて、各構成部材6、7、8の角度情報を演算することが可能である。ブームIMU26、アームIMU27、バケットIMU28はそれぞれ、各構成部材6、7、8の角速度及び加速度の検出結果及び各構成部材6、7、8の角度情報の演算結果(各構成部材6、7、8の姿勢に関する情報)をコントローラ40へ出力する。
 これら4つの車体IMU25、ブームIMU26、アームIMU27、バケットIMU28は、上部旋回体3及びフロント作業装置1の各構成部材6、7、8の加速度及び角速度を検出すると共に検出結果の加速度及び角速度に基づいて角度演算を行うことで、建設機械の姿勢に関する情報を計測する角度計測装置として機能するものである。
 上部旋回体3には、複数の衛星からの測位信号を受信可能な受信装置としての2つのGNSSアンテナ36、37が取り付けられている。各GNSSアンテナ36、37が受信した測位信号は、図2に示すGNSS受信機38に入力される。GNSS受信機38は、GNSSアンテナ36、37が受信した測位信号を基に、アンテナ座標(車体の特定部分の位置)の演算や上部旋回体3(車体)の方位角の演算などの測位演算を行う測位演算装置として機能するものである。GNSSアンテナ36、37とGNSS受信機38は、油圧ショベルに対する衛星測位を行う測位システム35(図4参照)を構成している。GNSS受信機38は、上述の位置及び方位角の演算に統計処理を用いているので、当該位置及び方位角に加えてそれらの分散も同時に計算している。また、GNSS受信機38は、GNSSアンテナ36、37(車体)の位置だけでなく、速度も演算可能である。GNSS受信機38は、測位演算の演算結果であるGNSSアンテナ36、37(車体)の位置及び速度や上部旋回体3(車体)の方位角、並びに、それらの分散をコントローラ40へ出力する。
 GNSS受信機38(測位システム35)は、現場内に設置されたGNSS固定局に無線通信を介して接続することで、RTK(Real Time Kinematic)測位を実行することが可能である。GNSS固定局がない現場の場合には、インターネットを介して電子基準局の情報を取得するネットワーク型RTKを利用した測位を実行することが可能である。以下、現場内の固定局の有無を問わず、GNSS受信機38がRTK測位を実行可能であることを想定している。
 コントローラ40は、図2に示すように、GNSS受信機38の演算結果、並びに、車体IMU25、ブームIMU26、アームIMU27、バケットIMU28の検出結果及び角度演算の結果などに基づき、油圧ショベルの動作の制御やオペレータの操作支援を実行するものである。コントローラ40は、ハード構成として例えば、RAMやROM等からなる記憶装置41と、CPUまたはMPU等からなる処理装置42とを備えている。記憶装置41には、油圧ショベルの動作制御に必要なプラグラムや各種情報が予め記憶されている。処理装置42は、記憶装置41からプログラムや各種情報を適宜読み込み、当該プログラムに従って処理を実行することで以下の機能を含む各種機能を実現する。
 コントローラ40は、処理装置42により実行される機能の一部として、ポジショニング演算部51、施工目標面演算部52、モニタ表示制御部53、油圧システム制御部54を有している。
 ポジショニング演算部51は、GNSS受信機38の演算結果、並びに、車体IMU25、ブームIMU26、アームIMU27、バケットIMU28の検出結果及び角度演算の演算結果に基づき、油圧ショベルの作業現場内における位置(座標)及び方位、並びに、フロント作業装置1の姿勢情報を演算する姿勢演算を行うものである。フロント作業装置1の姿勢情報を算出するには、上部旋回体3とフロント作業装置1を構成するブーム6、アーム7、バケット8における各々の連結関係にある2つの部材の相対角を演算する必要がある。具体的には、ブーム6の相対角は、車体IMU25の演算結果の角度及びブームIMU26の演算結果の角度に基づいて算出される。アーム7の相対角は、ブームIMU26の演算結果の角度及びアームIMU27の演算結果の角度に基づいて算出される。バケット8の相対角は、アームIMU27の演算結果の角度及びバケットIMU28の演算結果の角度に基づいて算出される。ポジショニング演算部51は、施工目標面演算部52、モニタ表示制御部53、油圧システム制御部54へ演算結果を出力する。ポジショニング演算部51の演算結果の精度(油圧ショベルの実際上の位置や姿勢に対する誤差)は、これら各部52、53、54の演算や制御に影響を与えてしまう。そのため、ポジショニング演算部51の演算結果は高精度であることが求められている。ポジショニング演算部51の構成の詳細は後述する。
 施工目標面演算部52は、記憶装置41に予め記憶されている3次元施工図面などの施工情報、および、ポジショニング演算部51の演算結果の油圧ショベルの位置情報や姿勢情報に基づき、施工対象の目標形状を定義する施工目標面を演算するものである。施工情報は、例えば、入力デバイスとしてモニタ19などを介して施工管理者が入力したものである。また、施工目標面演算部52は、施工目標面と参照点(例えば、バケット8の爪先)との距離を算出する。なお、施工目標面は、オペレータがモニタ19を操作してその場で設定することも可能である。施工目標面演算部52は、モニタ表示制御部53及び油圧システム制御部54へ演算結果を出力する。
 モニタ表示制御部53は、運転室16内のモニタ19の表示を制御するものである。モニタ表示制御部53は、施工目標面演算部52の演算結果である施工目標面、並びに、ポジショニング演算部51の演算結果である油圧ショベルの位置情報及び姿勢情報に基づき、オペレータに対する操作支援の指示内容を演算し、演算結果を表示装置として機能するモニタ19に表示する。モニタ表示制御部53は、例えば、フロント作業装置1の姿勢ならびにフロント作業装置1のバケット8の先端位置や角度をモニタ19に表示することで、オペレータの操作を支援するマシンガイダンスシステムとしての機能の一部を担っている。GNSS受信機38の測位結果に異常が生じた場合、又は、4つのIMU25、26、27、28のいずれかの演算結果の角度情報の精度が設定された要求精度を満たしていない場合には、ガイダンスの実行を停止、または、ガイダンス中断の警告をモニタ19に表示させる構成が可能である。また、モニタ19に対して、画面表示だけでなく、音声を出力することで、作業指示や注意喚起を行うように構成することも可能である。すなわち、モニタ表示制御部53は、GNSS受信機38の測位結果やIMU25、26、27、28の演算結果に問題がある場合には、ガイダンスの実行に対して否定的な措置を講じるように構成されている。
 なお、モニタ19は、単なる表示デバイスではなく、タッチパネルを備えることで入力デバイスとして利用可能であることが望ましい。モニタ19は、例えば、運転室16内に据え付けた構成や可搬性のタブレット端末を運転室16内に着脱可能に設置する構成が可能である。
 油圧システム制御部54は、油圧ポンプ装置22、複数の油圧アクチュエータ4、10、11、12、14a、制御弁ユニット23(共に図1参照)を含む油圧システムを制御するものである。油圧システム制御部54は、例えば、施工目標面演算部52の演算結果である施工目標面並びにポジショニング演算部51の演算結果である油圧ショベルの位置情報及び姿勢情報に基づき油圧ショベルの動作を演算し、演算結果の動作を実現するように油圧システムを制御する。油圧システム制御部54は、バケット8の先端が施工目標面に一定以上接近しないように動作に制限をかけたり、バケット8が施工目標面に沿って動くよう制御したりするマシンコントロールシステムとしての機能の一部を担っている。油圧システム制御部54は、GNSS受信機38の測位結果に異常が生じたとき又は4つのIMU25、26、27、28のいずれかの演算結果の角度情報の精度が所定の要求精度を満たしていないときに、モニタ表示制御部53がガイダンスの実行を停止する場合には、それに応じてマシンコントロール機能を停止させることが望ましい。
 以下において、施工目標面演算部52とモニタ表示制御部53の両機能を併せたものをマシンガイダンスシステムと呼ぶ。また、施工目標面演算部52と油圧システム制御部54の両機能を併せたものをマシンコントロールシステムと呼ぶ。
 本実施の形態においては、1つのコントローラ40が図2に示す機能部をすべて実行するように構成しているが、各機能部をそれぞれ異なるコントローラが実行する構成も可能である。各機能部が別々のコントローラによって実装される場合、各機能部を構成するコントローラの集合体が油圧ショベルの姿勢情報を演算してフロント作業装置1の操作支援を実行するコントローラを構成する。
 次に、コントローラによるマシンガイダンスやマシンコントロールの実行に影響を及ぼすIMUの角度演算の精度低下について説明する。コントローラ40のポジショニング演算部51は、油圧ショベルの姿勢情報を演算するために、衛星の測位信号を利用したGNSS受信機38(測位システム35)の演算結果並びに4つのIMU25、26、27、28の検出結果及び演算結果を用いている。ポジショニング演算部51の演算結果の姿勢情報は、モニタ表示制御部53および油圧システム制御部54で用いられる。各IMU25、26、27、28の演算結果である角度情報の精度が低下すると、角度情報の精度低下の影響がポジショニング演算部51の演算結果に及ぶので、モニタ表示制御部53によってモニタ19に表示されるバケット8の爪先位置が実際の位置から変動してしまい、適切なマシンガイダンスを実行することができない懸念がある。また、油圧システム制御部54により制御されるバケット8の爪先位置が実際の位置とは異なってしまい、仕上げ面が波打つような形状になってしまう懸念がある。
 以下に、IMU25、26、27、28の演算結果の角度情報の精度低下が生じる具体的な例について図3を用いて説明する。図3は本発明の建設機械の第1の実施の形態の一部を構成する慣性計測装置(IMU)の角度演算の精度低下を示す説明図である。図3中、上段図は操作装置(走行レバーまたは走行ペダル)の操作量を、中段図はIMUが検出した加速度の合成値の一例を、下段図はIMUの角度演算の演算結果と真の角度との差分(IMUの演算角度の誤差)の一例を示している。IMUは、車体IMU25、ブームIMU26、アームIMU27、バケットIMU28のいずれかのIMUである。
 図3の上段図に示すように、初期時刻t0から時刻t1までの間、操作装置18cの走行レバーまたは走行ペダル(図1参照)が操作されておらず、油圧ショベルは走行せずに停止状態である。したがって、図3の中段図に示すように、IMUが検出する加速度の合成値は重力加速度gとほぼ一致する。このとき、油圧ショベルが静止状態なので、IMUの角度演算の方法として第1の方法が用いられる。ただし、IMUの演算結果の角度は、加速度センサのバイアス(定常的な誤差)や加速度センサでの量子化誤差などにより、真(実際上)の角度と完全には一致しない。IMUの角度演算において、静止状態(図3の下段図に示す時刻t0から時刻t1の間)のときに生じる角度誤差を最小誤差εminと呼ぶ。最小誤差εminは、IMUの演算精度に対する定常時の仕様値(許容誤差)ε未満の値である。
 図3の上段図に示すように、時刻t1にて操作装置18c(走行レバー又は走行ペダル)が操作される。これにより、油圧ショベルが停止状態から走行動作に移行するので、油圧ショベルに加速度が生じる。このとき、図3の中段図に示すように、IMUにより検出された加速度の合成値が重力加速度gと一致しなくなるので、IMUは第1の演算方法を利用できない。そこで、IMUは、第1の方法から第2の方法へ演算方法を切り替えて角度演算を行う。演算方法の切替えを適切なタイミングで行うことで、図3の下段図に示すように、演算角度の誤差が時刻t1以降に急激に大きくなることを防止している。しかし、第2の方法による角度演算は、角速度センサの検出結果(角速度)を積分するものなので、長時間適用すると、角速度センサのバイアスの影響が積み重なって、演算結果の精度が低下してしまう(演算角度の誤差が大きくなってしまう)。
 時刻t2から時刻t3では、図3の上段図に示すように、操作装置18c(走行レバーまたは走行ペダル)の操作量が略一定なので、油圧ショベルの走行速度が略一定になる。このため、油圧ショベルには走行による加速度が生じなくなる。ただし、油圧ショベルが略一定速度で走行中(時刻t2から時刻t3の間)であっても、図3の中段図に示すように、IMUが検出する合成加速度は常に重力加速度gと一致しない。なぜなら、油圧ショベルでは、舗装された路面を走行する自動車とは異なり作業現場の凹凸のある路面を走行すると共に、走行装置14(図1参照)が金属製の履帯の駆動により走行するので、走行時に比較的大きな振動が生じるからである。このため、油圧ショベルの走行中は、IMUの角度演算として第1の方法を利用することができない。しかし、第2の方法を継続して用いると、図3の下段図に示すように、角速度センサのバイアスの影響が積み重なることで、演算角度の誤差が徐々に大きくなっていく。
 図3の上段図に示すように、時刻t3にて操作装置18cの操作が停止される。これにより、油圧ショベルが急減速するので、図3の中段図に示すように、IMUが検出した加速度の合成値が再び重力加速度gから大きく変動する。その後、油圧ショベルの並進加速度は0になるが、急減速によって生じた車体振動が継続する。時刻t4になってようやく、図3の中段図に示すように、油圧ショベルが完全に停止した状態となる。
 この場合、油圧ショベルの完全な停止後の適切な時期にIMUの角度演算が第2の方法から第1の方法に切り替わる。この演算方法の切替時では、第2の方法による演算結果及び第1の方法による演算結果に対して補間処理やフィルタ処理などの処理を行うことで、演算結果の連続性を担保している。したがって、このため、油圧ショベルが完全に停止してIMUの角度演算が第1の方法に切り替わったとしても、完全な停止後の暫くの間、IMUが出力する角度情報には第2の演算方法に起因した誤差が残存するので、IMUの演算角度の誤差が時刻t4にて直ちに最小誤差εminになることはない。すなわち、IMUの演算角度の誤差は、図3の下段図に示すように、完全に車体が停止した時刻t4以降も徐々に減少していき、時刻t5にて最小誤差εminに収束する。
 このように、IMUの演算角度の精度(誤差)は、走行動作から停止状態へと移行した後も暫くの間、定常時の仕様値(許容誤差)εを満たすことができない場合がある。したがって、走行動作が行われておらず停止状態であることのみを判断材料にして、時刻t4においてマシンガイダンスが実行されると、IMUが出力する低精度の角度情報を基に演算した不正確な姿勢情報にしたがって操作支援が行われるので、施工面を傷つけてしまう懸念がある。このことは、走行動作から停止状態へと移行した場合だけでなく、旋回動作から停止状態へと移行した場合にも当てはまる。
 このため、マシンガイダンスやマシンコントロールなどの操作支援を実行する場合には、油圧ショベルが停止状態であっても、走行や旋回の動作状態から停止状態への移行後の一定期間はIMUの演算角度の精度(誤差)が要求精度(許容誤差)を満たしてない場合があることを考慮する必要がある。そこで、本実施の形態に係るコントローラ40は、車体(上部旋回体3)の走行動作及び旋回動作から停止状態への移行後におけるIMUの演算角度の精度低下の有無を評価するように構成されている。コントローラ40は、IMUが出力する低精度の角度情報を基にした不正確な姿勢情報の利用を抑制するために、IMUの演算角度の精度(誤差)が要求精度(許容角度)を満たしていないと判定した場合には、マシンガイダンスやマシンコントロールなどの作業装置1の操作支援の停止または警告などを講じるように構成されている。
 次に、本発明の建設機械の第1の実施の形態におけるコントローラのポジショニング演算部の機能構成の詳細及びモニタ表示制御部の機能構成を図4~図6を用いて説明する。図4は図2に示すコントローラのポジショニング演算部の機能構成及びモニタ表示部の機能構成を示すブロック図である。図5は図4に示すコントローラのポジショニング演算部の一部を構成する要求角度精度演算部の機能構成を示すブロック図である。図6は図4に示すコントローラのポジショニング演算部の一部を構成するIMU演算精度評価部の機能構成を示すブロック図である。
 図4において、コントローラ40は、測位システム35からの情報、各IMU25、26、27、28からの情報、要求精度設定装置19からの情報が入力されるように構成されている。測位システム35は、GNSSアンテナ36、37が受信した複数の衛星からの測位信号に基づきGNSS受信機38が演算した位置及びその分散の情報をコントローラ40へ出力する。
 各IMU25、26、27、28は、加速度を検出する加速度センサ31及び角速度を検出する角速度センサ32を備えている。また、各IMU25、26、27、28は、加速度センサ31により検出された加速度及び角速度センサ32により検出された角速度に基づき、各IMU25、26、27、28が設置された部分の基準面に対する角度を演算する角度演算を行う角度演算部33としての機能を有している。各IMU25、26、27、28は、加速度センサ313が検出した加速度、角速度セン23サが検出した角速度、角度演算部33が演算した角度の各情報をコントローラ40へ出力する。
 要求精度設定装置は、例えば、入力デバイスを有するモニタ19によって構成されており、フロント作業装置1の操作支援に用いられる情報に対して要求精度を設定するものである。具体的には、要求精度設定装置19では、操作支援の情報に対する要求精度である仕上げ精度として、例えば、寸法次元の許容誤差(許容寸法誤差)をオペレータの操作によって入力可能である。仕上げ精度の許容寸法誤差は、例えば、粗掘削時に10cm、仕上げ掘削時に2cmなど、油圧ショベルの動作に応じて設定可能である。
 コントローラ40のポジショニング演算部51は、油圧ショベルの姿勢を示す姿勢情報を演算する姿勢演算部61と、IMU25、26、27、28の角度演算に対する要求精度(第2要求精度)を演算する要求角度精度演算部62と、IMU25、26、27、28の角度演算の精度を評価するIMU演算精度評価部63とを有している。
 具体的には、姿勢演算部61は、測位システム35の演算結果(位置及び方位角並びにその分散)と各IMU25、26、27、28の検出結果(加速度及び角速度)及び演算結果(角度)とを用いて姿勢情報を演算するものである。姿勢情報は、例えば、バケット8の爪先中央位置などマシンガイダンスやマシンコントロールに必要な各種の3次元座標である。この演算は一般的な幾何学的な関係に従うものなので、詳細な説明は省略する。姿勢演算部61の演算結果の姿勢情報は、施工目標面演算部52、モニタ表示制御部53、油圧システム制御部54へ出力され、マシンガイダンスやマシンコントロールに利用される。
 要求角度精度演算部62は、要求精度設定装置19によって要求精度(第1要求精度)が設定されているか否かを判定するものである。さらに、要求精度が設定されている場合には、要求精度設定装置19により設定された要求精度(第1要求精度)に基づき、IMU25、26、27、28の角度演算の演算結果に対する要求精度(第2要求精度)を演算するものである。
 具体的には、要求角度精度演算部62は、操作支援の情報に対する要求精度(第1要求精度)としての許容寸法誤差を、IMU25、26、27、28の角度演算の演算結果に対する要求精度(第2要求精度)として、許容される角度次元の誤差(許容角度誤差)に変換する。例えば図5に示すように、要求角度精度演算部62は、要求精度設定装置19から入力された寸法次元の許容誤差(許容寸法誤差)を角度次元の許容誤差(許容角度誤差)に変換する誤差変換テーブル621を備えている。誤差変換テーブル621は、例えば、仕上げ精度(許容寸法誤差)が10cmのときの許容角度誤差は0.5度、仕上げ精度が2cmのときの許容角度誤差は0.1度というように、数値計算によって事前に算出した関係性から導出されたものである。要求角度精度演算部62は、要求精度設定装置19により設定された要求精度(第1要求精度)としての許容寸法誤差に対して1つの許容角度誤差(第1要求精度)をIMU演算精度評価部63へ出力する。
 許容角度誤差の最小値は、IMU25、26、27、28の仕様値で定まるものであり、最小許容角度誤差Aminと呼ぶ。最小許容角度誤差Aminに対応する許容寸法誤差よりも小さい数値は、要求精度設定装置19での入力を制限することが望ましい。例えば,最小許容角度誤差Aminに対応する許容寸法誤差が2.0cmの場合、オペレータが要求精度設定装置19を操作して仕上げ精度として1.0cmを入力しようとした場合、コントローラ40が要求精度設定装置19に対して仕上げ精度を2.0cm以上に設定するように警告メッセージを出力することが望ましい。
 IMU演算精度評価部63は、図4に示すように、IMU25、26、27、28の検出結果(加速度及び角速度)に基づき、IMU25、26、27、28の角度演算の精度に影響を及ぼす車体2、3の走行動作及び旋回動作の有無を判定する動作判定部65と、IMU25、26、27、28の角度演算の精度が要求角度精度演算部62の演算結果の第2要求精度を満たしているか否かを判定する演算精度判定部66とを備えている。
 動作判定部65は、各IMU25、26、27、28の検出結果の加速度及び角速度に基づき、車体2、3が動作している状態(走行状態や旋回状態)にあるか又は停止状態にあるかを判定する。すなわち、各IMU25、26、27、28により検出された加速度及び角速度のいずれかが閾値を超えた場合には車体2、3が動作している状態であると判定する一方、閾値以下の場合には停止状態と判定する。また、動作判定部65は、車体2、3が動作している状態(走行状態または旋回状態)から停止状態へと変化しているか否かを判定する動作停止判定も行う。動作判定部65は、車体2、3の動作状態の判定結果を演算精度判定部66へ出力する。
 より具体的には、例えば、車体IMU25が検出したx軸の加速度をAx、y軸の加速度をAy、z軸の加速度をAzとする。このときの3軸の加速度の合成値Accが重力加速度gと一致しない場合、または、3軸のいずれかの角速度が0でない場合、車体2、3が動作(走行動作又は旋回動作)している状態であると判定する。ただし、車体IMU25の検出値には、バイアス(定常的な誤差)が存在したりノイズが含まれていたりするので、判定には閾値を設けることが望ましい。例えば、加速度閾値をAth、角速度閾値をωthとし、次の(式1)~(式5)のいずれかの式が成立する場合には、動作判定部65は、車体2、3が動作している状態であると判定する。
 Acc > g + Ath … (式1)
 Acc < g - Ath … (式2)
 |ωx| > ωth   … (式3)
 |ωy| > ωth   … (式4)
 |ωz| > ωth   … (式5)
 なお、ωx、ωy、ωzはそれぞれ、車体IMU25のx軸、y軸、z軸の角速度の検出値である。
 演算精度判定部66は、例えば図6に示すように、要求角度精度演算部62の演算結果の第2要求精度(許容角度誤差)に基づき精度判定の比較対象である時間閾値を設定する時間変換テーブル661と、或る時点からの経過時間tをカウントするカウンタ662と、カウンタ662がカウントした経過時間tと時間変換テーブル661が出力する時間閾値とを比較することで、IMUの角度演算の精度が第2要求精度を満たしているか否かを判定する比較判定部663とを備えている。演算精度判定部66は、油圧ショベルに搭載されたIMUと高精度な角度センサの両者の出力を比較して図3の下段図に示すような油圧ショベルの動作状態とIMUの演算角度の誤差との関係を示す実験データを予め取得し、当該実験データの関係を基に時間変換テーブル661を作成することで実現できる。例えば、油圧ショベルに搭載するには非常に高価であるが精度に優れた光ファイバジャイロスコープ(Fiber Optical Gyroscope:FOG)を搭載した実験機を用いることで、図3の下段図に示すIMUの演算角度の誤差の時系列を取得することができる。
 時間変換テーブル661は、要求角度精度演算部62の演算結果の第2要求精度である許容角度誤差θに対応する時間閾値Tthの関係が規定されている。時間変換テーブル661の許容角度誤差に対する時間閾値の関係は、許容角度誤差が大きくなる(第2要求精度が低くなる)にしたがって時間閾値が小さくなる一方、許容角度誤差が小さくなる(第2要求精度が高くなる)にしたがって時間閾値が大きくなるという特性を有している。時間変換テーブル661は、要求角度精度演算部62の演算結果の許容角度誤差の入力に対して時間閾値を比較判定部へ出力する。
 時間変換テーブル661の関係は、例えば、図3の下段図における時刻t4(IMUにより検出された合成加速度が重力加速度に略一致した時点)から時刻t5(IMUの演算角度の誤差が最小誤差εminになる時刻)までの演算角度の誤差の時間推移を示す実験データから得られたものである。すなわち、油圧ショベルの車体が走行状態又は旋回状態から停止状態へと変化したタイミングを起点として最小誤差εminに到達する時刻までの演算角度の誤差の時間推移を基に規定されている。すなわち、時間変換テーブル661の関係は、車体が走行状態又は旋回状態から停止状態へと変化しても、IMUの角度演算の誤差が要求精度内に収束するには或る程度の時間経過を必要とすることを示したものである。時間変換テーブル661では、要求角度精度演算部62からの入力とは無関係に、最小の許容角度誤差θminに到達する時間閾値tmax(図3の下段図における時刻t4から時刻t5までの経過時間に相当する期間)が予め定められる。
 カウンタ662は、動作判定部65によって車体2、3が走行状態又は旋回状態から停止状態へと変化したと判定された時点からの経過時間をカウントするものである。カウンタ662は、カウントした経過時間tを比較判定部663へ出力する。
 比較判定部663は、カウンタ662がカウントした経過時間tと時間変換テーブル661が出力した時間閾値Tthとを比較することで、IMU25、26、27、28の角度演算の精度が要求角度精度演算62の演算結果の第2要求精度を満たしているか否かを判定するものである。比較判定部663は、カウンタ662の経過時間tが時間変換テーブル661の時間閾値Tthよりも小さい場合には、IMU25、26、27、28の角度演算の精度が第2要求精度を満たしていないと判定し、IMUの角度演算が要求精度を満たしていないことを示す低精度フラグを有効にする。一方、カウンタ662の経過時間tが時間変換テーブル661の時間閾値Tth以上の場合には、IMU25、26、27、28の角度演算の精度が第2要求精度を満たしていると判定し、低精度フラグを無効にする。なお、カウンタ662の経過時間tが時間変換テーブル661の最大の時間閾値tmax以上になれば、IMU25、26、27、28の角度演算の精度が第2要求精度を満たしていると自動的に判定することができる。比較判定部663は、比較判定に応じて設定した低精度フラグの有効又は無効をモニタ表示制御部53へ出力する。
 コントローラ40のモニタ表示制御部53は、図4に示すように、ポジショニング演算部51の姿勢演算部61の演算結果の油圧ショベルの姿勢情報をモニタ19に表示するガイダンス実行部531を備えている。ガイダンス実行部531は、また、IMU演算精度評価部63の評価結果の低精度フラグの有効又は無効に応じてマシンガイダンスの実行の継続または停止を判断する。低精度フラグが有効の場合には、マシンガイダンスの実行を停止する。なお、ガイダンス実行部531は、マシンガイダンスの実行の停止の代わりに、マシンガイダンスの実行に対する警告や作業停止を促す指示をモニタに表示するように構成することも可能である。すなわち、ガイダンス実行部531は、低精度フラグが有効の場合には、マシンガイダンスの実行に対して否定的な措置を講じるように構成される。
 次に、本発明の建設機械の第1の実施の形態を構成するコントローラのポジショニング演算部及びモニタ表示制御部の処理手順の一例について図4及び図7~図9を用いて説明する。図7は本発明の建設機械の第1の実施の形態を構成するコントローラにおけるガイダンス実行の判断の処理手順の一例を示すフローチャートである。図8は図7に示すフローチャートにおける車体の動作状態の判定の処理手順の一例を示すフローチャートである。図9は図7に示すフローチャートにおけるIMUの演算精度の判定の処理手順の一例を示すフローチャートである。
 図7において、図4に示すコントローラ40のポジショニング演算部51は、先ず、測位システム35(GNSS受信機38)から演算結果(位置やその分散)を取り込むと共に、各IMU25、26、27、28から検出結果(加速度及び角速度)及び演算結果(角度)を取り込む(ステップS10)。
 次に、ポジショニング演算部51の姿勢演算部61は、測位システム35の演算結果の位置及び各IMU25、26、27、28の演算結果の角度に基づき、油圧ショベルの姿勢情報を演算する(ステップS20)。
 次いで、ポジショニング演算部51の要求角度精度演算部62は、操作支援の情報に対する要求精度(第1要求精度)としての仕上げ精度(許容寸法誤差)が要求精度設定装置19によって設定されているか否かを判定する(ステップS30)。第1要求精度が設定されている場合(YESの場合)にはステップS40に進む一方、第1要求精度が設定されていない場合(NOの場合)にはステップS90に進む。
 ステップS30にてNOの場合、コントローラ40のモニタ表示制御部53のガイダンス実行部531が姿勢演算部61の演算結果の姿勢情報に基づきガイダンスを実行する(ステップS90)。第1要求精度が設定されていない場合には、IMUの角度演算の精度に対する比較対象が存在しないので、当該精度が要求精度を満たしているかを評価することができない。したがって、この場合には、コントローラ40は、従来と同様に、マシンガイダンスの機能を実行する。
 一方、ステップS30にてYESの場合、要求角度精度演算部62は、IMU25、26、27、28の角度演算の精度に対する要求誤差を演算する(ステップS40)。具体的には、要求角度精度演算部62は、誤差変換テーブル621を参照して、要求精度設定装置19によって設定された許容寸法誤差(仕上げ精度)から第2要求精度である許容角度誤差を演算する。
 次に、ポジショニング演算部51のIMU演算精度評価部63の動作判定部65が車体2、3の動作状態を判定する(ステップS50)。ステップS50では、概略すると、動作判定部65がIMU25、26、27、28が検出した加速度及び角速度に基づき車体2、3が走行状態または旋回状態であるか否かを判定する。
 具体的には、図8に示すように、動作判定部65は、IMU25、26、27、28が検出した3軸方向の加速度を基に合成加速度を演算する(ステップS510)。次いで、演算した合成加速度が所定の閾値の範囲内で重力加速度gと一致するか否かを判定する(ステップS520)。この判定は、上述の式1及び式2に相当する。ステップS520にて、合成加速度が閾値の範囲内において重力加速度gと一致していない場合、すなわち上述の式1及び式2のいずれかが成立する場合(NOの場合)には、車体2、3の動作状態が走行状態であると判定したことを示す走行フラグを有効し(ステップS530)、その後、ステップS540に進む。一方、合成加速度が閾値の範囲内において重力加速度gと一致する場合(YESの場合)には、走行フラグを有効にすることなくステップS540に進む。
 ステップS540において、動作判定部65は、IMU25、26、27、28が検出した各軸方向の角速度を基に各軸方向の角速度の絶対値を演算する。次いで、演算した角速度の絶対値が予め設定されている閾値(角速度センサのバイアス)以下か否かを判定する(ステップS550)。この判定は、上述の式3~式5に相当する。ステップS550にて、角速度の絶対値が閾値よりも大きい場合、すなわち上述の式3~式5のいずれかが成立する場合(NOの場合)には、車体2、3の動作状態が旋回状態であると判定したことを示す旋回フラグを有効し(ステップS560)、その後、ステップS570に進む。一方、角速度の絶対値が閾値以下の場合(YESの場合)には、旋回フラグを有効にすることなくステップS570に進む。
 ステップS570では、動作判定部65は、前回と今回の制御サイクルのときの走行フラグを比較して走行フラグが有効から無効へと変化しているかを判定すると共に、前回と今回の制御サイクルのときの旋回フラグを比較して旋回フラグが有効から無効へと変化しているかを判定する。すなわち、車体2、3の動作状態が走行状態から停止状態への変化が生じたか否かを判定すると共に、旋回状態から停止状態への変化が生じたか否かを判定する。この状態は、車体2、3が停止状態であっても、IMUの角度演算の精度が低下する懸念がある状況である。動作判定部65は、走行フラグの有効から無効への変化の有無の判定及び旋回フラグの有効から無効への変化の有無の判定に対してOR処理を行うことで、車体2、3の動作状態がIMU25、26、27、28の角度演算の精度を低下させる所定の状態であることを示す情報を1つの信号に統合する。動作判定部65がステップS570の手順を実行することでステップS50が終了する。
 ステップS50の終了後、図7に示すように、IMU演算精度評価部63がIMU25、26、27、28の角度演算の精度を評価する(ステップS60)。ステップS60では、概略すると、IMU演算精度評価部63は、IMU25、26、27、28の演算結果の角度の精度がステップS40にて演算した第2要求精度を満たしているか否かを評価する。
 具体的には、図9に示すように、動作判定部65は、車体2、3の動作状態がIMUの角度演算の精度が低下している所定の停止状態であるか否かを判定する(ステップS610)。つまり、車体2、3が走行状態から停止状態へと変化しているか又は旋回状態から停止状態へと変化しているかを判定する。具体的には、この判定は、走行フラグの有効から無効への変化の有無の判定及び旋回フラグの有効から無効への変化の有無の判定の結果に基づき判定される。
 ステップS610にて、車体2、3がIMUの角度演算の精度を低下させるような停止状態である(YES)と動作判定部65が判定した場合には、ステップS620に進む。ステップS620では、演算精度判定部66が、時間変換テーブル661を参照することで、要求角度演算部62の演算結果である許容角度誤差θに対応する時間閾値Tthを演算する。
 次に、演算精度判定部66のカウンタ662が起動して経過時間tをカウントする(ステップS630)。これは、車体2、3が走行状態または旋回状態から停止状態へと変化したときを起点に経過時間tをカウントするものである。
 次いで、演算精度判定部66の比較判定部663は、カウンタ662によりカウントされた経過時間tが時間変換テーブル661の出力である時間閾値Tthよりも小さいか否か判定する(ステップS640)。これは、図3の下段図の時刻t4から時刻t5までのIMUの演算角度の誤差の時系列に示されているように、車体2、3が動作している状態から停止状態へと変化してからの経過時間がIMUの演算精度の回復時間に到達したかを見極めるものである。
 ステップS640にて、カウンタの経過時間tが時間閾値Tthよりも小さい場合(YESの場合)には、ステップS650に進み、比較判定部663はIMU25、26、27、28の角度演算の精度が要求精度を満たしていないことを示す低精度フラグを有効にする。一方、カウンタの経過時間tが時間閾値Tth以上の場合(NOの場合)には、ステップS660に進み、比較判定部663は低精度フラグを無効にする。
 一方、ステップS610にて、車体2、3の動作状態がIMUの演算精度を低下させるような停止状態ではない(NO)と動作判定部65が判定した場合には、ステップS660に進み、IMUの演算精度の判定が不要なので、演算精度判定部66は低精度フラグを無効にする。
 ステップS650又はステップS660の終了によりステップS60の手順が終了する。これにより、コントローラ40はステップS70の手順へ進む。
 図7に示すステップS70では、IMU25、26、27、28の角度演算の精度が第2要求精度を満たしていないか否かを演算精度判定部66が判定する。具体的には、演算精度判定部66は、低精度フラグの有効の有無によって判定する。低精度フラグが有効である場合(YESの場合)には、ステップS80に進む。一方、低精度フラグが無効である場合(NOの場合)には、ステップS90に進む。
 ステップS80では、モニタ表示制御部53のガイダンス実行部531がガイダンスの実行を停止する。なぜなら、車体2、3が停止状態であっても、IMU25、26、27、28の低精度な演算角度を基にした不正確な姿勢情報にしたがって操作支援が行われると、施工面を傷つけてしまう懸念があるからである。一方、ステップS90では、IMU25、26、27、28の角度演算の精度が要求精度を満たしていると判定されているので、モニタ表示制御部53のガイダンス実行部531はガイダンスを実行する。
 ステップS80又はステップS90の手順を実行した後、コントローラ40は開始に戻る。ポジショニング演算部51及びモニタ表示制御部53は、ステップS10~S90を1サイクルとする制御サイクルを何度も繰り返し実行することで操作支援の1つであるマシンガイダンスを実行したり停止したりする。
 このように、本実施の形態に係るコントローラ40は、車体2、3がIMU25、26、27、28の演算精度を低下させるような所定の停止状態であるか否かを判定し、車体2、3が所定の停止状態である場合にはマシンガイダンスの実行の停止や警告などの作業支援に対して否定的な措置を講じることで、マシンガイダンスの実行の際に不正確な姿勢情報の利用を抑制することができる。
 上述したように、本発明の第1の実施の形態に係る油圧ショベル(建設機械)は、車体2、3と、車体2、3に対して回動可能に取り付けられたフロント作業装置1(作業装置)と、車体2、3及びフロント作業装置1(作業装置)に設置され、設置部分の加速度及び角速度を検出すると共に検出結果に基づき当該設置部分の基準面に対する角度を演算する角度演算を行うIMU25、26、27、28(角度計測装置)と、IMU25、26、27、28(角度計測装置)により演算された角度に基づいて車体2、3及びフロント作業装置1(作業装置)の姿勢を示す姿勢情報を演算し、演算された姿勢情報をモニタ19(表示装置)に表示させると共に、演算された姿勢情報に基づいてフロント作業装置1(作業装置)の操作支援を実行するコントローラ40とを備えている。コントローラ40は、フロント作業装置1(作業装置)の操作支援に用いられる情報に対して設定された要求精度である第1要求精度に基づいて、IMU25、26、27、28(角度計測装置)の角度演算に対する要求精度である第2要求精度を演算する要求精度演算を行い、IMU25、26、27、28(角度計測装置)の検出結果に基づいて、車体2、3が動作している状態から停止状態へと変化しているか否かを判定する動作停止判定を行い、IMU25、26、27、28(角度計測装置)の角度演算の精度が第2要求精度を満たしているか否かを判定する精度判定を行い、車体が動作している状態から停止状態へと変化したと判定し、且つ、IMU25、26、27、28(角度計測装置)の角度演算の精度が第2要求精度を満たしていないと判定した場合には、フロント作業装置1(作業装置)の操作支援の停止または警告を講じるように構成されている。
 この構成よれば、車体2、3が停止状態であっても、IMU25、26、27、28(角度計測装置)の角度演算の精度が要求精度を満たしていない場合には、コントローラ40がマシンガイダンスやマシンコントロールなどのフロント作業装置1(作業装置)の操作支援の停止または警告を講じるので、フロント作業装置1(作業装置)の操作支援の実行の際に不正確な姿勢情報が利用されることを抑制することができる。
 また、本実施の形態に係るコントローラ40の精度判定は、第2要求精度が高くなるにしたがって時間閾値Tthが大きくなるように予め規定された時間変換テーブル661(変換テーブル)を用いて、要求精度演算により演算された第2要求精度から時間閾値Tthを設定し、動作停止判定において車体2、3が動作している状態から停止状態へと変化したと判定した時点からの経過時間tをカウントし、カウントしている経過時間tと設定された時間閾値Tthとを比較することで行われ、カウントした経過時間tが設定した時間閾値Tthよりも小さいときに、IMU25、26、27、28(角度計測装置)の角度演算の精度が第2要求精度を満たしていないと判定するものである。
 この構成によれば、実験データなどを基に予め規定された変換テーブルを用いることで、IMU25、26、27、28(角度計測装置)の演算結果を用いることなく、車体2、3の動作停止への移行時点からの経過時間tによってIMU25、26、27、28(角度計測装置)の角度演算の精度を評価することができる。
 [第1の実施の形態の変形例]
  次に、本発明の建設機械の第1の実施の形態の変形例について図10を用いて説明する。図10は本発明の建設機械の第1の実施の形態の変形例におけるコントローラのポジショニング演算部の一部を構成する要求角度精度演算部の機能構成を示すブロック図である。なお、図10において、図1~図9に示す符号と同符号のものは、同様な部分であるので、その詳細な説明は省略する。
 本発明の建設機械の第1の実施の形態の変形例が第1の実施の形態に対して相違する点は、コントローラ40のポジショニング演算部51における要求角度精度演算部62Aの機能構成が異なっていることである。第1の実施の形態に係る要求角度精度演算部62は、要求精度設定装置19から入力された1つの許容寸法誤差(第1要求精度)に対して1つの許容角度誤差(第2要求精度)を出力するものである(図5参照)。それに対して、第1の実施の形態の変形例に係る要求角度精度演算部62Aは、図10に示すように、上部旋回体3、ブーム6、アーム7、バケット8にそれぞれ設置された各IMU25、26、27、28に対応した4つの誤差変換テーブル6211、6212、6213、6214と、要求精度設定装置19により設定された許容寸法誤差(第1要求精度としての仕上げ精度)を各IMU25、26、27、28に対応した誤差変換テーブル6211、6212、6213、6214に対して予め定められた関係に基づき配分する要求精度配分演算部622とを備えている。
 油圧ショベルでは、一般的に、ブーム6はバケット8に比べて長さ寸法が大きいので、各IMU25、26、27、28の角度演算の誤差(精度)が同じ値であっても、バケットのつめ先の位置情報の演算に与える影響は異なっている。例えば、ブームIMU26の角度演算の精度が0.5度低下すると、バケット8のつめ先位置の演算結果が5cm変化するのに対して、バケットIMU28の角度演算の精度が0.5度低下しても、当該つめ先位置の演算結果は1cmしか変化しない。第1の実施の形態の変形例に係る要求角度精度演算部62Aは、このことを考慮したものであり、ブーム6の相対角の演算に関係する車体IMU25及びブームIMU26の角度演算の誤差(精度)をバケット8の相対角の演算に関係するアームIMU27及びバケットIMU28の角度演算の誤差(精度)とは異なるように設定するように構成したものである。
 各IMU25、26、27、28用の第1~第4の誤差変換テーブル6211、6212、6213、6214は、図5に示す第1の実施の形態に係る要求角度精度演算部62における誤差変換テーブル621と同様に、要求精度設定装置19から入力された寸法次元の許容誤差(許容寸法誤差)を角度次元の許容誤差(許容角度誤差)に変換するものである。ただし、第1~第4の変換テーブル6211、6212、6213、6214は、要求精度配分演算部622の演算結果に応じて入力される許容寸法誤差の大きさが異なっている。
 要求精度配分演算部622は、フロント作業装置1を構成するブーム6、アーム7、バケット8に対して、要求精度設定装置19により設定された仕上げ精度、すなわち許容寸法誤差の割付けを行うものである。この割付けは、フロント作業装置1の各構成部材6、7、8の寸法に応じて設定されることが望ましい。例えば、要求精度配分演算部622は、要求精度設定装置19により設定された仕上げ精度が10cmである場合、3つの構成部材6、7、8の寸法比に応じて、ブームパートを5cm、アームパートを3cm、バケットパートを2cmに割り当てる。要求精度配分演算部622は、各パートに割り当てる許容寸法誤差を各パートに対応する誤差変換テーブル6211、6212、6213、6214へ出力する。これにより、各誤差変換テーブル6211、6212、6213、6214が各IMU25、26、27、28に対する許容角度誤差を算出する。
 ブームパートの誤差は、車体IMU25及びブームIMU26の角度演算の精度で決まる。このため、第1及び第2の誤差変換テーブル6211、6212に対する参照値はブームパートに対する誤差で決定される。アームパートの誤差は、ブームIMU26及びアームIMU27の精度で決まるが、ブームIMU26に対する許容角度誤差は既に決定されているので、アームIMU27の精度のみで決定することが可能である。バケットパートの誤差も、アームパートの誤差と同様に、バケットIMU28の精度のみで決定することが可能である。
 上述した本発明の建設機械の第1の実施の形態の変形例によれば、前述した第1の実施の形態と同様に、車体2、3が停止状態であっても、IMU25、26、27、28(角度計測装置)の角度演算の精度が要求精度を満たしていない場合には、コントローラ40がフロント作業装置1(作業装置)の操作支援の停止または警告を講じるので、フロント作業装置1(作業装置)の操作支援の実行の際に不正確な姿勢情報が利用されることを抑制することができる。
 また、本変形例におけるコントローラ40の要求精度演算は、各IMU25、26、27、28に対してフロント作業装置1の操作支援の情報(バケット8の先端位置の情報)に対する各構成部材6、7、8の姿勢情報の影響の度合いに応じて第1要求精度としての許容寸法誤差を配分し、許容寸法誤差が大きくなるにしたがって許容角度誤差が大きくなるように予め規定された各IMU25、26、27、28の誤差変換テーブル6211、6212、6213、6214を用いて各IMU25、26、27、28に対して配分された許容寸法誤差から各IMU25、26、27、28の角度演算に対する第2要求精度としての許容角度誤差を演算するものである。
 この構成によれば、フロント作業装置1の操作支援の情報(バケット8の先端位置の情報)に対する各構成部材6、7、8の姿勢情報の影響の度合いに応じて許容寸法誤差(第1要求精度)の大きさを変更することで、各IMU25、26、27、28の角度演算に対する要求精度(第2要求精度)をフロント作業装置1の操作支援の情報(バケット8の先端位置の情報)の影響の度合いに応じて変更することができるので、フロント作業装置1の操作支援の実行の際に不正確な姿勢情報の利用を更に抑制することができる。
 [第2の実施の形態]
  次に、本発明の建設機械の第2の実施の形態について図11~図14を用いて説明する。図11は本発明の建設機械の第2の実施の形態におけるコントローラの機能構成を示すブロック図である。図12は図11に示すコントローラのポジショニング演算部の一部を構成するIMU演算精度評価部の機能構成を示すブロック図である。図13は図12に示す本発明の建設機械の第2の実施の形態のコントローラのIMU演算精度評価部における精度評価の方法を示す説明図である。図14は図12に示す本発明の建設機械の第2の実施の形態におけるコントローラのIMU演算精度評価部の処理手順の一例を示すフローチャートである。なお、図11~図14において、図1~図10に示す符号と同符号のものは、同様な部分であるので、その詳細な説明は省略する。
 図11及び図12に示す本発明の建設機械の第2の実施の形態が第1の実施の形態に対して相違する点は、コントローラ40のポジショニング演算部51におけるIMU演算精度評価部63Bの演算精度判定部66Bの機能構成が異なっていることである。
 第1の実施の形態に係る演算精度判定部66は、車体2、3の動作している状態から停止状態へと変化した後のIMUの演算角度の誤差(精度)の時系列を予め取得しておくことでIMU25、26、27、28の演算角度の誤差(精度)と許容角度誤差の範囲内に達する時間との関係を示す時間変換テーブル661を用いるものである(図6参照)。演算精度判定部66は、車体2、3が動作している状態から停止状態へと変化した後の経過時間tを時間変換テーブル661の参照により設定した時間閾値Tthと比較することで、IMU25、26、27、28の演算精度が要求精度を満たしているか判定している(図6参照)。第1の実施の形態を実現するには、図3の下段図に示すような実験データを別途取得する必要があるので、当該機能をコントローラに実装するには大きな工数が必要となる。
 それに対して、第2の実施の形態に係る演算精度判定部66Bは、図11及び図12に示すように、IMU25、26、27、28の演算結果の角度を用いることで、IMU25、26、27、28の角度演算の精度が要求精度を満たしているかを判定するものである。具体的には、演算精度判定部66Bは、図12に示すように、第1の実施の形態と同様な動作判定部65に加えて、要求角度精度演算部62の演算結果の第2要求精度(許容角度誤差)に基づき精度判定の比較対象である角度閾値θthを設定する角度閾値変換テーブル661Bと、IMU25、26、27、28の演算結果の角度に対して時間的変化量δθを演算する角度変化量演算部662Bと、角度変化量演算部662Bが演算した角度の時間的変化量δθと角度閾値変換テーブル661Bが出力する角度閾値θthとを比較することで、IMU25、26、27、28の角度演算の精度が第2要求精度を満たしているか否かを判定する比較判定部663Bとを備えている。演算精度判定部66Bは、次の内容を基に実現するものである。
 図13は、図3の下段図の時刻t4以降のIMUの角度演算の誤差を拡大した図である。車体が停止状態にある場合、IMUの演算結果の角度は,IMUのバイアスの影響を含んだ或る値θtrueを取り続ける。ただし、車体が動作している状態から停止状態へと変化した直後では、車体の動作時におけるIMUの角度演算の誤差が積み重なっているので、IMUの演算結果の角度は所定値θtrueからずれた値となっている。時刻t4以降は、車体の停止状態が継続することからIMUの演算結果の角度が所定値θtrueに徐々に近づいてき、IMUの角度演算の誤差も徐々に減少していく。時刻t5以降、IMUが出力する角度は、所定値θtrueとほぼ一致するようになる。
 ここで、IMUの演算結果の角度θの変化量δθに注目する。δθは、或る時刻kのときのIMUの演算結果の角度θと次の時刻k+1のときのIMUの演算結果の角度θk+1との差分の絶対値である。すなわち、δθ=|θk+1-θ|である。図13に示すように、時刻t5以降では変化量δθが所定値θth以下であるというデータを得ることができる。この事実から、δθ=|θk+1-θ|≦θthの場合には、IMUの角度演算の精度が低精度でないと判定することが可能である。
 角度閾値変換テーブル661Bは、IMUの角度演算の角度変化量δθが収束したか否かの判定基準である角度閾値θthを設定するものである。角度閾値変換テーブル661Bは、要求角度精度演算部62の演算結果の第2要求精度である許容角度誤差θに対応する角度閾値θthの関係が規定されている。角度閾値変換テーブル661Bの許容角度誤差θに対する角度閾値θthの関係は、許容角度誤差が大きくなる(第2要求精度が低くなる)にしたがって角度閾値が大きくなる一方、許容角度誤差が小さくなる(第2要求精度が高くなる)にしたがって角度閾値が小さくなるという特性を有している。角度閾値変換テーブル661Bは、要求角度精度演算部62の演算結果の許容角度誤差の入力に対して角度閾値を比較判定部663Bへ出力する。
 角度変化量演算部662Bは、時刻k+1のときに取り込んだIMU25、26、27、28の演算結果の角度θk+1と以前の時刻kのときに取り込んだIMU25、26、27、28の演算結果の角度θとの差分の絶対値である角度の時間的変化量δθを演算する。この角度変化量δθは、上述したように、IMU25、26、27、28の演算精度が要求精度を満たしているか否かの指標となるものである。角度変化量演算部662Bは、車体2、3が動作している状態から停止状態への変化が生じたと動作判定部65が判定した場合に(第1の実施の形態の演算精度判定部66のカウンタ662の起動タイミングと同じときに)、角度変化量δθの演算を開始する。角度変化量演算部662Bは、演算した角度変化量δθを比較判定部663Bへ出力する。
 比較判定部663Bは、角度変化量演算部662Bの演算した角度変化量δθと角度閾値変換テーブル661Bが出力した角度閾値θthとを比較することで、IMU25、26、27、28の角度演算の精度が要求角度精度演算部62の演算結果の第2要求精度を満たしているか否かを判定するものである。比較判定部663Bは、角度変化量演算部662Bの角度変化量δθが角度閾値変換テーブル661Bの角度閾値θthよりも大きい場合には、IMU25、26、27、28の角度演算の精度が第2要求精度を満たしていないと判定し、低精度フラグを有効にする。一方、角度変化量δθが角度閾値θth以下の場合には、IMU25、26、27、28の角度演算の精度が第2要求精度を満たしていると判定し、低精度フラグを無効にする。
 次に、第2実施の形態に係るIMU演算精度評価部63Bの処理手順の一例を説明する。第1実施の形態のIMU演算精度評価部63のIMU25、26、27、28の角度演算の精度を評価する手順であるステップS60(図9参照)の代わりに、図14に示すステップS60Bが実行される。
 具体的には、第1実施の形態の場合と同様であるステップS610にて、車体2、3がIMUの角度演算の精度を低下させるような停止状態である(YES)と動作判定部65が判定した場合には、ステップS620Bに進む。ステップS620Bでは、演算精度判定部66が、角度閾値変換テーブル661Bを参照することで、要求角度演算部62の演算結果である許容角度誤差θに対応する角度閾値θthを演算する。
 次に、演算精度判定部66の角度変化量演算部662Bが角度変化量δθの演算を行う(ステップS630B)。これは、車体2、3が走行状態または旋回状態から停止状態へと変化したときから演算を開始するものである。
 次いで、演算精度判定部66の比較判定部663Bは、角度変化量演算部662Bが演算した角度変化量δθが角度閾値変換テーブル661Bの出力である角度閾値θthよりも大きいか否か判定する(ステップS640B)。これは、図13の時刻t5以降のIMUの演算角度の誤差の時系列に示されているように、車体2、3が停止状態へと変化してIMUの演算角度が所定値の近傍に収束しているかを見極めるものである。
 ステップS640Bにて、角度変化量δθが角度閾値θthよりも大きい場合(YESの場合)には、ステップS650に進み、比較判定部663Bは低精度フラグを有効にする。一方、角度変化量δθが角度閾値θth以下の場合(NOの場合)には、ステップS660に進み、比較判定部663Bは低精度フラグを無効にする。ステップS650又はステップS660の終了によりステップS60Bの手順が終了する。
 上述した本発明の建設機械の第2の実施の形態によれば、前述した第1の実施の形態と同様に、車体2、3が停止状態であっても、IMU25、26、27、28(角度計測装置)の角度演算の精度が要求精度を満たしていない場合には、コントローラ40がフロント作業装置1(作業装置)の操作支援の停止または警告を講じるので、フロント作業装置1(作業装置)の操作支援の実行の際に不正確な姿勢情報が利用されることを抑制することができる。
 また、本実施の形態に係るコントローラ40の精度判定は、第2要求精度が高くなるにしたがって角度閾値θthが小さくなるように予め規定された角度閾値変換テーブル661Bを用いて要求精度演算により演算された第2要求精度から角度閾値θthを設定し、IMU25、26、27、28(角度計測装置)により演算された角度の時間的変化量δθを演算し、演算した角度の時間的変化量δθと設定した角度閾値θthとを比較することで行われ、演算した角度の時間的変化量δθが設定した角度閾値θthよりも大きいときに、IMU25、26、27、28(角度計測装置)の角度演算の精度が第2要求精度を満たしていないと判定するものである。
 この構成によれば、IMU25、26、27、28(角度計測装置)の角度演算の精度判定の比較対象である閾値を設定するための変換テーブルが高価なセンサを利用して取得した実験データを基に規定されているものである第1の実施の形態の場合と比べると、精度判定の比較対象である閾値を設定するための角度閾値変換テーブル661Bが事前に実験データを取得せずとも規定することができるので、コントローラ40への実装に大きな工数を必要としない。
 [第3の実施の形態]
 次に、本発明の建設機械の第3の実施の形態について図15~図19を用いて説明する。図15は本発明の建設機械の第2の実施の形態における問題点を示す説明図である。図16は本発明の建設機械の第3の実施の形態におけるコントローラの機能構成を示すブロック図である。図17は図16に示すコントローラのポジショニング演算部の一部を構成するIMU演算精度評価部の機能構成を示すブロック図である。図18は図17に示す本発明の建設機械の第3の実施の形態におけるコントローラのIMU演算精度評価部の処理手順の一例を示すフローチャートである。図19は本発明の建設機械の第3の実施の形態の作用及び効果を示す説明図である。なお、図15~19において、図1~図14に示す符号と同符号のものは、同様な部分であるので、その詳細な説明は省略する。
 第2の実施形態のIMU演算精度評価部63Bにおいては、IMU25、26、27、28の演算結果の角度の時間変化量δθに基づいてIMU25、26、27、28の角度演算の精度を評価している。しかし、IMUの演算特性によっては、演算精度の評価を誤る懸念がある。例えば、IMUの演算特性が図15に示すような特性を有している場合である。IMUの演算結果(出力値)の角度θは、所定値θtrueに単調に近づくのではなく、時刻taから時刻tbの間において当該角度θの時間的変化が一時的に停止し、その後、時刻t5以降において所定値θtrueとほぼ一致するようになっている。このような場合、第2の実施の形態では、コントローラ40のIMU演算精度評価部63Bにおける角度の時間的変化量δθが時刻taから時刻tbの間で角度閾値θth以下となるので、IMU25、26、27、28の演算精度は要求精度を満たしていると判定してしまう。しかしこのとき、IMU25、26、27、28の演算結果の角度には所定値θtrueに対してΔθ分の誤差が生じているので、IMU5、26、27、28の演算精度が要求精度を満たしていない場合がある。
 そこで、第3の実施の形態は、事前に高価なセンサを利用した実験データの取得が不要であるという第2の実施の形態の利点を維持しつつ、簡易な演算で判定の誤りが少ないIMUの演算精度の評価を行うものである。図16に示す本発明の建設機械の第3の実施の形態が第2の実施の形態に対して相違する点は、コントローラ40のIMU演算精度評価部63Cが動作判定部65及び演算精度判定部66Cに加えて傾斜角演算部67を備えていること、及び、演算精度判定部66Cの機能構成が異なることである。
 具体的には、傾斜角演算部67は、各IMU25、26、27、28によって検出された加速度を基に基準面に対する角度である傾斜角θsを演算する。この演算は、重力加速度gを参照値とする上述のIMU25、26、27、28の角度演算の第1の方法と同じことを実行していることに他ならない。
 演算精度判定部66Cは、図17に示すように、第2の実施の形態の角度変化量演算部662Bに代えて、角度差演算部662Cを備えている。さらに、第2の実施の形態の比較判定部663Bとは異なる判定方法によってIMU25、26、27、28の演算精度を判定する比較判定部663Cを備えている。演算精度判定部66Cは、第2の実施の形態の角度閾値変換テーブル661Bが不要であり、比較判定部663Cは要求角度精度演算部62の演算結果の許容角度誤差が直接入力されるように構成されている。
 角度差演算部662Cは、IMU25、26、27、28の演算結果(出力値)の角度θと傾斜角演算部67の演算結果の傾斜角θsとの差分の絶対値である角度差Δθsを演算する。傾斜角演算部の演算結果の傾斜角θsは車体2、3が静止状態のときIMU25、26、27、28の演算角度の真値となるので、角度差ΔθsはIMUの演算精度が要求精度を満たしているか否かの指標となるものである。角度差演算部662Cは、演算した角度誤差Δθsを比較判定部663Cへ出力する。
 比較判定部663Cは、角度差演算部662Cの演算した角度差Δθsと要求角度精度演算部62の演算結果の許容角度誤差とを比較することで、IMU25、26、27、28の演算精度が第2要求精度を満たしているか否かを判定するものである。比較判定部663Cは、角度差演算部662Cの角度差Δθsが要求角度精度演算部62の許容角度誤差θaよりも大きい場合には、IMU25、26、27、28の角度演算の精度が第2要求精度を満たしていないと判定し、低精度フラグを有効にする。一方、角度差演算部662Cの角度差Δθsが要求角度精度演算部62の許容角度誤差θa以下の場合には、IMU25、26、27、28の角度演算の精度が第2要求精度を満たしていると判定し、低精度フラグを無効にする。この判定は、車体2、3が停止状態であると動作判定部65が判定したときだけ実行される。
 次に、第3実施の形態に係るIMU演算精度評価部の処理手順の一例を説明する。第1実施の形態のIMU演算精度評価部63のIMU25、26、27、28の角度演算の精度を評価する手順であるステップS60(図9参照)の代わりに、図18に示すステップS60Cが実行される。
 具体的には、IMU演算精度評価部63Cの傾斜角演算部67が各IMU25、26、27、28により検出された加速度を基に傾斜角θsを演算する(ステップS620C)。次いで、IMU演算精度評価部63Cの演算精度判定部66Cの角度差演算部662Cが、IMU25、26、27、28の演算結果の角度θと傾斜角演算部67の演算結果の傾斜角θsとの差分の絶対値である角度差Δθsを演算し(ステップS630C)、ステップS635に進む。
 ステップS635では、第1実施の形態の場合のステップS610と同様な判定を行う。すなわち、車体2、3の動作状態がIMUの角度演算の精度が低下している所定の停止状態であるか否かを動作判定部65が判定する。車体2、3が所定の停止状態である(YES)と動作判定部65が判定した場合には、ステップS640Cに進む。一方、NOと判定した場合には、第1実施の形態の場合と同様に、ステップS660に進む。
 ステップS640Cでは、角度差演算部662Cが演算した角度差Δθsが要求角度精度演算部62の許容角度誤差θaよりも大きいか否かを判定する。ステップS640Cにて、角度差Δθsが許容角度誤差θaよりも大きい場合(YESの場合)には、ステップS650に進み、比較判定部663Cは低精度フラグを有効にする。一方、角度差Δθsが許容角度誤差θa以下の場合(NOの場合)には、ステップS660に進み、比較判定部663Bは低精度フラグを無効にする。ステップS650又はステップS660の終了によりステップS60Cの手順が終了する。
 次に、本発明の建設機械の第3の実施の形態の作用及び効果について図19を用いて説明する。図19中、太い破線はIMUの演算角度θ(出力値)を、実線はIMU演算精度評価部の傾斜角演算部の演算結果の傾斜角θsを示している。
 時刻t3(車体2、3の走行操作が停止された時刻)の直後は車体2、3が振動するので、様々な方向に加速度を生じる。その結果、コントローラ40のIMU演算精度評価部63Cの傾斜角演算部67が演算する傾斜角θsは振動的な振る舞いになる。一方、このとき、IMU25、26、27、28の角度演算では、主に角速度センサ32の検出結果を用いることで演算結果の角度θが振動的になることを抑制している。しかし、IMU25、26、27、28の角度演算では、平滑化の効果によって演算角度θが真値θtrueから乖離してしまう。
 車体振動が停止した時刻t4では、振動による加速度が生じないので、傾斜角演算部67の演算結果の傾斜角θsは真値θtrueとほぼ一致している。それに対して、IMU25、26、27、28の演算結果の角度θは、真値θtrueとは異なる値となっている。時刻t4を含む時刻taから時刻tbの間では、振動による加速度が極めて小さいか又は加速度が生じていないので、IMU25、26、27、28の演算結果の角度θの時間的変化が一時的に止まっている。
 前述した第2の実施の形態の場合には、時刻taから時刻tbの間において、コントローラ40の演算精度判定部66Bの角度変化量演算部662Bの演算結果の角度変化量δθが角度閾値θth以下となる。このため、演算精度判定部66Bの比較判定部663Bは、IMU25、26、27、28の演算精度が要求精度を満たしていると誤った判定を行ってしまう。
 それに対して、第3の実施の形態においては、時刻taから時刻tbの間において、演算精度判定部66Cの角度差演算部662Cの演算結果の角度差Δθsが許容角度誤差θaよりも大きくなっている。したがって、比較判定部663Cは、IMU25、26、27、28の演算精度が要求精度を満たしていないと正しく判定することができる。このように、第3の実施の形態では、第2の実施の形態のような誤判定を抑制することができる。
 時刻tc以降は、角度差Δθsが許容角度誤差θaよりも小さくなっているので、比較判定部663CはIMU25、26、27、28の演算精度が要求精度を満たしていると正しく判定することができる。
 上述した本発明の建設機械の第3の実施の形態によれば、前述した第2の実施の形態と同様に、車体2、3が停止状態であっても、IMU25、26、27、28の角度演算の精度が要求精度を満たしていない場合には、コントローラ40がフロント作業装置1の操作支援の停止または警告を講じるので、フロント作業装置1の操作支援の実行の際に不正確な姿勢情報が利用されることを抑制することができる。
 また、本実施の形態においては、コントローラ40の要求精度演算が第2要求精度として角度の次元の許容誤差である許容角度誤差θaを演算するものであり、かつ、コントローラ40の精度判定は、IMU25、26、27、28(角度計測装置)により検出された加速度に基づいて基準面に対する角度θsを演算し、コントローラ40が演算した角度θsとIMU25、26、27、28(角度計測装置)が演算した角度θとの差分の絶対値である角度差Δθsを演算し、演算した角度差Δθsを許容角度誤差θaと比較することで行われ、演算した角度差Δθsが許容角度誤差θaよりも大きいときに、IMU25、26、27、28(角度計測装置)の角度演算の精度が第2要求精度を満たしていないと判定するものである。
 この構成によれば、IMU25、26、27、28(角度計測装置)の角度演算の精度判定の比較対象を設定するための変換テーブルを高価なセンサを利用して取得した実験データを基に規定する第1の実施の形態の場合と比べると、そのような変換テーブルが不要なので、コントローラ40への実装に大きな工数を必要としない。さらに、IMU25、26、27、28(角度計測装置)の検出結果の加速度を基にコントローラ40で演算した角度θsとIMU25、26、27、28(角度計測装置)の演算結果の角度θとの差分に基づき、IMU25、26、27、28(角度計測装置)の角度演算の精度判定を行うので、IMU25、26、27、28(角度計測装置)の演算結果の低精度であってその時間的変化量が一時的に変化しない場合あっても、簡易な演算で誤りの少ない判定を行うことができる。
 [第4の実施の形態]
 次に、本発明の建設機械の第4の実施の形態について図20及び図21を用いて説明する。図20は 本発明の建設機械の第4の実施の形態におけるコントローラの機能構成を示すブロック図である。図21は図20に示すコントローラのポジショニング演算部の一部を構成する要求角度精度演算部の機能構成を示すブロック図である。なお、図20及び図21において、図1~図19に示す符号と同符号のものは、同様な部分であるので、その詳細な説明は省略する。
 図20及び図21に示す本発明の建設機械の第4の実施の形態が第1の実施の形態に対して相違する点は、コントローラ40のポジショニング演算部51における演算要求角度演算部62Dの機能構成が異なっていることである。第1の実施の形態に係る演算要求角度演算部62(第2及び第3の実施の形態の場合も同様)は、要求精度設定装置19によって設定された要求精度(仕上げ精度としての許容寸法誤差)に対してIMUの角度演算に対する要求精度(許容角度誤差)を演算するものである。しかしながら、マシンガイダンスが提供する油圧ショベルの姿勢情報は、測位システム35の位置情報とIMU25、26、27、28の角度情報の両方で定まるものである。そのため、IMUの演算角度が正確であっても、測位システム35からの位置情報が不正確な場合には、マシンガイダンスが提供する姿勢情報が不正確なものになってしまう懸念がある。この観点から、本実施の形態における要求角度演算部62Dは、測位システム35の位置情報の精度を考慮してIMU25、26、27、28の角度演算の要求精度を設定するようにしたものである。
 具体的には、要求角度精度演算部62Dは、第1の実施の形態と同様な誤差変換テーブル621に加えて、要求精度設定装置19により設定された第1要求精度(許容寸法誤差)に対して、GNSS受信機38の測位演算の位置や速度の分散値(演算誤差に対応する値)を用いてIMU25、26、27、28の演算で補償すべき要求精度を算出する構成を備えている。すなわち、要求角度精度演算部62Dは、GNSS受信機38の測位演算の誤差が大きい場合には、その分、IMU25、26、27、28の角度演算の要求精度を高めるように調整するものである。
 測位システム35では、衛星の測位信号の受信環境が良好で、かつ、RTK測位が実行されている場合であっても、測位演算の標準偏差(分散σの平方根)は2cm程度となる。したがって、要求精度設定装置19の要求精度(許容寸法誤差)に対して測位演算の標準偏差(分散の平方根)をそのまま利用することは難しい。なぜなら、仕上げ作業時の要求精度が2cmに設定された場合、要求精度設定装置19の要求精度から測位演算の標準偏差を単純に減算すると、IMU25、26、27、28の角度演算で補償すべき寸法精度は0cmとなるので、IMU25、26、27、28の角度演算で誤差を全く許容しないことになってしまう。
 そこで、要求角度精度演算部62Dは、GNSS受信機38の測位演算の分散値を調整寸法に変換する変換テーブル624を備えている。調整寸法は、IMU25、26、27、28の角度演算において、GNSS受信機38の測位演算の誤差に対して調整すべき寸法の次元の許容誤差の大きさを示している。変換テーブル624は、測位演算の分散値が所定値σ th以下の場合には調整寸法が0であると共に、当該分散値が所定値σ thよりも大きい場合には、分散値が大きくなるにしたがって調整寸法が大きくなる特性を有している。つまり、測位システム35の測位状態が良好であれば、調整寸法が0cmに設定される。一方、測位状態が悪化して測位演算の分散値が大きくなると、調整寸法が分散値の大きさに応じた値となる。
 また、要求角度精度演算部62Dは、要求精度設定装置19で設定された許容寸法誤差から変換テーブル624で設定された調整寸法を減算することで、IMU25、26、27、28の角度演算に対する要求精度を調整する許容誤差調整部625を備えている。許容誤差調整部625は、GNSS受信機38の位置情報の誤差に応じて、IMU25、26、27、28の角度演算に対する寸法の次元の要求精度である許容寸法誤差を演算するものである。許容誤差調整部625は、演算結果の許容寸法誤差を変換テーブル621へ出力する。もし、測位システム35の測位演算に利用可能な衛星数が変化して測位演算の分散値が所定値σ th以上となった場合において、調整寸法として1cmを出力したとする。要求精度設定装置19によって第1要求精度(許容寸法誤差)が2cmに設定されている場合には、許容誤差調整部625の出力は1cmになる。許容誤差調整部625の出力が0cm以下となった場合には、IMU25、26、27、28の演算精度は要求精度を達成することができない。そこで、モニタ表示制御部53(ガイダンス実行部531)に対して警告表示の実行を指令するように許容誤差調整部625を構成することが可能である。
 なお、変換テーブル621は、第1の実施の形態の変換テーブルと同様であり、許容誤差調整部625からの許容寸法誤差に応じて許容角度誤差を設定する。設定した許容角度誤差はIMU演算精度評価部63へ出力される。
 上述した本発明の建設機械の第4の実施の形態によれば、前述した第1の実施の形態と同様に、車体2、3が停止状態であっても、IMU25、26、27、28の角度演算の精度が要求精度を満たしていない場合には、コントローラ40がフロント作業装置1の操作支援の停止または警告を講じるので、フロント作業装置1の操作支援の実行の際に不正確な姿勢情報が利用されることを抑制することができる。
 また、本実施の形態に係る油圧ショベル(建設機械)は、車体2、3に取り付けられ、複数の衛星からの測位信号を受信するGNSSアンテナ36、37(受信装置)と、GNSSアンテナ36、37(受信装置)が受信した複数の衛星からの測位信号を基に車体2、3の位置及び車体2、3の位置の分散値を演算するGNSS受信機38(測位演算装置)とを更に備えている。さらに、コントローラ40の要求精度演算は、第1要求精度として寸法の次元の精度が設定されている場合において、車体2、3の位置の分散値が所定値σ thよりも大きい場合に車体2、3の位置の分散値が高くなるにしたがって調整寸法が大きくなるように予め規定された変換テーブル624を用いて、GNSS受信機38(測位演算装置)により演算された車体2、3の位置の分散値から調整寸法を設定し、第1要求精度から設定された調整寸法を減算することで、IMU25、26、27、28(角度計測装置)の角度演算に対する寸法の次元の要求精度である許容寸法誤差を演算する許容寸法誤差演算を行い、許容寸法誤差が大きくなるにしたがって第2要求精度が低くなるように予め規定された変換テーブル621を用いて、許容誤差演算により演算された許容寸法誤差から第2要求精度を演算するものである。
 この構成によれば、操作支援に対して設定された第1要求精度に対して、GNSS受信機38(測位演算装置)の演算結果の位置の分散値に応じて設定した調整寸法を減算した結果を基に第2要求精度を設定するので、GNSS受信機38(測位演算装置)の位置情報の演算誤差の大小に応じてIMU25、26、27、28(角度計測装置)の角度演算の要求精度の高低を調整することができる。GNSS受信機38(測位演算装置)の位置情報が低精度のときには、IMU25、26、27、28(角度計測装置)の角度演算の要求精度を厳しくすることで、操作支援の実行の際に不正確な姿勢情報の利用を更に抑制することができる。
 [第5の実施の形態]
 次に、本発明の建設機械の第5の実施の形態について図3及び図22を用いて説明する。図22は本発明の建設機械の第5の実施の形態におけるコントローラの機能構成を示すブロック図である。なお、図22において、図1~図21に示す符号と同符号のものは、同様な部分であるので、その詳細な説明は省略する。
 図22に示す本発明の建設機械の第5の実施の形態が第2の実施の形態に対して相違する点は、コントローラ40のポジショニング演算部51におけるIMU演算精度評価部63Eの演算精度の判定結果が油圧システム制御部54へ出力されていること、及び、その演算精度の判定結果に応じて油圧システム制御部54の制御を変更することである。
 図3の下段図に示すように、車体の走行動作又は旋回動作が開始された直後(時刻t1の直後)では、IMUの演算角度の誤差は大きくない。しかし、その動作が継続されると、IMUのセンサバイアスの影響により演算角度の誤差が徐々に増加する。逆に、その動作が継続さなければ、IMUの演算精度は要求精度を逸脱することないので、作業継続が可能である。
 そこで、本実施の形態においては、車体2、3の走行動作又は旋回動作によってIMU25、26、27、28の演算精度が要求精度を逸脱すると、IMU25、26、27、28の演算精度の低下の要因である当該走行動作又は旋回動作を直ちに停止するようにする。具体的には、IMU演算精度評価部63Eの動作判断部65Eによって走行又は旋回の動作が或る所定の期間以上継続していると判定された場合において、IMU25、26、27、28の角度演算の精度が要求精度を満たしていないとIMU演算精度評価部63Eが評価したときに、コントローラ40の油圧システム制御部54は、当該動作を停止させるように油圧システムを制御する。動作判断部65Eの判定は、例えば、図8に示すフローチャートのステップS50(ステップS510~S570)の処理を実行することで基本的に可能である。ただし、ステップS570において、動作判定部65Eは、制御サイクルの継続中に走行フラグの有効が所定の期間以上継続しているか否かを判定すると共に、旋回フラグの有効が所定の期間以上継続しているか否かを判定するように構成すればよい。動作判定部65Eは、走行フラグの有効の継続の有無の判定及び旋回フラグの有効の継続の有無の判定に対してOR処理を行うことで、車体2、3の動作している状態が所定の期間以上継続していることを示す情報を1つの信号に統合する。
 なお、走行及び旋回の動作を自動的に停止させると、オペレータの操作と油圧ショベルの動作が一致しない状況が生じ得る。したがって、本制御は、タブレット端末などによって任意のタイミングで有効と無効の切替が可能である構成が望ましい。
 上述した本発明の建設機械の第5の実施の形態によれば、前述した第2の実施の形態と同様な効果を得ることができる。
 また、本実施の形態に係るコントローラ40は、さらに、IMU25、26、27、28(角度計測装置)の検出結果に基づいて車体2、3の動作している状態が所定の期間以上継続しているか否かを判定する動作継続判定を行い、車体2、3の動作している状態が所定の期間以上継続していると判定した場合、且つ、IMU25、26、27、28(角度計測装置)の角度演算の精度が第2要求精度を満たしていないと判定した場合には、車体2、3の動作を停止させるように構成されている。
 この構成によれば、IMU25、26、27、28(角度計測装置)の角度演算の誤差が大きくなる前にIMU25、26、27、28(角度計測装置)の演算精度の低下の要因である動作を停止させることで、正確な姿勢情報を使用したマシンガイダンスを実行し直すことが可能である。
 [第6の実施の形態]
 次に、本発明の建設機械の第6の実施の形態について図23を用いて説明する。図23は本発明の建設機械の第6の実施の形態におけるコントローラの機能構成を示すブロック図である。なお、図23において、図1~図22に示す符号と同符号のものは、同様な部分であるので、その詳細な説明は省略する。
 図23に示す本発明の建設機械の第6の実施の形態が第1の実施の形態に対して相違する点は、コントローラ40のポジショニング演算部51における要求角度精度演算部62Fが施工管理システム100で管理している施工情報に基づいて第2要求精度である許容角度誤差を演算することである。施工管理システム100は、例えば、施工情報などの現場の施工の進捗状態を管理するクラウドシステムである。施工情報は、設計情報として寸法の次元の要求精度である許容寸法誤差を含んでいる。
 要求角度精度演算部62Fは、要求精度設定装置19からの入力がない場合には、施工管理システム100から施工目標面演算に入力された施工情報に含まれる要求精度を基にIMU25、26、27、28の角度演算に対する角度の次元の要求精度の演算を実行する。コントローラ40は、施工管理システム100が管理している施工の進捗状況に応じて、施工情報に含まれる要求精度(第1要求精度)を変更するように構成することが可能である。例えば、施工管理システム100が管理している施工の進捗状態が進行するほど、設計情報としての許容寸法誤差を小さくする(要求精度を高める)ように変更する。例えば、施工開始直後では、掘削目標面に対して土砂が数十cm上まで存在する状態なので、粗掘削の設定値(例えば、10cm)が自動的に設定され、施工が進むにつれて徐々に仕上げ掘削の設定値(例えば、2cm)へと切り替わるようにする。
 第1~第5の実施の形態においては、オペレータ自身の操作によって要求精度設定装置19を介して第1要求精度(許容寸法誤差)が設定されるように構成されている。このような構成では、粗掘削や仕上げ掘削などの操作に応じてオペレータが要求精度を変更する必要があるので、オペレータの操作が煩雑になる。
 それに対して、本実施の形態においては、コントローラ40が、現場の施工の進捗状態を管理する施工管理システム100で管理されている施工情報に含まれている要求精度を第1要求精度として施工管理システム100から取り込み、施工管理システム100によって管理されている施工の進捗状態が進行するにつれて第1要求精度を高めていくように構成されている。
 この構成によれば、オペレータの操作によらずに第1要求精度が設定されるので、オペレータの操作の手間を軽減することができる。また、コントローラ40が施工の進捗状況に応じて第1要求精度を自動的に変更するので、オペレータが粗掘削や仕上げ掘削などの操作に応じて要求寸法精度を設定し直す必要がなく、オペレータの操作の手間を軽減することができる。
 上述した本発明の建設機械の第6の実施の形態によれば、前述した第1の実施の形態と同様な効果を得ることができる。
 [その他の実施の形態]
  なお、上述した実施の形態においては、本発明を油圧ショベルに適用した例を示したが、本発明はIMUの演算結果の角度情報を基に制御する各種の建設機械に広く適用することができる。
 また、本発明は本実施の形態に限られるものではなく、様々な変形例が含まれる。上記した実施形態は本発明をわかり易く説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。ある実施形態の構成の一部を他の実施の形態の構成に置き換えることが可能であり、また、ある実施形態の構成に他の実施の形態の構成を加えることも可能である。また、各実施形態の構成の一部について、他の構成の追加、削除、置換をすることも可能である。
 1…フロント作業装置(作業装置)、 2…下部走行体(車体)、 3…上部旋回体(車体)、 19…モニタ(表示装置)、 25…車体IMU(角度計測装置)、 26…ブームIMU(角度計測装置)、 27…アームIMU(角度計測装置)、 28…バケットIMU(角度計測装置)、 36、37…GNSSアンテナ(受信装置)、 38…GNSS受信機(測位演算装置)、 40…コントローラ、 100…施工管理システム、 621…誤差変換テーブル(変換テーブル)、 624…変換テーブル、 661…時間変換テーブル(変換テーブル)、 661B…角度閾値変換テーブル(変換テーブル)

Claims (7)

  1.  車体と、
     前記車体に対して回動可能に取り付けられた作業装置と、
     前記車体及び前記作業装置に設置され、設置部分の加速度及び角速度を検出すると共に検出結果に基づき当該設置部分の基準面に対する角度を演算する角度演算を行う角度計測装置と、
     前記角度計測装置により演算された角度に基づいて前記車体及び前記作業装置の姿勢を示す姿勢情報を演算し、演算された姿勢情報を表示装置に表示させると共に、演算された姿勢情報に基づいて前記作業装置の操作支援を実行するコントローラとを備えた建設機械において、
     前記コントローラは、
     前記作業装置の操作支援に用いられる情報に対して設定された要求精度である第1要求精度に基づいて、前記角度計測装置の前記角度演算に対する要求精度である第2要求精度を演算する要求精度演算を行い、
     前記角度計測装置の検出結果に基づいて、前記車体が動作している状態から停止状態へと変化しているか否かを判定する動作停止判定を行い、
     前記角度計測装置の前記角度演算の精度が前記第2要求精度を満たしているか否かを判定する精度判定を行い、
     前記車体が動作している状態から停止状態へと変化したと判定し、且つ、前記角度計測装置の前記角度演算の精度が前記第2要求精度を満たしてないと判定した場合には、前記作業装置の操作支援の停止または警告を講じる
     ことを特徴とする建設機械。
  2.  請求項1に記載の建設機械において、
     前記コントローラの前記精度判定は、
     前記第2要求精度が高くなるにしたがって時間閾値が大きくなるように予め規定された変換テーブルを用いて、前記要求精度演算により演算された前記第2要求精度から時間閾値を設定し、
     前記動作停止判定において前記車体が動作している状態から停止状態へと変化したと判定した時点からの経過時間をカウントし、
     カウントしている経過時間と設定した時間閾値とを比較することで行われ、
     カウントした経過時間が設定した時間閾値よりも小さいときに、前記角度計測装置の前記角度演算の精度が前記第2要求精度を満たしていないと判定するものである
     ことを特徴とする建設機械。
  3.  請求項1に記載の建設機械において、
     前記コントローラの前記精度判定は、
     前記第2要求精度が高くなるにしたがって角度閾値が小さくなるように予め規定された変換テーブルを用いて、前記要求精度演算により演算された前記第2要求精度から角度閾値を設定し、
     前記角度計測装置により演算された角度の時間的変化量を演算し、
     演算した角度の時間的変化量を設定した角度閾値と比較することで行われ、
     演算した角度の時間的変化量が設定した角度閾値よりも大きいときに、前記角度計測装置の前記角度演算の精度が前記第2要求精度を満たしていないと判定するものである
     ことを特徴とする建設機械。
  4.  請求項1に記載の建設機械において、
     前記コントローラの前記要求精度演算は、前記第2要求精度として角度の次元の許容誤差である許容角度誤差を演算するものであり、
     前記コントローラの前記精度判定は、
     前記角度計測装置により検出された加速度に基づいて前記基準面に対する角度を演算し、
     前記コントローラが演算した角度と前記角度計測装置が演算した角度との差分の絶対値である角度差を演算し、
     演算した角度差を前記許容角度誤差と比較することで行われ、
     演算した角度差が前記許容角度誤差よりも大きいときに、前記角度計測装置の前記角度演算の精度が前記第2要求精度を満たしていないと判定するものである
     ことを特徴とする建設機械。
  5.  請求項1に記載の建設機械において、
     前記車体に取り付けられ、複数の衛星からの測位信号を受信する受信装置と、
     前記受信装置が受信した前記複数の衛星からの測位信号を基に前記車体の位置及び前記車体の位置の分散値を演算する測位演算装置とを更に備え、
     前記コントローラの前記要求精度演算は、
     前記第1要求精度として寸法の次元の精度が設定されている場合において、
     前記車体の位置の分散値が所定値よりも大きい場合に前記車体の位置の分散値が大きくなるにしたがって調整寸法が大きくなるように予め規定された変換テーブルを用いて、前記測位演算装置により演算された前記車体の位置の分散値から調整寸法を設定し、
     前記第1要求精度から設定された調整寸法を減算することで、前記角度計測装置の前記角度演算に対する寸法の次元の要求精度である許容寸法誤差を演算する許容寸法誤差演算を行い、
     前記許容寸法誤差が大きくなるにしたがって前記第2要求精度が低くなるように予め規定された変換テーブルを用いて、前記許容寸法誤差演算により演算された前記許容寸法誤差から前記第2要求精度を演算するものである
     ことを特徴とする建設機械。
  6.  請求項1に記載の建設機械において、
     前記コントローラは、さらに、
     前記角度計測装置の検出結果に基づいて、前記車体が動作している状態が所定の期間以上継続しているか否かを判定する動作継続判定を行い、
     前記車体が動作している状態が前記所定の期間以上継続していると判定した場合、且つ、前記角度計測装置の前記角度演算の精度が前記第2要求精度を満たしていないと判定した場合には、前記車体の動作を停止させる
     ことを特徴とする建設機械。
  7.  請求項1に記載の建設機械において、
     前記コントローラは、
     現場の施工の進捗状態を管理する施工管理システムで管理されている施工情報に含まれている要求精度を前記第1要求精度として前記施工管理システムから取り込み、
     前記施工管理システムによって管理されている施工の進捗状態が進行するにつれて前記第1要求精度を高めていく
     ことを特徴とする建設機械。
PCT/JP2021/038634 2020-10-20 2021-10-19 建設機械 WO2022085688A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
US18/024,098 US20240102266A1 (en) 2020-10-20 2021-10-19 Construction machine
KR1020237007253A KR20230044502A (ko) 2020-10-20 2021-10-19 건설 기계
CN202180053562.0A CN116034201A (zh) 2020-10-20 2021-10-19 工程机械
EP21882829.1A EP4234819A1 (en) 2020-10-20 2021-10-19 Construction machine

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2020175824A JP7009590B1 (ja) 2020-10-20 2020-10-20 建設機械
JP2020-175824 2020-10-20

Publications (1)

Publication Number Publication Date
WO2022085688A1 true WO2022085688A1 (ja) 2022-04-28

Family

ID=80629605

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/038634 WO2022085688A1 (ja) 2020-10-20 2021-10-19 建設機械

Country Status (6)

Country Link
US (1) US20240102266A1 (ja)
EP (1) EP4234819A1 (ja)
JP (1) JP7009590B1 (ja)
KR (1) KR20230044502A (ja)
CN (1) CN116034201A (ja)
WO (1) WO2022085688A1 (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2024068558A (ja) * 2022-11-08 2024-05-20 株式会社小松製作所 作業機械の作業状態推定システムおよび作業機械の作業状態推定方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015167022A1 (ja) 2015-05-29 2015-11-05 株式会社小松製作所 作業機械の制御システム及び作業機械
JP2018145753A (ja) * 2017-03-09 2018-09-20 日立建機株式会社 作業機械の操作支援装置
JP2018193704A (ja) * 2017-05-15 2018-12-06 コベルコ建機株式会社 作業機械の自動制御装置
WO2019053833A1 (ja) * 2017-09-13 2019-03-21 日立建機株式会社 作業機械

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9745726B2 (en) * 2014-05-19 2017-08-29 Komatsu Ltd. Posture calculation device of working machinery, posture calculation device of excavator, and working machinery
JP6717535B2 (ja) * 2016-10-25 2020-07-01 三菱電機株式会社 傾斜角度検出装置およびオートレベライザ
JP6779759B2 (ja) * 2016-11-21 2020-11-04 日立建機株式会社 建設機械
JP7143117B2 (ja) * 2018-05-22 2022-09-28 住友重機械工業株式会社 ショベル
JP6910995B2 (ja) * 2018-08-30 2021-07-28 日立建機株式会社 作業機械

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2015167022A1 (ja) 2015-05-29 2015-11-05 株式会社小松製作所 作業機械の制御システム及び作業機械
JP2018145753A (ja) * 2017-03-09 2018-09-20 日立建機株式会社 作業機械の操作支援装置
JP2018193704A (ja) * 2017-05-15 2018-12-06 コベルコ建機株式会社 作業機械の自動制御装置
WO2019053833A1 (ja) * 2017-09-13 2019-03-21 日立建機株式会社 作業機械

Also Published As

Publication number Publication date
JP7009590B1 (ja) 2022-01-25
CN116034201A (zh) 2023-04-28
KR20230044502A (ko) 2023-04-04
US20240102266A1 (en) 2024-03-28
EP4234819A1 (en) 2023-08-30
JP2022067226A (ja) 2022-05-06

Similar Documents

Publication Publication Date Title
US9598845B2 (en) Posture computing apparatus for work machine, work machine, and posture computation method for work machine
US9739038B2 (en) Posture computing apparatus for work machine, work machine, and posture computation method for work machine
JP5909029B1 (ja) 作業機械の制御システム及び作業機械の制御方法
JP5969712B1 (ja) 作業車両および作業車両の制御方法
CN107002383B (zh) 作业机械的控制系统、作业机械及作业机械的控制方法
JP6058217B2 (ja) 作業車両、バケット装置及びチルト角度の取得方法
JP7245119B2 (ja) 建設機械
KR101886798B1 (ko) 작업기 제어 장치 및 작업 기계
WO2022085688A1 (ja) 建設機械
WO2021256353A1 (ja) 建設機械
JP7227111B2 (ja) 作業機械
JP6553702B2 (ja) 作業機械の制御システム、作業機械、作業機械の制御方法及びナビゲーションコントローラ
JP7489344B2 (ja) 地形情報管理システムおよび作業機械
JP7065002B2 (ja) 作業機械

Legal Events

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

Ref document number: 21882829

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 20237007253

Country of ref document: KR

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

ENP Entry into the national phase

Ref document number: 2021882829

Country of ref document: EP

Effective date: 20230522