WO2020179320A1 - 作業機械 - Google Patents

作業機械 Download PDF

Info

Publication number
WO2020179320A1
WO2020179320A1 PCT/JP2020/004152 JP2020004152W WO2020179320A1 WO 2020179320 A1 WO2020179320 A1 WO 2020179320A1 JP 2020004152 W JP2020004152 W JP 2020004152W WO 2020179320 A1 WO2020179320 A1 WO 2020179320A1
Authority
WO
WIPO (PCT)
Prior art keywords
gnss
controller
work
mask range
range
Prior art date
Application number
PCT/JP2020/004152
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 CN202080004684.6A priority Critical patent/CN112639225B/zh
Priority to US17/274,448 priority patent/US12000114B2/en
Priority to KR1020217005192A priority patent/KR102500969B1/ko
Priority to EP20766596.9A priority patent/EP3933122A4/en
Publication of WO2020179320A1 publication Critical patent/WO2020179320A1/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
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/261Surveying the work-site to be treated
    • 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/2004Control mechanisms, e.g. control levers
    • 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/08Superstructures; Supports for superstructures
    • E02F9/0858Arrangement of component parts installed on superstructures not otherwise provided for, e.g. electric components, fenders, air-conditioning units
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2025Particular purposes of control systems not otherwise provided for
    • E02F9/205Remotely operated machines, e.g. unmanned vehicles
    • 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)
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/24Acquisition or tracking or demodulation of signals transmitted by the system
    • G01S19/28Satellite selection
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/43Determining position using carrier phase measurements, e.g. kinematic positioning; using long or short baseline interferometry
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/53Determining attitude
    • G01S19/54Determining attitude using carrier phase measurements; using long or short baseline interferometry
    • 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/2058Electric or electro-mechanical or mechanical control devices of vehicle sub-units
    • E02F9/2079Control of mechanical transmission
    • 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/2058Electric or electro-mechanical or mechanical control devices of vehicle sub-units
    • E02F9/2087Control of vehicle steering
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/03Cooperating elements; Interaction or communication between different cooperating elements or between cooperating elements and receivers
    • G01S19/04Cooperating elements; Interaction or communication between different cooperating elements or between cooperating elements and receivers providing carrier phase data

Definitions

  • the present invention relates to a work machine such as a hydraulic excavator, and more particularly to a work machine equipped with a position measurement system for measuring the absolute position of a monitor point set in the work device in three-dimensional space using satellite signals of satellites. ..
  • a predetermined point (monitor point) set on a work machine has been measured using a three-dimensional position measurement system such as GNSS (Global Navigation Satellite System) to manage work.
  • GNSS Global Navigation Satellite System
  • the monitor point there is a point set on a work device provided in the work machine, for example, a bucket tip of a hydraulic shovel. If the position of the tip of the bucket can be measured, the progress of work during construction can be grasped by comparing the measured data with preset terrain data and target shape data, and management and control during construction can be performed.
  • work form data for example, excavation landform data
  • the GNSS antenna may receive the GNSS signal as a diffracted wave or a reflected wave called multipath. If diffracted waves or reflected waves are used for positioning the monitor points, the positioning results are likely to include errors.
  • a solution method for removing the influence of multipath for example, there is one described in Patent Document 1.
  • Patent Document 1 includes a receiver that receives signals from a plurality of transmitters (a plurality of satellites), determines the transmitter position of each transmitter (a plurality of satellites), and determines the position of each transmitter. Calculate the transmitters (multiple satellites) that can directly receive signals based on the position of the positioning device and the multipath information that were previously determined, and ignore the transmitters that cannot directly receive signals. There is disclosed a positioning device for determining the current position of the positioning device.
  • Patent Document 1 The technique described in Patent Document 1 described above can reduce the influence of reflection and diffraction due to obstacles, but in a working machine such as a hydraulic excavator that repeats a series of operations such as excavation, turning, and dumping, Since the relative positions of the work machine and the surrounding obstacles can easily change in response to changes in the posture of the work equipment or upper revolving structure, the combination of satellite signals used for positioning may constantly change. Positioning by GNSS has a problem that positioning error increases when the satellite used for positioning switches.
  • the present invention has been made to solve the above problems, and an object of the present invention is to perform work capable of suppressing a decrease in accuracy of GNSS positioning even when the posture of a work device or an upper swing body changes during work of a work machine. To provide the machine.
  • the present invention provides an undercarriage, an upper revolving structure that is provided on the lower traveling structure so as to be rotatable, and constitutes an automobile body together with the lower traveling structure, and is rotatable around the upper revolving structure.
  • a tilt measuring device provided on the vehicle body, an angle measuring device provided on the working device, and a three-dimensional position and direction calculating the three-dimensional position and direction of the own device based on satellite signals from satellites. Based on the information from the position measuring device, the tilt measuring device, the angle measuring device, and the three-dimensional position measuring device, the three-dimensional position and posture of the vehicle body and the predetermined three-dimensional position of the working device are determined.
  • the three-dimensional position measuring device receives a satellite signal of a satellite, and calculates the three-dimensional position and direction of the three-dimensional position measuring device among the satellites receiving the satellite signal.
  • a storage instruction device for instructing to store a combination of satellites is further provided, and the controller is a satellite selected by the three-dimensional position measuring device when an instruction is input via the storage instruction device.
  • the satellite selection information is transmitted to the three-dimensional position measuring device, and the three-dimensional position measuring device is controlled by the controller from the satellite selection information.
  • the satellite included in the satellite selection information shall be preferentially selected from the satellites that received the satellite signal.
  • the switching of the satellite signal used for the calculation of GNSS positioning can be suppressed, so that the deterioration of the positioning accuracy due to GNSS can be suppressed. As a result, work accuracy can be improved.
  • FIG. 6 is a diagram showing an example of a relationship between a vehicle body reference azimuth angle and a front shielding elevation angle ⁇ ft. It is explanatory drawing of a vehicle body reference azimuth angle. It is the figure which looked at the present terrain cross section at the time of the body reference azimuth of 15 degrees from the side. It is a figure which shows the relationship diagram of a vehicle body reference
  • the present invention is applied to a crawler type hydraulic excavator as a construction machine, and a monitor point (control point) is set at the tip of the bucket of the hydraulic excavator.
  • a monitor point control point
  • the same members are designated by the same reference numerals, and duplicate explanations will be omitted as appropriate.
  • FIG. 1 is a diagram showing the external appearance of the hydraulic excavator according to the present embodiment.
  • a hydraulic excavator 1 is mounted on a lower traveling body 2 that travels by a crawler driven by a traveling hydraulic motor (not shown), and is rotatably mounted on the lower traveling body 2 together with the lower traveling body 2 and a vehicle body.
  • the cab 4 provided on the upper revolving structure 3 and the front working machine (working device) 5 attached to the upper revolving structure 3.
  • the upper swing body 3 is driven to swing right and left by a swing hydraulic motor (not shown).
  • the front working machine 5 includes a boom 6 rotatably provided in the upper revolving structure 3 in a vertical direction, an arm 7 rotatably provided in a vertical direction at a tip of the boom 6, and an arm 7 provided in a vertical direction at a tip of the arm 7.
  • the boom 6, arm 7, and bucket 8 are driven by expanding and contracting the boom cylinder 9, arm cylinder 10, and bucket cylinder 11, respectively.
  • the boom 6, arm 7 and bucket 8 may be referred to as front members, respectively.
  • the upper swing body 3 is attached with a vehicle body IMU 21 that detects the inclination angle (pitch angle) of the upper swing body 3 with respect to a predetermined plane (for example, a horizontal plane), and the boom 6 is attached to the boom 6 with respect to a predetermined plane (for example, a horizontal plane).
  • a boom IMU 22 that detects the angle of the boom 6 (boom angle), an arm IMU 23 that detects the angle (arm angle) of the arm 7 with respect to a predetermined plane (for example, a horizontal plane) on the arm 7, and a predetermined plane (
  • a bucket IMU24 that detects the angle (bucket angle) of the bucket 8 with respect to the horizontal plane) is attached.
  • the boom IMU 22, arm IMU 23, and bucket IMU 24 may be collectively referred to as front IMU (see FIG. 2) in this document.
  • the upper swivel body 3 receives two GNSS antennas 31 and 32 for receiving satellite signals (navigation signals) transmitted from a plurality of GNSS satellites, and RTK correction data (described later) from a reference station.
  • An RTK correction data receiving antenna 34 for this purpose is installed.
  • the two GNSS antennas 31 and 32 are installed on the left and right sides of the rear part of the swivel body deviating from the swivel center of the upper swivel body 3.
  • the position measurement system 200 shown in this figure includes a radio 35, a GNSS receiver 33, a controller 38, a display device 39, and a setting switch 40.
  • the radio 35 receives RTK correction data (described later) from the reference station via the RTK correction data receiving antenna 34, and outputs the RTK correction data to the GNSS receiver 33.
  • the GNSS receiver 33 is a GNSS antenna of one of the two GNSS antennas 31 and 32 based on the RTK correction data input from the radio 35 and the signal from the GNSS satellite received by the GNSS antennas 31 and 32.
  • the position of 31 and the vector from one GNSS antenna 31 of the two GNSS antennas 31 and 32 to the other GNSS antenna 32 are calculated in real time, and as a result, the upper part of the geographical coordinate system (global coordinate system) is calculated.
  • the position and azimuth angle of the swivel body 3 can be calculated.
  • the controller 38 inputs the position and vector data calculated by the GNSS receiver 33 and the angle data from the IMUs 21 to 24, and inputs the position and azimuth of the upper swivel body 3 and the position of the tip (monitor point) of the bucket 8. Is calculated.
  • the controller 38 includes, as hardware, an arithmetic processing unit (for example, CPU), a storage device (for example, semiconductor memory such as ROM and RAM), and an interface (input/output device), and is stored in advance in the storage device.
  • the program (software) is executed by the arithmetic processing unit, the arithmetic processing unit performs arithmetic processing based on the data specified in the program and the data input from the interface, and the signal (computation result) is output from the interface to the outside.
  • the GNSS receiver 33 can also have the same type of hardware as the controller 38.
  • the display device (monitor) 39 displays the calculation result of the controller 38 and various data acquired by using the calculation result.
  • a setting switch (mask range reset switch) 40 is connected to the controller 38.
  • the setting switch 40 is a switch for releasing (erasing) all mask ranges (described later) set at that time, and is pressed at a timing desired by the operator, whereby the controller 38 sets all mask ranges. delete. The details of setting the mask range and the scene where the setting switch 40 is used will be described later.
  • An external recording medium (external storage device) 42 such as a semiconductor memory can be connected to the controller 38.
  • the external recording medium 42 stores topographical data including the current topographical data and the target topographical data (also referred to as design data), and the operator connects the external recording medium 42 to the controller 38 at a predetermined timing such as when the system is started. Then, if necessary, the data is downloaded to the storage device in the controller 38. At the end of work, for example, the post-work current terrain data generated from the trajectory data of the bucket tip position during system startup is recorded in the external recording medium 42 and used for construction management.
  • FIG. 3 is a block diagram of an office-side measurement system (reference station system) 50 that functions as a GNSS reference station.
  • the office-side measurement system 50 includes a GNSS antenna 52, a GNSS receiver 51, a radio 53, and a radio antenna 54.
  • GNSS antenna 52 is an antenna for receiving satellite signals (navigation signals) transmitted from a plurality of GNSS satellites.
  • the GNSS receiver 51 functions as a GNSS reference station (hereinafter, the GNSS receiver 51 may be referred to as a GNSS reference station 51), and pre-measured three-dimensional position data (for example, the position of the GNSS antenna 52) and data. Based on the satellite signal received by the GNSS antenna 52, correction data for RTK (real time kinematic) measurement is generated by the GNSS receiver 33 of the hydraulic excavator 1 and output to the wireless device 53.
  • RTK real time kinematic
  • the wireless device 53 transmits the correction data input from the GNSS receiver 51 to the wireless device 35 of the hydraulic excavator 1 via the wireless antenna 54.
  • RTK measurement is performed by the GNSS receiver 33 shown in FIG.
  • the GNSS reference station 51 for generating the correction data shown in FIG. 3 is required.
  • the GNSS reference station 51 is corrected data for RTK measurement based on the position data of the GNSS antenna 52 measured in advance in three dimensions as described above and the satellite signals from a plurality of GNSS satellites received by the GNSS antenna 52. Is generated, and the generated correction data is transmitted by the radio 53 via the antenna 54 at regular intervals.
  • the GNSS receiver 33 on the hydraulic excavator 1 side shown in FIG. 2 has correction data received by the radio 35 via the antenna 34 and satellites from a plurality of GNSS satellites received by the GNSS antennas 31 and 32.
  • RTK measurement is performed on the three-dimensional position of the GNSS antenna 31 and the vector from the GNSS antenna 31 to the GNSS antenna 32.
  • the three-dimensional position of the GNSS antenna 31 in the geographic coordinate system and the vector from the GNSS antenna 31 to the GNSS antenna 32 are measured with high accuracy. Then, the measured three-dimensional position data and vector data are input to the controller 38.
  • tilt angles that is, pitch angle and roll angle
  • the angles of the boom 6, arm 7 and bucket 8 are measured by the IMUs 21 to 24, and are similarly input to the controller 38.
  • the controller 38 performs general vector calculation and coordinate conversion based on the input various data to determine the position of the upper swing body 3 in a predetermined coordinate system (for example, the site coordinate system set on the ground of the work site) and The posture (including the azimuth) and the position of the tip (monitor point) of the bucket 8 are calculated.
  • the controller 38 also displays the bucket image and the target on the screen of the display device 39 based on the calculated position and orientation of the upper swing body 3, the position of the bucket tip, and the target terrain data input from the external recording medium 41.
  • the terrain can be displayed to inform the operator of the work status.
  • FIG. 4 schematically shows the posture of the hydraulic excavator 1 during the excavation operation.
  • the hydraulic excavator 1 is performing so-called slope up work.
  • the image shown in FIG. 4 is substantially equal to the information displayed on the display device 39, and the operator performs the excavation operation of the hydraulic excavator 1 based on this information so that the on-site form 61 approaches the target landform 62.
  • FIG. 5 schematically shows the posture of the hydraulic excavator 1 during the turning operation.
  • the turning operation is performed in a state where the boom 6 is lifted after the excavation operation is completed, the arm 7 and the bucket 8 are wound, and the clearance between the bucket 8 and the ground is secured. Then, the arm 7 and the bucket 8 are dumped at the dumping position to drop the excavated soil at a predetermined position. After that, a turning operation for returning to the excavation position is performed, and the excavation operation is repeated.
  • FIG. 6 schematically shows the excavation position and the dumping position of the hydraulic excavator 1 and the arrangement of the GNSS satellites 81 to 87 in the sky view of the GNSS antennas 31 and 32 at that time.
  • a state in which the front working machine 5 faces upward is an excavation position 71
  • a state in which the front working machine 5 faces left is an earth releasing position 72.
  • the movement from the excavating position 71 to the earth releasing position 72 is a left turn.
  • the movement from the discharge position 72 to the excavation position 71 shall be performed by turning right.
  • the GNSS receiver 33 determines various conditions such as the quality of satellite signals from GNSS satellites received by GNSS antennas 31 and 32 and the arrangement of GNSS satellites receiving satellite signals.
  • the GNSS satellite (satellite signal) used for position calculation is selected.
  • the arrangement of the GNSS satellites is evaluated by a numerical value called DOP (Calculation of Precision).
  • DOP Determination of Precision
  • the DOP is bad (the numerical value is large).
  • the calculated position accuracy deteriorates.
  • the DOP is good (the numerical value is small) and the calculated position accuracy is improved. This is because the position measurement by GNSS is a measurement system that applies triangulation.
  • the GNSS satellites 81 to 87 that can be captured are arranged as shown in FIG. 6, as the GNSS satellites used for position calculation at the excavation position 71, for example, the satellites 81, 83, 84 shown in black in FIG. 86 is selected.
  • the GNSS antennas 31, 32 and the GNSS satellites 81, 86, 87 are taken.
  • the satellite signals of the GNSS satellites 81, 86, and 87 are blocked by the passage of the front work equipment 5 between the two.
  • the GNSS satellites 82 to 85 shown in the fill in FIG. 8 are selected, which may change from the combination selected in the excavation position 71 in FIG.
  • the hydraulic excavator 1 returns to the excavation position 71 by turning right and repeats the excavation operation, but while turning right from the dumping position 72 to the excavation position 71, the satellite signals of the GNSS satellites 82 to 85 are in front. Since it is not blocked by the work equipment 5, the combination of GNSS satellites used for position calculation is held by the GNSS satellites 82 to 85 even at the excavation position 71 as shown in FIG. 9, and the GNSS satellites selected during the previous excavation operation. The combination of 81, 83, 84, and 86 may remain changed.
  • GNSS In position measurement by GNSS, there are slightly different error factors in each GNSS satellite such as clock error of GNSS satellite and error of orbit information other than DOP, and even if the hydraulic excavator 1 is in the same position, it is used for position calculation. If the combination of GNSS satellites is different, the position calculation result may be different and the reproducibility of the position calculation may be deteriorated.
  • the positional relationship between the bucket 8 displayed on the display device 39 and the target terrain 62 may differ before and after the excavation operation, and eventually the finished product. Can cause problems such as discontinuity.
  • FIG. 10 is a flowchart showing an example of the satellite selection logic executed by the controller 38. Note that the flowchart of FIG. 10 is repeatedly calculated in a constant cycle (for example, 100 ms).
  • step S10 the controller 38 determines whether the information from the GNSS receiver 33 has a Fix solution by RTK. Whether or not this state is present can be determined by referring to, for example, the GGA sentence of the NMEA message from the GNSS receiver 33.
  • step S10 If it is determined in step S10 that the Fix solution has not been obtained, it is determined that correct positioning has not been performed, and the process proceeds to step S20, indicating that the controller 38 has not been able to perform correct measurement on the display device 39. Display and return to the initial state (wait for the next control cycle). On the other hand, if it is determined in step S10 that the Fix solution has been obtained, the process proceeds to step S30.
  • step S30 the controller 38 is based on the three-dimensional position of the GNSS antenna 31 input from the GNSS receiver 33, the vector information from the GNSS antenna 31 to the GNSS antenna 32, and the angle information input from the IMUs 21 to 24.
  • the general vector calculation and coordinate conversion are performed to calculate the position and orientation of the upper swing body 3 and the position of the tip of the bucket 8 in the on-site coordinate system, and the orientation information of the bucket 8 and the topography obtained from the external recording medium 42 are calculated.
  • the display device 39 displays information on the current topography and target shape generated based on the data.
  • step S40 the controller 38 determines whether or not the hydraulic excavator 1 is in the process of demanding accuracy by the determination method shown in FIG.
  • FIG. 11 is a flowchart showing one specific example of the processing performed in step S40.
  • step S401 the controller 38 determines whether or not the distance between the front working machine 5 and the target surface (target surface distance) is equal to or less than the predetermined value d1.
  • the target surface distance for example, the distance between the bucket tip (toe) position and the target surface can be used.
  • a perpendicular is drawn from the position of the bucket tip (monitor point) calculated in step S30, the point at which the perpendicular intersects the target terrain surface defined by the target terrain data, and the point and the bucket tip are calculated.
  • the distance can be the target surface distance. If the target surface distance is larger than the predetermined value d1, the controller 38 determines that the excavation work requiring accuracy is not performed because the bucket tip is located away from the target surface. On the other hand, if it is determined that the target surface distance is less than or equal to the predetermined value d1, the process proceeds to step S402.
  • step S402 the controller 38 determines whether or not an excavation operation has been input to an operation device (not shown) that operates the front working machine 5 (boom 6, arm 7, bucket 8) installed in the cab 4. Is determined. Whether or not the excavation operation is input is determined here by whether or not the arm 7 (arm cylinder 10) is driven. Whether or not the arm 7 (arm cylinder 10) is being driven is detected by, for example, detecting the operation pilot pressure of the arm 7 output from the operating device with a pressure sensor and checking whether the detected pressure exceeds a predetermined value. You can judge by doing.
  • step S401 and step S402 the controller 38 considers that the excavator 1 is in the process of excavating for accuracy. By doing so, even if the bucket tip and the target surface are equal to or smaller than the predetermined value d1 in step S401, if it is determined in step S402 that the excavation operation is not performed, for example, the terrain excavated along the target surface is determined.
  • the arm 7 is stopped by bringing the tip of the bucket 8 into contact with it, it is determined that the excavation work is not in progress, and therefore it is possible to prevent the mask range described below from being unnecessarily widened.
  • step S401 when it is determined in step S401 that the target surface distance exceeds the predetermined value d1, for example, when rough finishing work is performed, it is possible to prevent the mask range described below from being unnecessarily widened.
  • the determination of the excavation operation is made only by the operation pilot pressure of the arm, the excavation operation may be determined by including the operation pilot pressure of the boom 6 or the bucket 8. Further, the judgment may be made in consideration of the continuity of the past operation pilot pressure (that is, the time series of the detected operation pilot pressure) instead of the instantaneous value. Further, instead of the operation pilot pressure, for example, the excavation reaction force applied to the arm cylinder 10 may be detected by a pressure sensor installed in the arm cylinder 10 to determine the excavation operation.
  • step S401 it is determined whether or not the hydraulic excavator 1 is performing the work requiring accuracy based on both the size of the target surface distance (step S401) and the presence or absence of the excavation operation (step S402).
  • the determination may be made based on any of (steps S401 and S402). That is, the determination may be made based on at least one of these two processes.
  • step S40 if it is determined in step S40 that the hydraulic excavator 1 is not in the process of requiring accuracy, the process proceeds to step S45.
  • step S45 the controller 38 starts measuring the time (duration) T in which the state determined not to be in the process of requesting accuracy continues, and proceeds to step S70. If the measurement of the time T has already started when the step S45 is reached, the measurement shall be continued.
  • step S40 determines that accuracy is required. If it is determined in step S40 that accuracy is required, the process proceeds to step S50.
  • step S50 the controller 38 sets the range on the ground where the front working machine 5 can become an obstacle to the satellite signals when each of the two GNSS antennas 31 and 32 receives the satellite signals from the plurality of GNSS satellites.
  • Set as a mask range on the coordinate system for example, the field coordinate system.
  • satellite signals from GNSS satellites located in this mask range can be excluded from satellite signals used for positioning by the GNSS receiver 33. That is, in step S50, the range of satellite arrangement that should not be used for positioning is calculated.
  • step S50 the controller 38 of the present embodiment sets the installation positions of the two GNSS antennas 31 and 32 in the upper swing body 3 (hydraulic excavator 1) stored in advance in the storage device of the controller 38 (for example, the upper swing body). 3), the movable range of the front working machine 5 (boom 6, arm 7, bucket 8), the tilt angle of the upper swing body 3 detected by the vehicle body IMU 21, and the GNSS antenna.
  • the mask range is set based on the azimuth angle of the upper swing body 3 calculated from the vector information from the 31 to the GNSS antenna 32.
  • the mask range is set for each of the two GNSS antennas 31 and 32.
  • the mask range can be defined by a combination of an azimuth angle range (an angle range in the left-right direction) and an elevation angle range (an angle range in the up-down direction) based on the GNSS antennas 31 and 32.
  • the shape data (the shape data includes the position) of the obstacle (for example, the existing terrain, building, structure) that exists around the hydraulic excavator 1 and can become the obstacle of the satellite signal is acquired.
  • the controller 38 can set the mask range caused by the front work implement 5 as well as the range in which the satellite signal can be blocked by the obstacle as the mask range.
  • the current terrain data from the external recording medium 42 is stored in advance in the storage device in the controller 38 as the shape data of the obstacle, and in step S50, the controller 38 makes an upper turn in the geographical coordinate system (global coordinate system).
  • the azimuth angle of the upper swivel body 3 Calculates the cross-sectional shape of the current terrain in a predetermined azimuth direction with reference to, and when each of the two GNSS antennas 31 and 32 receives satellite signals from a plurality of GNSS satellites, the current terrain having that cross-sectional shape is the satellite.
  • the mask range may be set by further considering the range that may be an obstacle of the signal.
  • step S50 an example of the mask range calculation process in step S50 will be described with reference to FIGS.
  • the calculation of the mask range of the GNSS antenna 31 will be described, but the mask range of the GNSS antenna 32 can also be calculated by the same method.
  • the elevation angle mask angle that defines the elevation angle range of the mask range is defined as the plus direction from the horizontal plane to the sky and the elevation angle of 90 degrees in the zenith direction. Therefore, the elevation angle mask angle is 0 degrees at the lower end and 90 degrees at the upper end. Further, the azimuth mask angle that defines the azimuth angle range of the mask range is defined as a range from 0 to 360 degrees with 0° in the north direction and a positive direction in the clockwise direction.
  • FIG. 12 is a diagram showing an example of the relationship between the vehicle body reference azimuth angle and the front shielding elevation angle ⁇ ft, and the front shielding elevation angle ⁇ ft is defined for each vehicle body reference azimuth angle.
  • the range of the front shielding elevation angle ⁇ ft or less at each vehicle body reference azimuth is the shielding range (mask range) of the satellite signal.
  • the vehicle body reference azimuth angle and the front shielding elevation angle ⁇ ft here are defined by the vehicle body coordinate system set in the upper swing body 3. As shown in FIG.
  • the front shielding elevation angle ⁇ ft is defined at intervals of 5 degrees.
  • the front work implement 5 does not become an obstacle of the satellite signal except the range of the vehicle body reference azimuth angle from 10 degrees to 25 degrees, so the front shielding elevation angle is 0 degree.
  • FIG. 13 shows a range in which the vehicle body reference azimuth angle is from 10 degrees to 25 degrees as a mask range (azimuth range) 90.
  • the front shield elevation angle ⁇ ft may be defined from the maximum movable range of the front members 6, 7, and 8, or may be defined by a predicted movable range predicted to be used during work.
  • FIG. 14 is a side view of the current terrain cross section when the vehicle body reference azimuth is 15 degrees.
  • the elevation mask angle ⁇ s by the vehicle body (front work machine 5) in the site coordinate system is calculated by the following equation (1) depending on the front shielding elevation angle ⁇ ft in the vehicle body coordinate system and the vehicle body inclination angle ⁇ bd obtained from the vehicle body IMU21. Obtained by 1).
  • the elevation angle mask angle ⁇ g ⁇ ft ⁇ ⁇ bd... Equation (1)
  • the existing terrain shown in FIG. 14 shows a cross section of the existing terrain in the direction of the vehicle body reference azimuth of 15 degrees. All straight lines in contact with the cross section of the current terrain are drawn from the position of the GNSS antenna 31 measured by the GNSS receiver 33, and the maximum value of the angles formed by all the straight lines with the horizontal plane is defined as the elevation mask angle ⁇ g according to the current terrain. ..
  • the vehicle body is set to the azimuth angle ⁇ t of the upper swivel body 3 calculated by the GNSS receiver 33.
  • the cross section of the current terrain shown in FIG. 14 can be acquired by taking the cross section of the current terrain data in the angle direction (that is, ⁇ t+ ⁇ b) to which the reference azimuth ⁇ b is added.
  • the larger of the elevation mask angle ⁇ s based on the vehicle body and the elevation mask angle ⁇ g based on the current terrain obtained above is the elevation mask angle of the azimuth angle.
  • the elevation mask angle ⁇ s by the vehicle body becomes the elevation mask angle, and the mask range 90 in the elevation angle range when the vehicle body reference azimuth angle is 15 degrees is as illustrated.
  • the elevation mask angle in all directions is calculated.
  • the mask range is set in the field coordinate system based on the result.
  • the mask range may be set in the coordinate system set on the ground, and may be set in the geographical coordinate system, for example.
  • step S60 the controller 38 uses the mask range set before the current calculation cycle (the mask range set in the past (however, the mask range reset in steps S90 and 110 described later is excluded). )))
  • the mask range (newly set mask range) calculated in step S50 is added (added).
  • step S60 for example, when the inclination angle of the upper swing body 3 is changed from the processing of one cycle before or the azimuth angle is changed by the swing motion of the upper swing body 3, a new value is added according to the change.
  • Mask range is set. Then, by adding the new mask range to the past mask range, the mask range is expanded according to the change of the inclination angle and the azimuth angle of the upper swing body 3.
  • step S70 the controller 38 transmits the mask range stored in the storage device to the GNSS receiver 33.
  • the mask range of step S60 is transmitted to the GNSS receiver 33, and when reaching step S70 via step S45, finally set in step S60.
  • the masked range (however, the masked range is not transmitted if the masked range is reset in steps S90 and S110 and has not passed through step 60 even once) is transmitted.
  • step S80 the controller 38 determines whether or not it has received information from the GNSS receiver 33 that positioning cannot be performed in the state where the mask range is set. In making this determination, the GNSS receiver 33 performs the processing described below. That is, the GNSS receiver 33 receives the mask range transmitted from the controller 38 in step S70 and transmits from the remaining satellites except for the satellites located in the mask range from a plurality of GNSS satellites capable of receiving satellite signals. Determine if positioning can be performed based on the satellite signal.
  • the GNSS receiver 33 transmits to the controller 38 information indicating that positioning can be performed with the mask range set, and the position of the GNSS antenna 31 , The vector from the GNSS antenna 31 to the GNSS antenna 32 is calculated, and the calculation result is output to the controller 38.
  • the mask range the number of satellites used is insufficient (for example, less than 5) and positioning calculation cannot be performed, or the satellites used are biased (for example, when the DOP is greater than a predetermined value). If there is a possibility of a decrease in accuracy, it means that positioning cannot be performed with the mask range set to the controller 38 because the positioning calculation is performed with the mask range released in step S90 described later. Send information.
  • the controller 38 calculates the masked azimuth range and elevation range and sends the range (mask range) to the GNSS receiver 33
  • the controller 38 uses the GNSS receiver 33 to The satellite number that can receive the satellite signal and the information of the azimuth and elevation angle of the satellite are acquired, the satellite number within the mask range calculated by the controller 38 is calculated, and the satellite number that is not used for the positioning calculation is received by GNSS. It may be transmitted to the machine 33 to carry out the above determination.
  • step S80 When receiving information from the GNSS receiver 33 that positioning cannot be performed in the state where the mask range is set in step S80, the controller 38 proceeds to step S90 and the positioning accuracy is lowered on the screen of the display device 39. It displays that there is a possibility of being present, and resets the mask range information stored in the controller 38. This erases the entire mask range. At the same time as resetting the mask range, the duration T measured in step S45 is also reset.
  • step S80 when the information that the positioning is possible even when the mask range is set is received from the GNSS receiver 33 (that is, the information that the positioning is not possible when the mask range is set is received. If not), the process proceeds to step S100.
  • step S100 the controller 38 determines whether or not the mask range needs to be reset (erased). In this determination, when the time T measured in step S45 continues for a predetermined time t1 or more (for example, 10 minutes or more), and when the hydraulic excavator 1 is operated by the operating device in the cab 4 on the lower traveling body 2 for a predetermined distance or more.
  • a predetermined time t1 or more for example, 10 minutes or more
  • the controller 38 determines that the mask range needs to be reset.
  • the movement of the hydraulic excavator 1 due to the traveling operation can be detected, for example, from the detection of the traveling pilot pressure and the position movement of the excavator 1 performed based on the positioning calculation of the GNSS receiver 33.
  • step S100 If it is determined in step S100 that the mask range needs to be reset, the controller 38 proceeds to step S110 to reset the mask range, and at the same time resets the time T measured in step S45 to zero.
  • the satellite signal that may be affected by the obstacle including the front work implement 5 is used for the positioning calculation. This prevents the combination of satellites used for positioning calculation from being switched during excavation and reducing the accuracy of positioning calculation, and the accuracy of positioning calculation using satellite signals affected by the diffraction of radio waves. it can.
  • a mask range corresponding to the azimuth angle and inclination angle of the upper swivel body 1 during work is set in the field coordinate system, and the satellite signal of the GNSS satellite located in the mask range is set.
  • the positioning calculation is performed by the GNSS receiver 33 without using it. As a result, it is possible to prevent the positioning accuracy of the GNSS from being lowered during the work due to satellite switching or satellite signal diffraction associated with the operation of the front work implement 5 (mainly the boom raising operation). As a result, the position calculation result of the monitor point is prevented from fluctuating, so that the control accuracy of the hydraulic excavator 1 can be improved.
  • the hydraulic excavator 1 has a specification that the mask range is set while the work requiring accuracy is being performed, and the condition that the work not requiring accuracy continues for a predetermined time t1 or the mask range.
  • the setting of the mask range is canceled when the positioning accuracy is lowered by the setting of.
  • priority is given to the immediacy of positioning over accuracy in situations where accuracy is unnecessary or where accuracy does not appear. It is configured so that the positioning can be performed in conformity.
  • the mask range is expanded in addition to the mask range. That is, for example, when the upper swing body 3 turns from the excavation position to the dumping position, the mask range is set according to the change in the azimuth angle of the upper swing body 3 during the turn, and the mask range is added to the past mask range. Will be done. As a result, it is possible to prevent different satellites from being selected at the excavation position and the dumping position, so that it is possible to prevent the positioning accuracy from deteriorating due to satellite switching.
  • the mask range can be set in consideration of not only the front working machine 5 but also the influence of the obstacle (for example, the current terrain) on positioning. Since the positioning calculation can be performed without using the satellite signal shielded by the obstacle, the positioning accuracy can be further improved.
  • each configuration related to the controller (control device) 38 functions and execution processing of each configuration, a part or all of them is designed as hardware (for example, a logic for executing each function is designed by an integrated circuit, etc.). ) May be realized.
  • the configuration related to the controller 38 may be a program (software) that realizes each function related to the configuration of the control device by being read and executed by an arithmetic processing unit (for example, CPU).
  • Information related to the program can be stored in, for example, a semiconductor memory (flash memory, SSD, etc.), a magnetic storage device (hard disk drive, etc.), a recording medium (magnetic disk, optical disk, etc.), and the like.
  • control line and the information line are shown to be necessary for the description of the embodiment, but all control lines and information lines related to the product are not necessarily required. Does not always indicate. In reality, it can be considered that almost all the configurations are connected to each other.
  • GNSS reference station GNSS receiver
  • GNSS reference station antenna GNSS reference station antenna
  • Radio GNSS correction data transmission antenna
  • 61 ... Local type
  • 62 ... Target terrain, 71 ... Excavation position, 72 ... Exhaust position, 81-87 ... GNSS satellite, 200 ... Position measurement system

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Physics & Mathematics (AREA)
  • Structural Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Civil Engineering (AREA)
  • Mining & Mineral Resources (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)
  • Operation Control Of Excavators (AREA)
  • Component Parts Of Construction Machinery (AREA)

Abstract

2つのGNSSアンテナで受信された衛星信号に基づいて上部旋回体の位置と方位角を演算する受信機と、受信機で演算された上部旋回体の位置及び方位角とに基づいてバケットの先端位置を演算するコントローラとを油圧ショベルに備える。コントローラは、2つのGNSSアンテナの設置位置と、フロント作業機の可動範囲と、上部旋回体の傾斜角度及び方位角とに基づいて、2つのGNSSアンテナのそれぞれについてフロント作業機が衛星信号の受信の妨げとなり得る範囲をマスク範囲として設定する。受信機は、マスク範囲に位置する衛星を除いた残りの衛星から送信される衛星信号に基づいて上部旋回体の位置と方位角を演算する。

Description

作業機械
 本発明は,油圧ショベル等の作業機械に係り,特に,作業装置に設定されたモニタポイントの3次元空間における絶対位置を衛星の衛星信号を用いて計測する位置計測システムが搭載された作業機械に関する。
 近年,建設施工現場において,作業機械に設定した所定の点(モニタポイント)の位置をGNSS(Global Navigation Satellite System)等の3次元位置計測システムを用いて計測し,作業管理を行うことがなされている。モニタポイントの代表例としては,作業機械が備える作業装置に設定した点,例えば油圧ショベルのバケット先端がある。このバケット先端の位置を計測できれば,その計測データを予め設定した地形データや目標形状データと比較することにより施工中の作業進行状況を把握でき,施工中の管理や制御が行える。また,施工終了時までの計測データの履歴から出来形データ(例えば掘削地形データ)を生成することで,施工後も施工管理が行える。
 ところで,例えば油圧ショベルにおいては,ブーム,アーム及びバケット等のGNSSアンテナより上方に位置し得る作業装置や周辺の障害物がGNSS衛星から送信される信号(GNSS信号,衛星信号)の障害物となるため,GNSSアンテナは,GNSS信号をマルチパスと呼ばれる回折波や反射波として受信する可能性がある。モニタポイントの測位に回折波や反射波を使用すると,測位結果に誤差を含む可能性が高い。マルチパスの影響を除去する解決手法として,例えば特許文献1の記載のものがある。
 特許文献1には,複数の送信機(複数の衛星)から信号を受信する受信装置を具備し,各送信機(複数の衛星)の送信機位置を判定し,その各送信機の位置と,前回判定された位置決め装置の位置と,マルチパス情報とに基づいて,信号の直接受信が可能である送信機(複数の衛星)を計算し,信号の直接受信が不可能である送信機を無視して位置決め装置の現在の位置を判定する位置決め装置が開示されている。
特表2010-534849号公報
 上述した特許文献1記載の技術では,障害物による反射や回折の影響を低減することはできるが,油圧ショベルのように,掘削,旋回,放土等の一連の動作を繰り返す作業機械においては,作業装置や上部旋回体の姿勢の変化に応じて作業機械と周辺の障害物との相対位置が容易に変化し得るため,測位に使用する衛星信号の組合せが絶えず切り替わる可能性がある。GNSSによる測位では,測位に使用する衛星が切り替わると測位誤差が大きくなるという課題がある。
 本発明は上記課題を解決するためになされたものであって,その目的は,作業機械の作業中に作業装置や上部旋回体の姿勢が変化しても,GNSS測位の精度低下を抑制できる作業機械を提供することにある。
 上記目的を達成するために,本発明は,下部走行体と,前記下部走行体に旋回可能に設けられ,前記下部走行体と共に車体を構成する上部旋回体と,前記上部旋回体に回動可能に設けられた作業装置と,前記車体に設けられた傾斜計測装置と,前記作業装置に設けられた角度計測装置と,衛星の衛星信号に基づいて自身の3次元位置および方向を計算する3次元位置計測装置と,前記傾斜計測装置,前記角度計測装置,および前記3次元位置計測装置からの情報に基づいて,前記車体の3次元位置および姿勢,ならびに前記作業装置の所定位置の3次元位置を計算するコントローラとを備えた作業機械において,前記3次元位置計測装置は,衛星の衛星信号を受信し,衛星信号を受信した衛星のうち,前記3次元位置計測装置の3次元位置および方向の計算に使用する衛星を選択し,選択した衛星の衛星信号に基づいて,前記3次元位置計測装置の3次元位置および方向を計算し,前記作業機械は,前記3次元位置計測装置によって選択されている衛星の組み合わせを記憶するように指示するための記憶指示装置を更に備え,前記コントローラは,前記記憶指示装置を介して指示が入力されたときに,前記3次元位置計測装置によって選択されている衛星の組み合わせを衛星選択情報として記憶し,所定の変更条件が成立したときに,前記衛星選択情報を前記3次元位置計測装置に送信し,前記3次元位置計測装置は,前記コントローラから前記衛星選択情報を受信した場合に,衛星信号を受信した衛星のうち,前記衛星選択情報に含まれる衛星を優先的に選択するものとする。
 本発明によれば,作業中に作業装置や上部旋回体の姿勢が変化しても,GNSS測位の演算に使用する衛星信号の切替わりを抑制できるので,GNSSによる測位精度の低下を抑制でき,ひいては作業精度を向上できる。
本発明の実施の形態に係る油圧ショベルの外観を示す図である 油圧ショベルに搭載された位置計測システムの装置構成を示すブロック図である。 GNSS基準局としての役割を持つ事務所側システムの装置構成を示すブロック図である。 油圧ショベルの掘削動作時の姿勢を模式的に示した図である。 油圧ショベルの旋回動作時の姿勢を模式的に示した図である。 油圧ショベルの掘削位置および放土位置,ならびにその時のGNSSアンテナの上空視界内にあるGNSS衛星の配置を模式的に示した図である。 油圧ショベルの掘削位置,その時のGNSSアンテナの上空視界内にあるGNSS衛星の配置,および位置計算に使用されているGNSS衛星の組み合わせを模式的に示した図である。 油圧ショベルの放土位置,その時のGNSSアンテナの上空視界内にあるGNSS衛星の配置,および位置計算に使用されているGNSS衛星の組み合わせを模式的に示した図である。 油圧ショベルの掘削位置,その時のGNSSアンテナの上空視界内にあるGNSS衛星の配置,および位置計算に使用されているGNSS衛星の組み合わせを模式的に示した図である。 コントローラの処理を示すフローチャートである。 図10中のステップS40で行われる処理の具体例の1つを示すフローチャートである。 車体基準方位角とフロント遮蔽仰角αftの関係の一例を示す図である。 車体基準方位角の説明図である。 車体基準方位角が15度の場合における現況地形断面を横から見た図である。 車体基準方位角と上部旋回体の方位角の関係図を示す図である。
 以下,本発明の実施の形態について図面を用いて説明する。本実施の形態は,建設機械としてクローラ式の油圧ショベルに本発明を適用し,油圧ショベルのバケット先端にモニタポイント(制御点)を設定した場合のものである。なお,各図中,同等の部材には同一の符号を付し,重複した説明は適宜省略する。
 図1は,本実施の形態に係る油圧ショベルの外観を示す図である。
 図1において,油圧ショベル1は,走行油圧モータ(図示せず)によって駆動されるクローラで走行する下部走行体2と,下部走行体2の上に旋回可能に取り付けられ,下部走行体2と共に車体を構成する上部旋回体3と,上部旋回体3に設けられたキャブ4と,上部旋回体3に取り付けられたフロント作業機(作業装置)5とを備えている。上部旋回体3は旋回油圧モータ(図示せず)によって左右に旋回駆動される。フロント作業機5は,上部旋回体3に上下方向に回転可能に設けられたブーム6と,ブーム6の先端に上下方向に回転可能に設けられたアーム7と,アーム7の先端に上下方向に回転可能に設けられたバケット(アタッチメント)8とを有する多関節型の作業装置である。ブーム6,アーム7,バケット8は,それぞれ,ブームシリンダ9,アームシリンダ10,バケットシリンダ11を伸縮することにより駆動される。ブーム6,アーム7及びバケット8をそれぞれフロント部材と称することがある。
 また,上部旋回体3には所定の平面(例えば水平面)に対する上部旋回体3の傾斜角(ピッチ角度)を検出する車体IMU21が取り付けられており,ブーム6には所定の平面(例えば水平面)に対するブーム6の角度(ブーム角度)を検出するブームIMU22が,アーム7には所定の平面(例えば水平面)に対するアーム7の角度(アーム角度)を検出するアームIMU23が,バケット8には所定の平面(例えば水平面)に対するバケット8の角度(バケット角度)を検出するバケットIMU24が取り付けられている。なお,本稿ではブームIMU22,アームIMU23及びバケットIMU24をフロントIMU(図2参照)と総称することがある。
 さらに,上部旋回体3には,複数のGNSS衛星から送信される衛星信号(航法信号)を受信するための2個のGNSSアンテナ31,32と,基準局からのRTK補正データ(後述)を受信するためのRTK補正データ受信アンテナ34が設置されている。2個のGNSSアンテナ31,32は上部旋回体3の旋回中心から外れた旋回体後部の左右に設置されている。
 図2は,油圧ショベル1に搭載された位置計測システムの構成図である。この図に示す位置計測システム200は,無線機35と,GNSS受信機33と,コントローラ38と,表示装置39と,設定用スイッチ40とを備えている。
 無線機35は,基準局からのRTK補正データ(後述)をRTK補正データ受信アンテナ34を介して受信し,RTK補正データをGNSS受信機33に出力する。
 GNSS受信機33は,無線機35から入力したRTK補正データと,GNSSアンテナ31,32により受信されるGNSS衛星からの信号とに基づいて,2個のGNSSアンテナ31,32のうち一方のGNSSアンテナ31の位置と,2個のGNSSアンテナ31,32のうち一方のGNSSアンテナ31から他方のGNSSアンテナ32へのベクトルとをリアルタイムに演算しており,これにより地理座標系(グローバル座標系)における上部旋回体3の位置と方位角が演算できる。
 コントローラ38は,GNSS受信機33で演算された位置及びベクトルデータとIMU21~24からの角度データを入力して,上部旋回体3の位置と方位角や,バケット8の先端(モニタポイント)の位置を演算する。コントローラ38は,ハードウェアとして,演算処理装置(例えばCPU),記憶装置(例えば,ROM,RAM等の半導体メモリ),インタフェース(入出力装置)を備えており,記憶装置内に予め保存されているプログラム(ソフトウェア)を演算処理装置で実行し,プログラム内で規定されているデータとインタフェースから入力されたデータに基づいて演算処理装置が演算処理を行い,インタフェースから外部に信号(演算結果)を出力する。なお,図示はしないが,GNSS受信機33もコントローラ38と同種のハードウェアを備えることができる。
 表示装置(モニタ)39は,コントローラ38の演算結果及びそれを利用して取得される各種データを表示する。
 コントローラ38には,設定用スイッチ(マスク範囲リセットスイッチ)40が接続されている。設定用スイッチ40は,その時に設定されている全てのマスク範囲(後述)を解除(消去)するためのスイッチであり,オペレータが希望するタイミングで押下され,それによりコントローラ38は全てのマスク範囲を削除する。マスク範囲の設定の詳細や設定用スイッチ40が利用される場面については後述する。
 また,コントローラ38には,半導体メモリ等の外部記録媒体(外部記憶装置)42を接続することができる。外部記録媒体42には,現況地形データや目標地形データ(設計データとも称する)を含む地形データが記憶されており,オペレータはシステム起動時等の所定のタイミングで外部記録媒体42をコントローラ38に接続して,必要な場合にはコントローラ38内の記憶装置にデータをダウンロードする。そして,作業終了時などには,例えばシステム起動中におけるバケット先端位置の軌跡データから生成される作業後の現況地形データが外部記録媒体42に記録され施工管理に使用される。
 図3は,GNSS基準局としての役割を持つ事務所側計測システム(基準局システム)50の構成図である。
 図3において,事務所側計測システム50は,GNSSアンテナ52と,GNSS受信機51と,無線機53と,無線アンテナ54を備えている。
 GNSSアンテナ52は,複数のGNSS衛星から送信される衛星信号(航法信号)を受信するためのアンテナである。
 GNSS受信機51は,GNSS基準局として機能し(以下では,GNSS受信機51をGNSS基準局51と表記することがある),予め計測された3次元位置(例えばGNSSアンテナ52の位置)のデータと,GNSSアンテナ52により受信される衛星信号とに基づいて,油圧ショベル1のGNSS受信機33でRTK(リアルタイムキネマティック)計測を行うための補正データを生成し,無線機53に出力する。
 無線機53は,GNSS受信機51から入力された補正データを無線アンテナ54を介して油圧ショベル1の無線機35に対して送信する。
 次に,本実施の形態に係わる位置計測システム200の動作の概要を説明する。
 本実施の形態では高精度での位置計測を行うため,図2に示したGNSS受信機33でRTK計測を行う。このためには先ず,図3に示した補正データを生成するGNSS基準局51が必要となる。GNSS基準局51は,上記のように予め3次元計測されたGNSSアンテナ52の位置データと,GNSSアンテナ52により受信される複数のGNSS衛星からの衛星信号とに基づいて,RTK計測のための補正データを生成し,生成した補正データを無線機53によりアンテナ54を介して一定周期で送信する。
 一方,図2に示した油圧ショベル1側のGNSS受信機33は,アンテナ34を介して無線機35により受信される補正データと,GNSSアンテナ31,32により受信される複数のGNSS衛星からの衛星信号に基づき,GNSSアンテナ31の3次元位置と,GNSSアンテナ31からGNSSアンテナ32へのベクトルとをRTK計測する。このRTK計測によって,地理座標系におけるGNSSアンテナ31の3次元位置及びGNSSアンテナ31からGNSSアンテナ32へのベクトルが高精度で計測される。そして,計測された3次元位置データ及びベクトルデータはコントローラ38に入力される。
 また,IMU21~24によって油圧ショベル1(上部旋回体3)の傾斜角度(すなわち,ピッチ角度及びロール角度)とブーム6,アーム7及びバケット8の各角度が計測され,同様にコントローラ38に入力される。
 コントローラ38は入力された各種データに基づき,一般的なベクトル演算と座標変換を行って,所定の座標系(例えば,作業現場の地面に設定された現場座標系)における上部旋回体3の位置及び姿勢(方位角を含む)と,バケット8の先端(モニタポイント)の位置とを演算する。また,コントローラ38は,演算した上部旋回体3の位置及び姿勢とバケット先端の位置と,外部記録媒体41から入力した目標地形データとに基づいて,表示装置39の画面上にバケットの画像と目標地形を表示してオペレータに作業状況を知らせることもできる。
 次に,本発明が課題とする,GNSS受信機33による位置計測の再現性の悪化について,図4~9を用いて説明する。
 図4は,油圧ショベル1の掘削動作時の姿勢を模式的に示したものである。図4において,油圧ショベル1はいわゆる法面切り上げ作業を行っている。図4に示すイメージは,表示装置39に表示される情報に概略等しく,オペレータはこの情報に基づいて,現地形61が目標地形62に近づくように,油圧ショベル1の掘削操作を行う。
 図5は,油圧ショベル1の旋回動作時の姿勢を模式的に示したものである。図5に示すように,通常,旋回動作は,掘削動作の終了後にブーム6を上げ,アーム7及びバケット8を巻き込み,バケット8と地面とのクリアランスを確保した状態で行う。そして,放土位置にてアーム7及びバケット8をダンプさせて,掘削土を所定位置に落とす。その後,掘削位置へ戻るための旋回動作を行い,掘削動作を繰り返す。
 図6は,油圧ショベル1の掘削位置および放土位置,ならびにその時のGNSSアンテナ31,32の上空視界内にあるGNSS衛星81~87の配置を模式的に示したものである。図6において,フロント作業機5が上側に向いた状態を掘削位置71,フロント作業機5が左側に向いた状態を放土位置72とし,掘削位置71から放土位置72への移動は左旋回で行い,放土位置72から掘削位置71への移動は右旋回で行うものとする。
 GNSSによる位置計測において,GNSS受信機33は,GNSSアンテナ31,32で受信されるGNSS衛星からの衛星信号の品質や,衛星信号を受信しているGNSS衛星の配置等,種々の条件判定を行って位置計算に使用するGNSS衛星(衛星信号)を選択している。
 ここで,GNSS衛星の配置はDOP(Dilution of Precision)という数値で評価されており,例えばGNSS衛星が上空視界の一方向に偏って分布している場合などはDOPが悪く(数値が大きい),結果として計算される位置精度が悪化する。これに対して,GNSS衛星が上空視界に偏りなく分布している場合はDOPが良く(数値が小さい),計算される位置精度が向上する。これは,GNSSによる位置計測が,三角測量を応用した計測システムであることに起因する。
 このため,捕捉可能なGNSS衛星81~87が図6に示すような配置にある場合,掘削位置71では位置計算に使用するGNSS衛星として,例えば図7に塗りつぶしで示す衛星81,83,84,86が選択される。
 しかし,油圧ショベル1の掘削動作が終了し,図5に示すような旋回姿勢を取って掘削位置71から放土位置72へと左旋回すると,GNSSアンテナ31,32とGNSS衛星81,86,87との間をフロント作業機5が通過することにより,GNSS衛星81,86,87の衛星信号が遮られることになる。
 この結果,放土位置72の位置計算時には,例えば図8に塗りつぶしで示すGNSS衛星82~85が選択されることになり,図7の掘削位置71で選択された組み合わせから変化する場合がある。
 さらに,油圧ショベル1は右旋回で掘削位置71へ戻り,掘削動作を繰り返すことになるが,放土位置72から掘削位置71へ右旋回する間はGNSS衛星82~85の衛星信号はフロント作業機5によって遮られないため,掘削位置71においても位置計算に使用するGNSS衛星の組み合わせが図9に示すようにGNSS衛星82~85に保持され,前回の掘削動作時に選択されていたGNSS衛星81,83,84,86の組み合わせから変化したままになってしまう場合がある。
 GNSSによる位置計測では,DOP以外にもGNSS衛星の時計誤差や軌道情報の誤差等,各GNSS衛星で微妙に異なる誤差要因があり,油圧ショベル1が同じ位置にあっても,位置計算に使用するGNSS衛星の組み合わせが異なると,位置計算結果にズレが生じ,位置計算の再現性が悪化するおそれがある。
 このように,GNSS受信機33による位置計算の再現性が悪化すると,表示装置39に表示されるバケット8と目標地形62との位置関係が掘削動作の前後で異なる可能性があり,ひいては出来形が不連続になってしまうといった問題が生じ得る。
 この問題を解決するための方法について,コントローラ38で実行される使用衛星の選択ロジックについて,図10のフローチャートを用いて説明する。図10はコントローラ38が実行する衛星選択ロジックの一例を示すフローチャートである。なお図10のフローチャートは,一定周期(例えば100ms)で繰返し演算される。
 ステップS10では,コントローラ38は,GNSS受信機33からの情報が,RTKでFix解が得られているかを判断する。この状態か否かは,GNSS受信機33からの例えばNMEAメッセージのGGAセンテンスを参照すれば判断できる。
 ステップS10で,Fix解が得られていないと判断された場合は,正しい位置測位ができていないと判断し,ステップS20に進み,コントローラ38は,表示装置39に正しい計測ができていない旨を表示し,初期状態に戻る(次に制御周期まで待機する)。一方,ステップS10でFix解が得られていると判断された場合は,ステップS30に進む。
 ステップS30では,コントローラ38は,GNSS受信機33から入力されるGNSSアンテナ31の3次元位置と,GNSSアンテナ31からGNSSアンテナ32へのベクトル情報と,IMU21~24から入力される角度情報とに基づき,一般的なベクトル演算と座標変換を行って,現場座標系における上部旋回体3の位置及び姿勢とバケット8先端の位置を演算し,バケット8の姿勢情報や,外部記録媒体42から取得した地形データに基づいて生成した現況地形や目標形状の情報を表示装置39に表示する。
 次にステップS40に進み,コントローラ38は,図11に示す判断方法で,油圧ショベル1が精度を要求する作業中か否かを判断する。ここで図11を用いて,コントローラ38がステップS40で油圧ショベル1が精度を要求する掘削作業をしているか否かを判定するロジック(判定ロジック)について説明する。図11はステップS40で行われる処理の具体例の1つを示すフローチャートである。
 まずステップS401で,コントローラ38は,フロント作業機5と目標面の距離(目標面距離)が所定値d1以下であるか否かを判定する。目標面距離としては,例えば,バケット先端(爪先)位置と目標面の距離を利用できる。この場合,ステップS30で演算されたバケット先端(モニタポイント)の位置から垂線を下ろし,その垂線が目標地形データで規定される目標地形表面と交差する点を演算し,その点とバケット先端までの距離を目標面距離とすることができる。目標面距離が所定値d1より大きい場合は,コントローラ38は,バケット先端が目標面から離れた位置にあるため,精度を要求する掘削作業をしていないと判断する。一方,目標面距離が所定値d1以下であると判定された場合は,ステップS402に進む。
 ステップS402では,コントローラ38は,キャブ4内に設置されたフロント作業機5(ブーム6,アーム7,バケット8)を操作する操作装置(図示せず)に対して掘削操作が入力されているか否かを判定する。掘削操作が入力されているか否かは,ここではアーム7(アームシリンダ10)が駆動しているかどうかで判断する。アーム7(アームシリンダ10)が駆動しているか否かは,例えば,操作装置から出力されるアーム7の操作パイロット圧を圧力センサで検出し,その検出圧力が所定値を超えるか否かを確認することで判断できる。
 このようにして,ステップS401とステップS402がともに肯定されると,コントローラ38は油圧ショベル1が精度を求める掘削作業中であるとみなす。このようにすることで,ステップS401でバケット先端と目標面が所定値d1以下であっても,ステップS402で掘削操作がされていないと判断された場合,例えば目標面通りに掘削された地形にバケット8の先端を接触させてアーム7を停止している状態などでは,掘削作業中ではないと判断されるので,後述するマスク範囲を必要以上に広げることを防止できる。また,ステップS401で目標面距離が所定値d1を超えていると判断された場合,例えば粗仕上げ作業を行っている場合等も,後述するマスク範囲を必要以上に広げることを防止できる。なお,掘削操作の判定をアームの操作パイロット圧でのみ判定することとしたが,ブーム6やバケット8の操作パイロット圧を含めて掘削操作を判定してもよい。また,瞬間的な値でなく,過去の操作パイロット圧の連続性など(すなわち,検出された操作パイロット圧の時系列)を考慮して判断してもよい。また,操作パイロット圧ではなく,例えばアームシリンダ10に加わる掘削反力等をアームシリンダ10内に設置された圧力センサで検出して掘削操作を判断してもよい。また,ここでは,目標面距離の大小(ステップS401)と掘削操作の有無(ステップS402)の双方に基づいて油圧ショベル1が精度を要求する作業中か否かを判定したが,これら2つの処理(ステップS401,S402)のいずれかに基づいて判定を行っても良い。すなわち,これら2つの処理の少なくとも一方に基づいて判定しても良い。
 図7に戻り,ステップS40で油圧ショベル1が精度を要求する作業中でないと判断された場合は,ステップS45に進む。ステップS45では,コントローラ38は,精度を要求する作業中でないと判定された状態が継続している時間(継続時間)Tの計測を開始し,ステップS70に進む。なお,ステップS45に到達した際に既に当該時間Tの計測が開始されている場合には,その計測を継続するものとする。
 一方,ステップS40で精度を要求する作業中であると判断された場合は,ステップS50に進む。
 ステップS50では,コントローラ38は,2個のGNSSアンテナ31,32のそれぞれが複数のGNSS衛星から衛星信号を受信する際にフロント作業機5が衛星信号の障害物となり得る範囲を地面に設定された座標系(例えば現場座標系)上にマスク範囲として設定する。後述のように,このマスク範囲に位置するGNSS衛星からの衛星信号はGNSS受信機33で測位に利用される衛星信号から除外され得る。すなわちステップS50では測位に使用しない方がよい衛星配置の範囲を演算する。
 本実施形態のコントローラ38は,ステップS50において,予めコントローラ38の記憶装置内に記憶されている上部旋回体3(油圧ショベル1)における2個のGNSSアンテナ31,32の設置位置(例えば上部旋回体3に設定された車体座標系における座標位置)と,フロント作業機5(ブーム6,アーム7,バケット8)の可動範囲と,車体IMU21で検出される上部旋回体3の傾斜角度と,GNSSアンテナ31からGNSSアンテナ32へのベクトル情報から演算される上部旋回体3の方位角とに基づいて,マスク範囲を設定する。マスク範囲は,2個のGNSSアンテナ31,32のそれぞれについて設定される。マスク範囲は,各GNSSアンテナ31,32を基準にした方位角範囲(左右方向における角度範囲)と仰角範囲(上下方向における角度範囲)の組合せで定義できる。
 また,ステップS50において,油圧ショベル1の周囲に存在して衛星信号の障害物となり得る障害物(例えば,現況地形,建物,構造物)の形状データ(形状データには位置も含まれる)が取得可能な場合には,コントローラ38は,上記のフロント作業機5に起因するマスク範囲の設定に加えて,その障害物によって衛星信号が遮蔽され得る範囲もマスク範囲として設定することができる。例えば,コントローラ38内の記憶装置に障害物の形状データとして外部記録媒体42からの現況地形データを予め記憶しておき,ステップS50で,コントローラ38が,地理座標系(グローバル座標系)における上部旋回体3の位置及び方位角及び傾斜角と,上部旋回体3(油圧ショベル1)における2個のGNSSアンテナ31,32の設置位置と,現況地形データとに基づいて,上部旋回体3の方位角を基準とした所定の方位角方向における現況地形の断面形状を演算し,2つのGNSSアンテナ31,32のそれぞれが複数のGNSS衛星から衛星信号を受信する際にその断面形状を有する現況地形が衛星信号の障害物となり得る範囲をさらに考慮してマスク範囲を設定しても良い。
 ここで,ステップS50のマスク範囲の演算プロセスの一例について図12-15を用いて説明する。ここでは,説明の便宜上,GNSSアンテナ31のマスク範囲の演算について記載するが,GNSSアンテナ32のマスク範囲についても同様の方法で演算できる。
 マスク範囲の仰角範囲を規定する仰角マスク角は,水平面から上空方向をプラス方向とし,天頂方向が仰角90度と定義する。このため,仰角マスク角は,下端が0度で,上端が最大で90度となる。また,マスク範囲の方位角範囲を規定する方位角マスク角については,北方向を0度として,時計回りに正の方向として,0度から360度までの範囲と定義する。
 コントローラ38内の記憶装置には,GNSSアンテナ31から見たフロント作業機5の遮蔽部分が,車体基準の方位角(車体基準方位角)ごとにフロント遮蔽仰角αftとして記憶されている。図12は車体基準方位角とフロント遮蔽仰角αftの関係の一例を示す図であり,車体基準方位角ごとにフロント遮蔽仰角αftが規定されている。各車体基準方位角においてフロント遮蔽仰角αft以下となる範囲が衛星信号の遮蔽される範囲(マスク範囲)となる。ここでの車体基準方位角とフロント遮蔽仰角αftは,上部旋回体3に設定された車体座標系で規定されている。図13に示すようにGNSSアンテナ31を基準として油圧ショベル1の前方方向を車体基準方位角0度とし,時計回りを正の方向とすると,車体基準方位角が0度から360度に達するまでの間に,5度間隔でフロント遮蔽仰角αftが規定されている。図12の例では,車体基準方位角が10度から25度までの範囲以外は,フロント作業機5が衛星信号の障害物にならないため,フロント遮蔽仰角は0度となっている。図13に車体基準方位角が10度から25度までの範囲をマスク範囲(方位角範囲)90として図示している。なお,フロント遮蔽仰角αftは,各フロント部材6,7,8の最大可動範囲から規定しても良いし,作業中に利用すると予測される予測可動範囲で規定してもよい。
 ここでは説明のために,車体基準方位角が15度の場合における車体による影響の仰角マスク角の演算について図14を用いて説明する。
 図14は,車体基準方位角が15度の場合における現況地形断面を横から見た図である。この図に示すように,現場座標系における車体(フロント作業機5)による仰角マスク角αsは,車体座標系におけるフロント遮蔽仰角αftと,車体IMU21より求まる車体の傾斜角αbdとによって,下記式(1)によって求まる。
 αs=αft - αbd …式(1)
 次に,現場座標系での現況地形による仰角マスク角度αgを演算する。図14に示す現況地形は,車体基準方位角15度方向の現況地形の断面を示している。GNSS受信機33によって計測されるGNSSアンテナ31の位置から現況地形の断面に接する直線を全て引き,その全ての直線がそれぞれ水平面と成す角度のうちの最大値を現況地形による仰角マスク角αgとする。
 なお,図15に示すように,現況地形データは北方位を0度(基準)とした現場座標系で表されるので,GNSS受信機33で演算される上部旋回体3の方位角αtに車体基準方位角αbを加えた角度方向(すなわち,αt+αb)で現況地形データの断面をとることで図14に示した現況地形の断面を取得できる。
 以上で求めた,車体による仰角マスク角αsと現況地形による仰角マスク角αgのうち大きい方が,その方位角の仰角マスク角となる。図14の例では,αs>αgなので,車体による仰角マスク角αsが仰角マスク角となり,車体基準方位角が15度の場合の仰角範囲におけるマスク範囲90は図示の通りとなる。全ての方位において同様の演算をすることにより,全ての方位における仰角マスク角が演算される。そして,その結果に基づいて現場座標系にマスク範囲が設定される。なお,マスク範囲は,地面に設定された座標系に設定すれば良く,例えば地理座標系に設定しても良い。
 図10に戻り,ステップS60で,コントローラ38は,現在の演算周期より前に設定されたマスク範囲(過去に設定されたマスク範囲(ただし,後述のステップS90,110でリセットされたマスク範囲は除く))にステップS50で演算されたマスク範囲(新たに設定されたマスク範囲)を加える(加算する)。このステップS60により,例えば1周期前の処理から上部旋回体3の傾斜角が変化したり,上部旋回体3の旋回動作により方位角が変化したりした場合には,それらの変化に応じて新たなマスク範囲が設定される。そして,その新たなマスク範囲が過去のマスク範囲に加えられることで,上部旋回体3の傾斜角及び方位角の変化に応じてマスク範囲が拡がることになる。
 ステップS70で,コントローラ38は,記憶装置に記憶されているマスク範囲をGNSS受信機33に送信する。ステップS60を経由してステップS70に到達した場合には,ステップS60のマスク範囲がGNSS受信機33に送信され,ステップS45を経由してステップS70に到達した場合には,最後にステップS60で設定されたマスク範囲(ただし,ステップS90,S110でマスク範囲がリセットされた後にステップ60を一度も経由していない場合にはマスク範囲は送信されない)が送信される。
 ステップS80では,コントローラ38は,GNSS受信機33からマスク範囲を設定した状態では測位ができないという情報を受信しているか否かを判断する。この判断に際しては以下に説明する処理がGNSS受信機33で行われる。すなわち,GNSS受信機33は,ステップS70でコントローラ38から送信されたマスク範囲を受信し,衛星信号を受信可能な複数のGNSS衛星からマスク範囲に位置する衛星を除き,その残りの衛星から送信される衛星信号に基づいて測位演算ができるかを判断する。ここで測位演算できると判断した場合には,GNSS受信機33は,コントローラ38に対してマスク範囲を設定した状態で測位が可能であることを示す情報を送信するとともに,GNSSアンテナ31の位置と,GNSSアンテナ31からGNSSアンテナ32へのベクトルとを演算し,その演算結果をコントローラ38に出力する。一方,マスク範囲を設定することにより,使用する衛星数が不十分(例えば5つ未満)で測位演算ができなかったり,使用する衛星配置に偏りがあるため(例えばDOPが所定値以上のとき)精度低下の可能性があったりする場合には,後述するステップS90でマスク範囲を解除した状態で測位演算するために,コントローラ38に対してマスク範囲を設定した状態では測位ができないということを示す情報を送信する。
 なお,ここでは,コントローラ38でマスクする方位角範囲と仰角範囲を演算し,GNSS受信機33にその範囲(マスク範囲)を送信する場合について説明したが,コントローラ38で,GNSS受信機33から,衛星信号を受信可能な衛星番号とその衛星がある方位角と仰角の情報を取得し,コントローラ38で演算されたマスク範囲内にある衛星番号を演算し,測位演算に使用しない衛星番号をGNSS受信機33に送信して上記の判断を実施してもよい。
 ステップS80で,GNSS受信機33からマスク範囲を設定した状態では測位ができないという情報を受信した場合には,コントローラ38は,ステップS90に進み,表示装置39の画面上に測位精度が低下している可能性があることを表示するとともに,コントローラ38に記憶されているマスク範囲の情報をリセットする。これにより全てのマスク範囲が消去される。なお,マスク範囲のリセットと同時に,ステップS45で計測された継続時間Tもリセットするものとする。一方,ステップS80で,GNSS受信機33からマスク範囲を設定した状態でも測位が可能であるという情報を受信した場合(すなわち,マスク範囲を設定した状態では測位不可能であるという情報を受信していない場合)には,ステップS100に進む。
 ステップS100では,コントローラ38は,マスク範囲をリセット(消去)する必要があるか否かを判断する。この判断では,ステップS45で計測された時間Tが所定時間t1以上(例えば10分以上)継続した場合と,キャブ4内の操作装置による下部走行体2に対する走行操作により油圧ショベル1が所定距離以上(例えば3m以上)移動した場合と,マスク範囲をリセットする旨のオペレータの要求が設定用スイッチ(マスク範囲リセットスイッチ)40を介して入力された場合と,システム起動直後の最初の演算周期の場合とのいずれかの場合に,マスク範囲をリセットする必要があるとコントローラ38は判断する。走行操作による油圧ショベル1の移動に関しては,例えば,走行用のパイロット圧検出と,GNSS受信機33の測位演算を基に行われるショベル1の位置移動から検出することができる。
 ステップS100でマスク範囲のリセットが必要と判断された場合は,コントローラ38は,ステップS110に進み,マスク範囲のリセットを行い,同時に,ステップS45で計測された時間Tもゼロにリセットする。
 以上のようにすることで,油圧ショベル1により精度を要求する作業が行われている場合には,フロント作業機5を含む障害物の影響を受ける可能性がある衛星信号を測位演算に使用しなくなるため,測位演算に使用する衛星の組合せが掘削途中で切り替わって測位演算の精度が低下することや,電波の回折の影響を受けた衛星信号を使って測位演算の精度が低下することを防止できる。
 -効果-
 以上のように構成された油圧ショベル1では,作業中の上部旋回体1の方位角と傾斜角に応じたマスク範囲が現場座標系に設定され,そのマスク範囲に位置するGNSS衛星の衛星信号を利用することなくGNSS受信機33で測位演算が行われることになる。これにより,フロント作業機5の動作(主にブーム上げ動作)に伴う衛星の切り替わりや衛星信号の回折によりGNSSの測位精度が作業中に低下することが防止される。その結果,モニタポイントの位置演算結果が変動することが防止されるので,油圧ショベル1の制御精度を向上できる。 
 特に,上記の油圧ショベル1では,精度を要求する作業が行われている間にマスク範囲を設定する仕様となっており,精度を要求しない作業が所定時間t1以上継続している状態やマスク範囲の設定により測位精度が低下してしまう状態等ではマスク範囲の設定は解除される。すなわち,精度が必要な場面だけでマスク範囲を設定して測位精度を確保する一方で,精度が不要な場面や精度が出ない場面では精度よりも測位の即時性を優先することで,場面に即した測位を行うことができるように構成されている。
 また,上記の油圧ショベル1では,上部旋回体3の方位角や傾斜角が変わった場合には,それに応じて新たにマスク範囲が設定されるとともに,その新たなマスク範囲が過去に設定されたマスク範囲に加えられてマスク範囲が拡大する。すなわち,例えば,上部旋回体3が掘削位置から放土位置まで旋回した場合には,その旋回中の上部旋回体3の方位角の変化に応じてマスク範囲が設定され,過去のマスク範囲に合算される。これにより,掘削位置と放土位置で異なる衛星が選択されることが回避できるので,衛星の切り替わりにより測位精度が低下することを防止できる。
 また,障害物の形状データをコントローラ38に予め記憶しておけば,フロント作業機5だけでなく当該障害物(例えば現況地形)が測位に与える影響も考慮してマスク範囲を設定でき,それにより当該障害物によって遮蔽される衛星の信号を利用することなく測位演算できるので,測位精度をさらに向上できる。
 以上,本発明の実施の形態について詳述したが,本発明は,上記した実施の形態に限定されるものではなく,様々な変形例が含まれる。例えば,上記した実施の形態は,本発明を分かり易く説明するために詳細に説明したものであり,必ずしも説明した全ての構成を備えるものに限定されるものではない。
 例えば,上記の図10のフローチャートでは精度を要求する作業が行われているか否かでマスク範囲の設定の有無を切り替えたが,全ての場合にマスク範囲を設定しても良い。
 また,上記のコントローラ(制御装置)38に係る各構成や当該各構成の機能及び実行処理等は,それらの一部又は全部をハードウェア(例えば各機能を実行するロジックを集積回路で設計する等)で実現しても良い。また,上記のコントローラ38に係る構成は,演算処理装置(例えばCPU)によって読み出し・実行されることで当該制御装置の構成に係る各機能が実現されるプログラム(ソフトウェア)としてもよい。当該プログラムに係る情報は,例えば,半導体メモリ(フラッシュメモリ,SSD等),磁気記憶装置(ハードディスクドライブ等)及び記録媒体(磁気ディスク,光ディスク等)等に記憶することができる。
 また,上記の各実施の形態の説明では,制御線や情報線は,当該実施の形態の説明に必要であると解されるものを示したが,必ずしも製品に係る全ての制御線や情報線を示しているとは限らない。実際には殆ど全ての構成が相互に接続されていると考えて良い。
 1…油圧ショベル(作業機械),2…下部走行体,3…上部旋回体,4…キャブ,5…フロント作業機(作業装置),6…ブーム,7…アーム,8…バケット,9…ブームシリンダ,10…アームシリンダ,11…バケットシリンダ,21…車体IMU,22…ブームIMU,23…アームIMU,24…バケットIMU,31,32…GNSSアンテナ,33…GNSS受信機,34…RTK補正データ受信アンテナ,39…表示装置,40…設定用スイッチ(マスク範囲リセットスイッチ),42…外部記録媒体,50…事務所側計測システム,51…GNSS基準局(GNSS受信機),52…GNSS基準局アンテナ,53…無線機,54…RTK補正データ送信アンテナ,61…現地形,62…目標地形,71…掘削位置,72…放土位置,81~87…GNSS衛星,200…位置計測システム

Claims (6)

  1.  走行体と、前記走行体の上に旋回可能に取り付けられた上部旋回体と、前記上部旋回体に取り付けられた作業装置と、前記上部旋回体に設置された2つのGNSSアンテナと、複数の衛星から送信され前記2つのGNSSアンテナで受信された衛星信号に基づいて前記上部旋回体の位置と方位角を演算する受信機と、前記受信機で演算された前記上部旋回体の位置及び方位角とに基づいてモニタポイントの位置を演算するコントローラとを備えた作業機械において、
     前記コントローラは、前記作業機械における前記2つのGNSSアンテナの設置位置と、前記作業装置の可動範囲と、前記上部旋回体の傾斜角度と、前記上部旋回体の方位角とに基づいて、前記2つのGNSSアンテナのそれぞれが前記複数の衛星から衛星信号を受信する際に前記作業装置が衛星信号の障害物となり得る範囲を地面に設定された座標系上にマスク範囲として設定し、
     前記受信機は、前記複数の衛星から前記コントローラで設定された前記マスク範囲に位置する衛星を除いた残りの衛星から送信される衛星信号に基づいて前記上部旋回体の位置と方位角を演算することを特徴とする作業機械。
  2.  請求項1の作業機械において、
     前記コントローラは、前記作業機械が精度を要求する作業中か否かを判定し、前記作業機械が精度を要求する作業中であると判定したとき前記マスク範囲を設定することを特徴とする作業機械。
  3.  請求項2の作業機械において、
     前記コントローラは、前記作業機械が精度を要求する作業中でないと判定された状態が所定時間以上継続したとき、前記作業機械が所定距離以上移動したとき、前記残りの衛星から送信された衛星信号では前記上部旋回体の位置を演算できないとき、のいずれかに該当する場合、前記マスク範囲の設定を解除することを特徴とする作業機械。
  4.  請求項1の作業機械において、
     前記コントローラは、前記作業装置と目標面の距離と、前記作業装置を操作する操作装置への入力操作との少なくとも一方に基づいて前記作業機械が精度を要求する作業中か否かを判定し、前記作業機械が精度を要求する作業中であると判定したとき前記マスク範囲を設定することを特徴とする作業機械。
  5.  請求項1の作業機械において、
     前記コントローラは、前記上部旋回体の傾斜角及び方位角の変化に応じて前記マスク範囲を新たに設定し、その新たな前記マスク範囲を過去に設定した前記マスク範囲に加えることを特徴とする作業機械。
  6.  請求項1の作業機械において、
     前記コントローラは、
      前記作業機械の周囲の障害物の形状データが記憶された記憶装置を備え、
      前記上部旋回体の位置及び方位角と前記障害物の形状データに基づいて、前記上部旋回体の方位角を基準とした所定の方位角方向で前記障害物を切断したときの断面形状を演算し、前記2つのGNSSアンテナのそれぞれが前記複数の衛星から衛星信号を受信する際に前記断面形状を有する障害物が与える影響をさらに考慮して前記マスク範囲を設定することを特徴とする作業機械。
PCT/JP2020/004152 2019-03-01 2020-02-04 作業機械 WO2020179320A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
CN202080004684.6A CN112639225B (zh) 2019-03-01 2020-02-04 作业机械
US17/274,448 US12000114B2 (en) 2019-03-01 2020-02-04 Work machine
KR1020217005192A KR102500969B1 (ko) 2019-03-01 2020-02-04 작업 기계
EP20766596.9A EP3933122A4 (en) 2019-03-01 2020-02-04 WORK MACHINE

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2019038047A JP6961636B2 (ja) 2019-03-01 2019-03-01 作業機械
JP2019-038047 2019-03-01

Publications (1)

Publication Number Publication Date
WO2020179320A1 true WO2020179320A1 (ja) 2020-09-10

Family

ID=72280228

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2020/004152 WO2020179320A1 (ja) 2019-03-01 2020-02-04 作業機械

Country Status (6)

Country Link
US (1) US12000114B2 (ja)
EP (1) EP3933122A4 (ja)
JP (1) JP6961636B2 (ja)
KR (1) KR102500969B1 (ja)
CN (1) CN112639225B (ja)
WO (1) WO2020179320A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7039746B1 (ja) 2021-03-30 2022-03-22 日立建機株式会社 作業機械

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7088691B2 (ja) * 2018-02-28 2022-06-21 株式会社小松製作所 積込機械の制御装置、制御方法および遠隔操作システム
JP7419119B2 (ja) 2020-03-16 2024-01-22 日立建機株式会社 作業機械
EP4145180A4 (en) * 2020-04-28 2024-03-06 Nippon Telegraph And Telephone Corporation MEASURING DEVICE, MEASURING METHOD AND PROGRAM
JP2023010051A (ja) * 2021-07-08 2023-01-20 株式会社小松製作所 作業機械の制御システム、作業機械、及び作業機械の制御方法

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0462490A (ja) * 1990-06-29 1992-02-27 Nippondenso Co Ltd 車両用gps受信装置
JPH07325141A (ja) * 1994-04-29 1995-12-12 Robert Bosch Gmbh 航行衛星信号の選択方法及び受信装置
JP2003004838A (ja) * 2001-06-27 2003-01-08 Nec Eng Ltd Gps受信機
JP2010534849A (ja) 2007-07-31 2010-11-11 テレ アトラス ベスローテン フエンノートシャップ 位置を判定する方法及び装置
US20100283674A1 (en) * 2009-05-05 2010-11-11 Kirk Geoffrey R Tilt compensation for gnss antenna
JP2016079677A (ja) * 2014-10-16 2016-05-16 日立建機株式会社 領域制限掘削制御装置及び建設機械
US20160258759A1 (en) * 2015-03-04 2016-09-08 Agco Corporation Path planning based on obstruction mapping
JP2016188792A (ja) * 2015-03-30 2016-11-04 独立行政法人交通安全環境研究所 位置測定方法及び位置測定システム

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE4011316A1 (de) * 1990-04-07 1991-10-17 Rheinische Braunkohlenw Ag Verfahren zur bestimmung der geodaetischen standortes von teilen eines ortsbeweglichen grossgeraetes
JP3816806B2 (ja) * 2002-01-21 2006-08-30 株式会社トプコン 建設機械制御システム
EP1804071B1 (fr) 2005-12-29 2008-10-15 Alcatel Lucent Procédé d'optimisation des traitements de données de localisation en présence de plusieurs constellations de positionnement par satellites
JP5059953B2 (ja) * 2011-02-22 2012-10-31 株式会社小松製作所 油圧ショベルの作業可能範囲表示装置とその制御方法
CN103454650B (zh) * 2013-08-20 2015-06-24 北京航空航天大学 一种视觉辅助卫星完好性监测方法
JP5823046B1 (ja) 2014-05-14 2015-11-25 株式会社小松製作所 油圧ショベルの較正システム及び較正方法
EP3059611A1 (en) * 2015-02-12 2016-08-24 Agco Corporation Gnss-based obstruction mapping
WO2015167022A1 (ja) * 2015-05-29 2015-11-05 株式会社小松製作所 作業機械の制御システム及び作業機械
DE102015016045B8 (de) * 2015-12-11 2017-09-14 Audi Ag Satellitengestützte Ermittlung eines Kraftfahrzeugs in einem überdachten Bereich

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0462490A (ja) * 1990-06-29 1992-02-27 Nippondenso Co Ltd 車両用gps受信装置
JPH07325141A (ja) * 1994-04-29 1995-12-12 Robert Bosch Gmbh 航行衛星信号の選択方法及び受信装置
JP2003004838A (ja) * 2001-06-27 2003-01-08 Nec Eng Ltd Gps受信機
JP2010534849A (ja) 2007-07-31 2010-11-11 テレ アトラス ベスローテン フエンノートシャップ 位置を判定する方法及び装置
US20100283674A1 (en) * 2009-05-05 2010-11-11 Kirk Geoffrey R Tilt compensation for gnss antenna
JP2016079677A (ja) * 2014-10-16 2016-05-16 日立建機株式会社 領域制限掘削制御装置及び建設機械
US20160258759A1 (en) * 2015-03-04 2016-09-08 Agco Corporation Path planning based on obstruction mapping
JP2016188792A (ja) * 2015-03-30 2016-11-04 独立行政法人交通安全環境研究所 位置測定方法及び位置測定システム

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP3933122A4

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7039746B1 (ja) 2021-03-30 2022-03-22 日立建機株式会社 作業機械
JP2022155192A (ja) * 2021-03-30 2022-10-13 日立建機株式会社 作業機械

Also Published As

Publication number Publication date
KR102500969B1 (ko) 2023-02-17
EP3933122A4 (en) 2022-12-07
CN112639225B (zh) 2022-09-13
US12000114B2 (en) 2024-06-04
JP2020139933A (ja) 2020-09-03
JP6961636B2 (ja) 2021-11-05
CN112639225A (zh) 2021-04-09
US20220025615A1 (en) 2022-01-27
EP3933122A1 (en) 2022-01-05
KR20210034065A (ko) 2021-03-29

Similar Documents

Publication Publication Date Title
WO2020179320A1 (ja) 作業機械
US6782644B2 (en) Remote control system and remote setting system for construction machinery
JP7245119B2 (ja) 建設機械
JP7085071B2 (ja) 作業機械
US20080097693A1 (en) Gimbaled satellite positioning system antenna
JP4012448B2 (ja) 建設機械の掘削作業教示装置
JP3987777B2 (ja) 建設機械の掘削作業教示装置
WO2020196674A1 (ja) 作業機械
JP2002310652A (ja) 走行式建設機械の位置計測システム
JP6910995B2 (ja) 作業機械
JP4202209B2 (ja) 作業機械の位置計測表示システム
JP7007313B2 (ja) 作業機械
JP2006214236A (ja) 建設機械の計測表示機構
JP2021148467A (ja) 作業機械
JP2002340556A (ja) 走行式建設機械の位置計測システム、位置計測コンピュータ及び位置計測プログラム
JP7039746B1 (ja) 作業機械
KR102679015B1 (ko) 작업 기계의 측위 시스템, 작업 기계 및 작업 기계의 측위 방법
JP2024052345A (ja) 作業機械
JP2024041326A (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: 20766596

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 20217005192

Country of ref document: KR

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

WWE Wipo information: entry into national phase

Ref document number: 2020766596

Country of ref document: EP