WO2016148310A1 - 作業機械の制御システム、作業機械及び作業機械の制御方法 - Google Patents
作業機械の制御システム、作業機械及び作業機械の制御方法 Download PDFInfo
- Publication number
- WO2016148310A1 WO2016148310A1 PCT/JP2016/060847 JP2016060847W WO2016148310A1 WO 2016148310 A1 WO2016148310 A1 WO 2016148310A1 JP 2016060847 W JP2016060847 W JP 2016060847W WO 2016148310 A1 WO2016148310 A1 WO 2016148310A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- time
- dump truck
- information
- work machine
- vehicle body
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 22
- 238000004891 communication Methods 0.000 claims abstract description 48
- 238000001514 detection method Methods 0.000 claims abstract description 47
- 238000012937 correction Methods 0.000 claims description 23
- 238000004364 calculation method Methods 0.000 claims description 21
- 238000005065 mining Methods 0.000 description 32
- 238000012795 verification Methods 0.000 description 29
- 238000012545 processing Methods 0.000 description 28
- 238000010586 diagram Methods 0.000 description 20
- 238000012986 modification Methods 0.000 description 14
- 230000004048 modification Effects 0.000 description 14
- 230000032258 transport Effects 0.000 description 10
- 230000008859 change Effects 0.000 description 6
- 238000004590 computer program Methods 0.000 description 5
- 230000006870 function Effects 0.000 description 5
- 239000002245 particle Substances 0.000 description 5
- 230000005540 biological transmission Effects 0.000 description 4
- 238000007599 discharging Methods 0.000 description 4
- 238000005259 measurement Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 238000002485 combustion reaction Methods 0.000 description 3
- 230000007423 decrease Effects 0.000 description 3
- 239000002689 soil Substances 0.000 description 3
- 230000003111 delayed effect Effects 0.000 description 2
- 238000011156 evaluation Methods 0.000 description 2
- 230000005856 abnormality Effects 0.000 description 1
- 238000003745 diagnosis Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000005433 ionosphere Substances 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 239000013049 sediment Substances 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000012876 topography Methods 0.000 description 1
- 239000005436 troposphere Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2025—Particular purposes of control systems not otherwise provided for
- E02F9/2045—Guiding machines along a predetermined path
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2025—Particular purposes of control systems not otherwise provided for
- E02F9/205—Remotely operated machines, e.g. unmanned vehicles
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2025—Particular purposes of control systems not otherwise provided for
- E02F9/2054—Fleet management
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
- E02F9/261—Surveying the work-site to be treated
- E02F9/262—Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/027—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means comprising intertial navigation means, e.g. azimuth detector
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/30—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom
- E02F3/32—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom working downwardly and towards the machine, e.g. with backhoes
Definitions
- the present invention relates to a work machine control system, work machine, and work machine control method that are controlled using position information.
- Patent Document 1 describes a system for correcting a position measurement result in consideration of radio wave delay in a position measurement system using GPS (Global Positioning System).
- the control device that controls the work machine obtains the position of the work machine by communication from another position measurement device provided in the work machine, a delay caused by communication between the devices, a delay caused by instantaneous interruption of communication between the devices, and a device There may be a delay in the time at which the position of the work machine is obtained due to a delay caused by a difference in control cycle between them, a delay caused by processing in the position measuring device, and the like. If the timing at which the control device obtains the position of the work machine is delayed, a difference occurs between the reference time when the position measurement device obtains the position of the work machine and the time when the control device controls the work machine. There is a possibility of delay.
- the present invention is based on at least one of a delay caused by communication between devices, a delay caused by instantaneous interruption of communication between devices, a delay caused by a difference in control cycle between devices, and a delay caused by processing in the position measuring device, etc.
- An object is to suppress the influence of the delay when the control device controls the work machine when a delay occurs in the timing at which the control device obtains the position of the work machine.
- the present invention provides a non-contact sensor for detecting the periphery of a work machine, a position output device for obtaining a position of the work machine based on at least a detection result of the non-contact sensor, and outputting the position information, and the position output
- the position obtained by the device is corrected based on at least a delay time including a communication delay with the position output device, and the work is performed using the correction position corrected by the correction position calculation unit.
- a control device that generates a command for controlling the machine.
- control device corrects the position using dead reckoning navigation.
- the delay time is a first time that is the time when the correction position calculation unit corrects the position, and a time that is earlier than the first time, and the time when the non-contact sensor detects the time or the position It is preferable that the difference between the output device and the second time, which is the time when the detection result of the non-contact sensor is received.
- the position output device receives information for obtaining a position from the control device and obtains the position of the work machine, and the information for obtaining the position is output by the control device to the position output device.
- the time at which the position output device determines the position obtained by the correction position calculation unit is the second time, and the delay time is the second time and the first time. A difference is preferred.
- the control device obtains, using the dead reckoning navigation, a position where the work machine has moved during the delay time from the position corresponding to the first time received from the position output device, and the obtained position. Is preferably the corrected position.
- the present invention is a work machine including the work machine control system and a traveling device controlled by the control device of the work machine control system.
- the present invention detects the surroundings of the work machine with a non-contact sensor, obtains the position of the work machine based on the detected result, outputs the position information, and based on the output position information, A method for controlling a work machine, wherein the position is corrected by dead reckoning using a delay time including a delay in receiving information, and a command for controlling the work machine is generated using the corrected position.
- the present invention can suppress the influence due to the delay when the control device controls the work machine.
- FIG. 1 is a figure showing an example of the field where the work machine concerning an embodiment is used.
- FIG. 2 is a schematic diagram illustrating a dump truck that travels on a conveyance path.
- FIG. 3 is a diagram illustrating a dump truck including the work machine control system according to the embodiment.
- FIG. 4 is a diagram illustrating the vehicle body controller according to the embodiment.
- FIG. 5 is a diagram illustrating a part of map data stored in the map storage database of the control system according to the embodiment.
- FIG. 6 is an enlarged view showing the XIV portion in FIG.
- FIG. 7 is a schematic diagram illustrating an example of a partial region of map information according to the embodiment.
- FIG. 1 is a figure showing an example of the field where the work machine concerning an embodiment is used.
- FIG. 2 is a schematic diagram illustrating a dump truck that travels on a conveyance path.
- FIG. 3 is a diagram illustrating a dump truck including the work machine control system according to the embodiment.
- FIG. 8 is a schematic diagram illustrating an example of a bank detection result by a laser sensor when the dump truck travels on the conveyance path.
- 9 is a schematic diagram showing a state in which the detection result of the laser sensor shown in FIG. 8 is collated with the map information shown in FIG. 7, and the position of the host vehicle is calculated by collation navigation.
- FIG. 10 is a diagram illustrating that the dump truck moves during a communication delay.
- FIG. 11 is a flowchart illustrating a processing example when the control system according to the embodiment executes the work machine control method according to the embodiment.
- FIG. 12 is a diagram for explaining the exchange of information between the vehicle body controller and the reference navigation position output controller.
- FIG. 13 is a diagram illustrating a part of a control system according to a modification of the embodiment.
- FIG. 1 is a diagram illustrating an example of a site where the work vehicle according to the embodiment is used.
- the work vehicle is a mining machine used in the mine MR.
- the mining machine is managed by the management system 1.
- the management of the mining machine includes at least one of operation management of the mining machine, evaluation of the productivity of the mining machine, evaluation of operation technique of the operator who operates the mining machine, maintenance of the mining machine, and abnormality diagnosis of the mining machine.
- Mining machinery is a general term for machinery used for various operations in the mining MR.
- the mining machine includes at least one of a boring machine, an excavating machine, a loading machine, a transporting machine, a crusher, and a vehicle operated by an operator.
- the excavating machine is a machine for excavating the mine MR.
- the loading machine is a machine that loads a load onto a transporting machine.
- the loading machine includes at least one of a hydraulic excavator, an electric excavator, and a wheel loader.
- the transporting machine is a machine that moves in the mine MR and transports the load.
- the transport machine includes a dump truck.
- the load includes at least one of sediment and ore generated by mining the mine MR.
- the mine MR includes at least a part of the loading site LPA, the dumping site DPA, the transport path HL leading to at least one of the loading site LPA and the dumping site DPA, and the intersection IS where the transport paths HL intersect each other.
- a crusher CR that crushes the earth discharged may be arranged.
- the mine MR has a bank BK on which soil is piled beside the conveyance path HL.
- the bank BK may be further provided on at least one of the outside of the loading site LPA and the outside of the soil discharging site DPA.
- the dump truck 2 moves in the mine MR and carries the load.
- the dump truck 2 travels between the loading site LPA and the earth discharging site DPA by traveling at least a part of the transport path HL of the mine MR and the intersection IS.
- the dump truck 2 is loaded with a load at the loading site LPA.
- the loading site LPA is an area (place) where loading work is performed in the mine MR.
- a loading machine that is a mining machine other than the dump truck 2 loads the dump truck 2 with a load.
- the dump truck 2 unloads (discharges) the load at the dump site DPA.
- the earth removal site DPA is an area (place) where cargo discharge work is performed in the mine MR.
- the dump truck 2 inputs the discharged soil as a load into the crusher CR in the earth discharge site DPA provided with the crusher CR.
- the dump truck 2 is a so-called unmanned dump truck that autonomously travels on the travel route RP according to a command from the management device 10.
- the dump truck 2 traveling autonomously means that the dump truck 2 travels according to a command from the management device 10 without traveling by an operator's operation.
- the dump truck 2 can also travel by an operator's operation.
- the management system 1 includes a management device 10 that manages mining machines operating in the mine MR, and a communication system 9 that transmits information.
- the management apparatus 10 is installed in the control facility 7 of the mine MR.
- the communication system 9 transmits information by wireless communication between the management device 10, the dump truck 2, and other mining machines 3 (such as the hydraulic excavator 3S and the vehicle 3C).
- the management device 10, the dump truck 2, and the other mining machines 3 can wirelessly communicate with each other via the communication system 9.
- the communication system 9 includes a plurality of repeaters 6 that relay signals (radio waves) among the management device 10, the dump truck 2, and other mining machines 3.
- GNSS Global Navigation Satellite System
- An example of a global navigation satellite system includes, but is not limited to, GPS.
- the GNSS has a plurality of positioning satellites 5.
- GNSS detects a position in a coordinate system that defines latitude, longitude, and altitude.
- the GNSS coordinate system may be referred to as a global coordinate system in the embodiment.
- the position detected by the GNSS includes latitude, longitude, and altitude coordinate data.
- the GNSS detects the position of the dump truck 2 and other mining machines 3 in the mine MR.
- the position detected by GNSS is an absolute position defined in the global coordinate system.
- the position detected by the GNSS is appropriately referred to as a GPS position.
- the GPS position is an absolute position and is coordinate data (coordinate values) of latitude, longitude, and altitude.
- the positioning state changes due to the positioning of the positioning satellite 5, the ionosphere, the troposphere, or the influence of the topography around the antenna that receives information from the positioning satellite 5.
- the positioning state includes, for example, a Fix solution (accuracy ⁇ 1 cm to 2 cm), a Float solution (accuracy ⁇ 10 cm to several meters), a Single solution (accuracy ⁇ approximately several meters), and non-positioning (positioning calculation impossible). There is.
- the management device 10 disposed in the control facility 7 includes a computer 11, a display device 16, an input device 17, and a wireless communication device 18.
- the computer 11 includes a processing device 12, a storage device 13, and an input / output unit 15.
- the display device 16, the input device 17, and the wireless communication device 18 are connected to the computer 11 via the input / output unit 15.
- the input / output unit 15 is used for input / output of information between the processing device 12 and at least one of the display device 16, the input device 17, and the wireless communication device 18.
- FIG. 2 is a schematic diagram showing the dump truck 2 traveling on the transport path HL.
- the processing device 12 executes various processes related to the management of the dump truck 2 and various processes related to the management of other mining machines 3.
- the processing device 12 When the dump truck 2 travels autonomously in the mine MR, the processing device 12 generates a travel route RP along which the dump truck 2 travels.
- the travel route RP is an aggregate of a plurality of points PI. That is, the trajectory passing through the plurality of points PI is the travel route RP.
- the point PI is defined by an absolute position (latitude, longitude, and altitude coordinate data).
- the point PI constituting the travel route RP includes at least absolute position information and speed information that is the target speed of the dump truck that travels at that point.
- the dump truck 2 that has received the travel route information from the processing device 12 travels according to a travel route RP including at least a part of the loading site LPA, the earth removal site DPA, the transport route HL, and the intersection IS.
- the storage device 13 is connected to the processing device 12 and stores various information related to the management of the dump truck 2 and other mining machines 3.
- the storage device 13 stores a computer program for causing the processing device 12 to execute various processes.
- the processing device 12 uses the computer program stored in the storage device 13 to process information about the position and generate a travel route RP.
- the display device 16 can display a map including the transport path HL in the mine MR, information on the position of the dump truck 2, and information on the position of other mining machines 3.
- the input device 17 includes at least one of a keyboard, a touch panel, and a mouse, and functions as an operation unit that can input an operation signal to the processing device 12.
- An administrator of the control facility 7 operates the input device 17 to input a command to the processing device 12.
- the wireless communication device 18 has an antenna 18A, is disposed in the control facility 7, and is connected to the processing device 12 via the input / output unit 15.
- the wireless communication device 18 is a part of the communication system 9.
- the wireless communication device 18 can receive information transmitted from at least one of the dump truck 2 and the other mining machine 3. Information received by the wireless communication device 18 is output to the processing device 12. Information received by the wireless communication device 18 is stored (registered) in the storage device 13.
- the wireless communication device 18 can transmit information to at least one of the dump truck 2 and another mining machine 3. Next, the dump truck 2 will be described in detail.
- Drawing 3 is a figure showing dump truck 2 provided with control system 30 of a work vehicle concerning an embodiment.
- the dump truck 2 includes the work vehicle control system 30
- the work vehicle control system 30 may be included in another mining machine 3 that is a work vehicle other than the dump truck 2.
- the work vehicle control system 30 is appropriately referred to as a control system 30.
- the dump truck 2 includes a vehicle main body 21, a vessel 22, a traveling device 23, and an obstacle sensor 24.
- a vessel 22 and a travel device 23 are attached to the vehicle body 21.
- a driving device 2D for driving the traveling device 23 is attached to the vehicle main body 21.
- the driving device 2D includes an internal combustion engine 2E such as a diesel engine, a generator 2G that is driven by the internal combustion engine 2E to generate electric power, and an electric motor 23M that is driven by electric power generated by the generator 2G.
- the traveling device 23 includes a front wheel 23F, a rear wheel 23R, a braking device 23B, and a steering device 2S.
- the front wheels 23F are steered by the steering device 2S, and the front wheels 23F function as steering wheels for the dump truck 2.
- the rear wheel 23R is driven by an electric motor 23M disposed in the wheel and functions as a drive wheel of the dump truck 2.
- the drive device 2D of the dump truck 2 may transmit the power of the internal combustion engine 2E to the rear wheels 23R via a transmission including a torque converter to drive the rear wheels 23R.
- the vessel 22 is a loading platform on which a load is loaded.
- the vessel 22 is loaded with a load by a loading machine. In the discharging operation, the vessel 22 is lifted and discharges the load.
- the obstacle sensor 24 is arranged in the lower part in front of the vehicle main body 21.
- the obstacle sensor 24 detects an obstacle in front of the vehicle body 21 in a non-contact manner.
- the obstacle sensor 24 that is a non-contact sensor includes a radar 24A and a laser sensor 24B.
- the laser sensor 24B is a device that detects the position of an object existing around the dump truck 2.
- the laser sensor 24B irradiates a laser beam in a range as shown in FIG. 2, for example, and receives the laser beam reflected by the object. In this way, the laser sensor 24B detects the direction and distance of the object with respect to the laser sensor 24B.
- Objects around the dump truck 2 include objects (banks BK, side walls, banking, trees, buildings, and the like) that exist beside the travel route RP.
- the object existing beside the travel route RP may be an artificially manufactured structure.
- the control system 30 includes a collation navigation position output controller 33 that is a position output device and a vehicle body controller 20 that is a control device.
- the control system 30 includes a non-contact sensor 24, a gyro sensor 26, a speed sensor 27, a GPS receiver 31 that is a positioning device, a travel route creation device 32, a wireless communication device 34, a first signal line 35, and a first signal line 35. 2 signal lines 36 are included.
- the vehicle body controller 20, the travel route creation device 32, and the verification navigation position output controller 33 are connected to the first signal line 35. These communicate with each other via the first signal line 35 to exchange information.
- the vehicle body controller 20 receives the position of the dump truck 2 output from at least one of the collation navigation position output controller 33 and the GPS receiver 31. Then, the vehicle body controller 20 generates and outputs a command for controlling the dump truck 2 based on the received position of the dump truck 2 and travel route information received from the travel route creation device 32 described later. The vehicle body controller 20 generates and outputs a command for controlling the braking device 2B of the dump truck 2 using the received position of the dump truck 2.
- the travel route creation device 32 acquires the travel route information generated by the processing device 12 of the management device 10 shown in FIG. 1 and outputs it to the vehicle body controller 20.
- the travel route creation device 32 is connected to the wireless communication device 34 to which the antenna 34A is connected.
- the wireless communication device 34 receives information transmitted from at least one of the mining machines 3 other than the management device 10 and the host vehicle.
- the mining machine 3 other than the own vehicle includes a dump truck 2 other than the own vehicle in addition to the mining machine 3 other than the dump truck 2.
- FIG. 4 is a diagram showing the vehicle body controller 20 according to the embodiment.
- the vehicle body controller 20 as a control unit includes a processing unit 20P, a storage unit 20M, and an input / output unit 20IF.
- the processing unit 20P includes a correction position calculation unit 20PA, a dead reckoning position estimation unit 20PB, and a travel control unit 20PC.
- the corrected position calculation unit 20PA corrects the position of the dump truck 2 obtained by the collation navigation position output controller 33, which is a position output device, based on at least a delay time including a communication delay with the collation navigation position output controller 33. .
- the dead reckoning position estimation unit 20PB calculates the position of the dump truck 2 using a method called dead reckoning, which will be described later. Specifically, the position of the dump truck 2 is estimated using the angular speed of the dump truck 2 from the gyro sensor 26 and the speed of the dump truck 2 from the speed sensor 27.
- the traveling control unit 20PC generates a command for controlling the dump truck 2 using the correction position corrected by the correction position calculation unit 20PA.
- the storage unit 20M stores a computer computer program for autonomously driving the dump truck 2 and a computer program for controlling the operation of the dump truck 2.
- a gyro sensor 26, a speed sensor 27, a steering device 2S, a travel control device 2D, a first signal line 35, and a second signal line 36 are connected to the input / output unit 20IF.
- the input / output unit 20IF is an interface between the vehicle body controller 20 and devices connected to the vehicle body controller 20.
- the wireless communication device 34 receives the travel route information transmitted by the wireless communication device 18 of the control facility 7 shown in FIG. 1 and outputs it to the travel route creation device 32.
- a GPS receiver 31 is connected to the wireless communication device 34.
- the dump truck 2 travels in three travel modes.
- the first traveling mode is a traveling mode in which the position of the dump truck is obtained using the detection data of the GPS receiver 31 and the dump truck is autonomously traveled based on the position, and is appropriately referred to as a GPS traveling mode.
- the second driving mode calculates the position of the dump truck 2 using a technique called Scan Matching Navigation based on the map information prepared in advance and the detection result of the laser sensor 24B as will be described later.
- This is a travel mode in which the dump truck 2 autonomously travels based on the calculated position of the dump truck 2, and is appropriately referred to as a collation navigation travel mode.
- the position of the dump truck 2 is calculated by the verification navigation position output controller calculation unit 33.
- dead reckoning estimates the position of the dump truck 2 using the detection result of the gyro sensor 26 and the detection result of the speed sensor 27.
- the estimation of the position of the dump truck 2 by dead reckoning is performed by the vehicle body controller 20.
- the GPS receiver 31 detects the GPS position that is the position of the dump truck 2 using GPS.
- the GPS receiver 31 is one of a plurality of position information generation units included in the dump truck in the embodiment.
- the GPS receiver 31 is connected to an antenna 31 ⁇ / b> A that receives information from the positioning satellite 5.
- the antenna 31 ⁇ / b> A outputs a signal based on information received from the positioning satellite 5 to the GPS receiver 31.
- the GPS receiver 31 uses the information from the positioning satellite 5 to detect the position of the antenna 31A.
- the reference navigation position output controller 33 is based on the information on the object existing along the travel route RP obtained from the detection result of the laser sensor 24B and the map information including the position of the object existing in the mine MR in advance.
- the position of the dump truck 2 is obtained.
- the collation navigation position output controller 33 is one of a plurality of position information generation units included in the dump truck in the embodiment. Map information is stored in a map DB (database) 37.
- the vehicle body controller 20, the travel route creation device 32, and the reference navigation position output controller 33 are realized by a processor such as a CPU (Central Processing Unit) and a memory, for example.
- a processor such as a CPU (Central Processing Unit) and a memory, for example.
- Memory is non-volatile or volatile semiconductor memory such as RAM (Random Access Memory), ROM (Read Only Memory), flash memory, EPROM (Erasable Programmable Read Only Memory), EEPROM (Electrically Erasable Programmable Read Only Memory), magnetic A disk, a flexible disk, and a magneto-optical disk are applicable.
- RAM Random Access Memory
- ROM Read Only Memory
- flash memory EPROM (Erasable Programmable Read Only Memory), EEPROM (Electrically Erasable Programmable Read Only Memory), magnetic A disk, a flexible disk, and a magneto-optical disk are applicable.
- EPROM Erasable Programmable Read Only Memory
- EEPROM Electrical Erasable Programmable Read Only Memory
- the radar 24A and the laser sensor 24B are connected to the second signal line 36.
- the laser sensor 24 ⁇ / b> B is connected to the reference navigation position output controller 33 in addition to the second signal line 36. With such a configuration, the verification navigation position output controller 33 can directly receive the detection value of the laser sensor 24B.
- the vehicle body controller 20 acquires the detection values of the radar 24 ⁇ / b> A and the laser sensor 24 ⁇ / b> B via the second signal line 36.
- the vehicle body controller 20 can obtain the relative position between the dump truck 2 and the object using the detection values of the radar 24A and the laser sensor 24B. That is, the radar 24A and the laser sensor 24B detect the relative position between the object and the relative position between the dump truck 2 and the object.
- the gyro sensor 26 detects the azimuth or azimuth change amount of the dump truck 2.
- the gyro sensor 26 is connected to the vehicle body controller 20 and outputs a detection value as a detection result to the vehicle body controller 20.
- the speed sensor 27 detects the rotational speed of the wheels of the dump truck 2 and detects the traveling speed that is the speed of the dump truck 2.
- the speed sensor 27 is connected to the vehicle body controller 20 and outputs a detection value as a detection result to the vehicle body controller 20.
- the vehicle body controller 20 estimates the position of the dump truck 2 using dead reckoning navigation.
- Dead reckoning refers to navigation in which the current position of the dump truck 2 that is the object is estimated based on the azimuth (azimuth change amount) and the moving distance (velocity) from a known starting point.
- the azimuth (direction change amount) of the dump truck 2 is detected by using the gyro sensor 26 of the dump truck 2.
- the moving distance (speed) of the dump truck 2 is detected by using a speed sensor 27 that the dump truck 2 has.
- the vehicle body controller 20 obtains the position of the dump truck 2 by using the obtained direction (direction change amount) of the dump truck 2 and the moving distance (speed) of the dump truck 2.
- the collation navigation position output controller 33 obtains the position of the dump truck 2 using the detection value of the laser sensor 24B and the map information of the mine MR created in advance. That is, the collation navigation position output controller 33 computes the position of the dump truck 2 by collating the detection result of the laser sensor 24B with the map information.
- the verification navigation position output controller 33 obtains the position of the dump truck 2 using the detection value of the laser sensor 24B and the map information, and outputs it to the first signal line 35.
- the vehicle body controller 20 receives the position of the dump truck 2 obtained by the verification navigation position output controller 33 via the first signal line 35 and causes the dump truck 2 to travel along the travel route RP.
- the map information is information including the position of an object (bank BK, side wall, etc.) provided beside the traveling route RP of the mine MR.
- the map DB 37 that stores map information is connected to the first signal line 35.
- the map information needs to be created in advance before calculating the position of the dump truck by collation navigation.
- the detection result of the laser sensor 24B in the dump truck 2 traveling on the conveyance path HL can be used.
- the presence / absence and position of the bank BK provided beside the conveyance path HL is detected by the laser sensor 24B, and the presence / absence and position data of the bank BK are obtained.
- the map information corresponding to the transport path HL can be stored at any time.
- FIG. 5 is a diagram showing a part of the map information in the embodiment.
- a part of the map information in FIG. 5 shows the detection result of the bank BK by the radar sensor 24B in the area around the transport path HL.
- the conveyance path HL is a blank area in the center extending in the x direction in FIG. 5, and the bank BK is an area in which black and white are sparse in the upper and lower parts in FIG. 5.
- the map information includes the position in the XY coordinate system of the grid GR that divides the mine MR by a predetermined size in the plan view, and whether or not the bank BK exists in each grid GR. Indicate.
- the grid DR1 at the position where the bank BK is detected is indicated by a black square in the figure
- the grid DR2 at the position where the bank BK is not detected is indicated by a white square in the figure. Indicated.
- the map information stores presence / absence of bank BK and position information.
- the map DB 37 that stores map information is an external storage device (auxiliary storage device) that includes at least one of a ROM, a flash memory, and a hard disk drive.
- FIG. 7 is a schematic diagram showing an example of a partial area of map information according to the embodiment.
- FIG. 8 is a schematic diagram illustrating an example of a detection result of the bank BK by the laser sensor 24B when the dump truck travels on the conveyance path HL.
- FIG. 9 is a schematic diagram showing a state in which the detection result of the laser sensor 24B in FIG. 8 is collated with the map information in FIG. 7, and the position of the host vehicle is calculated by collation navigation. 7 to 9, the grid DR1 at the position where the bank BK exists in the map information is indicated by a dense parallel oblique line, and the grid DR3 at the position where the bank BK is detected by the laser sensor 24B is indicated by a rough parallel oblique line.
- the position calculation of the dump truck using the reference navigation is performed by the reference navigation position output controller 33.
- the calculation is performed by using a plurality of points (particles) PA virtually arranged within a range where the dump truck is expected to exist at a certain time. It is possible to calculate the position of the dump truck close to the true position while suppressing the cost.
- information on the direction (direction change amount) and movement distance (speed) of the host vehicle at that time that is, information on dead reckoning navigation is required. Since position estimation by collation navigation using particles is a known technique, a detailed description is omitted.
- the position calculation by collation navigation requires a certain amount of time for calculation because the detection result of the non-contact sensor and the map information are collated for each calculation cycle and each time calculation is performed using particles. Therefore, the delay caused by the processing in the verification navigation position output controller 33 is large.
- each square is a grid GR.
- the colored grid DR1 is a grid where the bank BK is detected, and the white grid DR2 is a grid where the bank BK is not detected.
- FIG. 8 shows detection data DR3 actually detected by the laser sensor 24B of the dump truck.
- the reference navigation position output controller 33 outputs the closest position as the position information of the dump truck 2.
- the position information of the dump truck 2 may include direction information indicating the direction of the dump truck 2.
- the vehicle body controller 20 acquires the position of the dump truck 2 output by the verification navigation position output controller 33.
- the vehicle body controller 20 controls the travel of the dump truck 2 using the acquired information so that the dump truck 2 travels along the travel route RP.
- the vehicle body controller 20 acquires the position information of the dump truck 2 from the reference navigation position output controller 33 through communication in the reference navigation traveling mode. Further, the collation navigation position output controller 33 displays the detection result of the laser sensor 24B, map information, the speed of the host vehicle, and the direction change amount, which are information necessary for calculating the position of the dump truck 2 by the collation navigation. Receive by communication. Specifically, the verification navigation position output controller 33 acquires the detection result from the laser sensor 24B, the map information from the map DB 37, and the detection value of the gyro sensor 26 and the detection value of the speed sensor 27 from the vehicle body controller 20.
- the collation navigation position output controller 33 receives the detection values of the gyro sensor 26 and the speed sensor 27 from the vehicle body controller 20, and the detection results from the laser sensor 24B. Receive map information from the map DB 37. The collation navigation position output controller 33 calculates the position of the dump truck based on the collation navigation. Thereafter, the verification navigation position output controller 33 transmits the calculation result to the vehicle body controller 20. The vehicle body controller 20 controls the vehicle based on the received position of the dump truck 2.
- communication is performed twice between the vehicle body controller 20 and the reference navigation position output controller 33. Therefore, when a delay or the like occurs in communication between the vehicle body controller 20 and the reference navigation position output controller 33 in the control system 30, the position and direction of the dump truck 2 received by the vehicle body controller 20 from the reference navigation position output controller 33 are There is a possibility that the position and orientation when the dump truck 2 is controlled by the controller 20 are different.
- FIG. 10 is a diagram showing that the dump truck 2 moves during a communication delay or the like.
- the position of the dump truck 2 is P1 at time t1
- the speed of the dump truck 2 detected by the speed sensor 27 is Vc1
- the angular speed of the dump truck 2 detected by the gyro sensor 26 is ⁇ 1.
- the time when the velocity Vc1 and the angular velocity ⁇ 1 are obtained is t1.
- the reference navigation position output controller 33 receives the detection result of the gyro sensor 26, the detection result of the speed sensor 27, the detection result of the received laser sensor 24B, and the map information by communication, and the dump at the time t1 based on the information.
- the position P1 of the track 2 is calculated.
- the vehicle body controller 20 receives the position P1 of the dump truck 2 obtained by the verification navigation position output controller 33, and controls the traveling of the dump truck 2 based on the received position P1.
- a timing at which the vehicle body controller 20 starts controlling the traveling of the dump truck 2 based on the position P1 is time t2.
- the vehicle body controller 20 performs the traveling control at the time t2 based on the position P1 of the dump truck 2 at the time t1. Therefore, accurate traveling control cannot be performed.
- the vehicle body controller 20 corrects the position P1 of the dump truck 2 at the time t1 obtained by the collation navigation position output controller 33, so that the correction position P1c at which the dump truck 2 will exist at the time t2 is obtained.
- a command for controlling the dump truck 2 is generated based on the correction position P1c. Details of the position correction method will be described later.
- the actual position of the dump truck 2 at time t2 is P2.
- the time t1 is appropriately referred to as a first time t1
- the time t2 is appropriately referred to as a second time t2.
- the delay time ⁇ t includes a communication delay when the vehicle body controller 20 receives position information that is information on the position P1 at the time t1 from the collation navigation position output controller 33, and a delay caused by position calculation processing in the collation navigation position output controller 33.
- the delay time may include a communication delay when the verification navigation position output controller 33 receives the detection results of the gyro sensor 26 and the speed sensor 27 from the vehicle body controller 20. Furthermore, a delay or the like caused by an instantaneous interruption of communication between the vehicle body controller 20 and the reference navigation position output controller 33 may be included.
- the delay time ⁇ t may include a delay generated due to a difference between the control cycle of the vehicle body controller 20 and the control cycle of the verification navigation position output controller 33 in addition to the communication delay.
- the vehicle body controller 20 controls the dump truck 2 based on the position information received by the vehicle body controller 20 from the verification navigation position output controller 33.
- the control cycle is earlier than the control cycle. That is, the vehicle body controller 20 receives the position information obtained by the verification navigation position output controller 33 with a delay.
- the delay time ⁇ t may include this delay.
- the dump truck 2 moves from the position P1 to the position P2 during the delay time ⁇ t, but as the delay time ⁇ t increases, the distance between the position P2 and the position P1 increases.
- the vehicle body controller 20 uses the position obtained by the verification navigation position output controller 33, that is, the position P1. For this reason, as the distance between the actual position P2 of the dump truck 2 and the position P1 at the timing when the body controller 20 controls the dump truck 2, the accuracy when the body controller 20 controls the dump truck 2 decreases. there's a possibility that.
- the vehicle body controller 20 of the control system 30 corrects the position P1 using the delay time ⁇ t. And the vehicle body controller 20 makes the dump truck 2 autonomously travel by generating and outputting a command for controlling the dump truck 2 using the corrected position P1c which is the corrected position.
- the control system 30 obtains the position of the dump truck 2 using the delay time.
- FIG. 11 is a flowchart illustrating a processing example when the control system 30 according to the embodiment executes the work machine control method according to the embodiment.
- FIG. 12 is a diagram for explaining the exchange of information between the vehicle body controller 20 and the verification navigation position output controller 33.
- the vehicle body controller 20 When the control system 30 makes the dump truck 2 autonomously travel, the vehicle body controller 20 outputs information IFs for the verification navigation position output controller 33 to obtain the position P1 of the dump truck 2 in step S101.
- the information IFs is an angular velocity ⁇ ⁇ b> 1 that is a detection value of the gyro sensor 26 and a velocity Vc ⁇ b> 1 that is a detection value of the speed sensor 27.
- the information IFs is appropriately referred to as vehicle body information IFs.
- the vehicle body controller 20 outputs the vehicle body information IFs to the first signal line 35 together with the first time t1 when the vehicle body information IFs is obtained.
- the vehicle body controller 20 transmits the first time t1 when the vehicle body information IFs is obtained and the vehicle body information IFs to the verification navigation position output controller 33.
- the vehicle body controller 20 transmits the vehicle body information IFs to the reference navigation position output controller 33 in the control cycle in which the vehicle body information IFs is received.
- the first time t1 when the vehicle body information IFs is obtained is the time when the vehicle body information IFs is transmitted to the verification navigation position output controller 33.
- the first time t1 may be a time when the vehicle body controller 20 receives the detection results from the gyro sensor 26 and the speed sensor 27.
- the first time t1 and the vehicle body information IFs are output from the vehicle body controller 20 as the first information IF1, as shown in FIG.
- the first information IF1 includes a first time t1 and vehicle body information IFs.
- the laser sensor 24B outputs a detection result RT.
- step S103 the verification navigation position output controller 33 communicates with the vehicle body controller 20 via the first signal line 35, and the first information IF1, the detection result RT of the laser sensor 24B, and the map information of the map DB 37 (in FIG. 11). (Omitted).
- the reference navigation position output controller 33 receives the vehicle body information IFs from the vehicle body controller 20 in step S103.
- step S104 the reference navigation position output controller 33 obtains the position P1 of the dump truck 2 using the received vehicle body information IFs, and outputs the obtained position P1 to the first signal line 35 as the position information IFp. .
- the position information IFp includes at least the coordinates P1 (X1, Y1) of the position P1 of the dump truck 2 obtained using the vehicle body information IFs included in the first information IF1.
- the position information IFp may include the azimuth angle ⁇ of the dump truck 2 obtained using the vehicle body information IFs.
- the azimuth angle ⁇ is information indicating the direction of the dump truck 2 at the position P1.
- the collation navigation position output controller 33 outputs the position information IFp to the first signal line 35 together with the first time t1 included in the first information IF1, thereby transmitting the position information IFp to the vehicle body controller 20. This means that the position of the dump truck at the first time t1 is P1 (X1, Y1).
- the first time t1 and the position information IFp are output from the collation navigation position output controller 33 as the second information IF2, as shown in FIG.
- the second information IF2 includes a first time t1 and position information IFp, as shown in FIG.
- step S106 the vehicle body controller 20 communicates with the verification navigation position output controller 33 via the first signal line 35 and receives the second information IF2. As described above, since the second information IF2 includes the position information IFp, the vehicle body controller 20 receives the position information IFp from the verification navigation position output controller 33 in step S106. Next, in step S107, the vehicle body controller 20 corrects the received position P1 using the delay time ⁇ t. Thereafter, in step S108, the vehicle body controller 20 generates a control command that is a command for controlling the dump truck 2 using the correction position P1c, and outputs the control command to at least one of the steering device 2S and the travel control device 2D. The dump truck 2 is controlled via
- step S107 the vehicle body controller 20 corrects the position P1 using dead reckoning navigation to obtain the corrected position P1c.
- the correction method will be described.
- the known starting point is the position P1.
- the moving distance from the position P1 is obtained from the product of the speed Vc1 and the delay time ⁇ t.
- the direction from the position P1 is obtained from the angular velocity ⁇ 1. That is, the method of correcting the position of the dump truck 2 at the second time t2 based on the position P1 at the first time t1 can be corrected by a method similar to dead reckoning navigation.
- the delay time ⁇ t is a difference between the second time t2 and the first time t1.
- the second time t2 is a time at which the vehicle body controller 20 starts calculating a command for controlling the dump truck 2, and is a time at which the position P1 is corrected.
- the first time t1 is a time when the vehicle body information IFs for obtaining the position P1 of the dump truck 2 is obtained, and is a time before the second time t2 when the position P1 is corrected.
- step S101 and step S102 do not necessarily have the same timing (first time t1).
- the first time t1 may be the time of output in step S101, the time of output of step S102, the time of acquisition of information in step S103, the time of processing in step S104, or the position in step S105.
- the information IFp may be output.
- the position advanced from P1 by the distance Vc1 ⁇ ⁇ t from the position P1 corresponding to the first time t1 based on the speed Vc1 and the angular speed ⁇ 1 is the correction position P1c. That is, the vehicle body controller 20 obtains the position where the dump truck 2 has moved from the position P1 received from the collation navigation position output controller 33 during the delay time ⁇ t using dead reckoning navigation, and corrects the obtained position to the corrected position. That is, it is set as the correction position P1c. Thereafter, the vehicle body controller 20 controls the dump truck 2 using the correction position P1c.
- a delay caused by communication between the vehicle body controller 20 and the reference navigation position output controller 33 a delay caused by an interruption of communication, a delay caused by a difference in control cycle, a delay caused by processing in the reference navigation position output controller 33, and the like. At least one effect is reduced. As a result, a decrease in accuracy when the vehicle body controller 20 controls the dump truck 2 is suppressed.
- FIG. 13 is a diagram illustrating a part of a control system 30a according to a modification of the embodiment.
- the gyro sensor 26 and the speed sensor 27 are connected not only to the vehicle body controller 20 but also to the reference navigation position output controller 33.
- the output of the clock 42 that counts time is input to the vehicle body controller 20 and the verification navigation position output controller 33.
- the vehicle body controller 20 and the reference navigation position output controller 33 operate in the same time system, that is, the clock 42 time system.
- the collation navigation position output controller 33 acquires the angular speed ⁇ 1 of the dump truck 2 from the gyro sensor 26 at the first time t1, and acquires the speed Vc1 of the dump truck 2 from the speed sensor 27.
- the reference navigation position output controller 33 obtains the position P1 of the dump truck 2 using the vehicle body information IFs, that is, the speed Vc1 and the angular speed ⁇ 1, the detection result of the laser sensor 24B, and the map information of the map DB 37. Specifically, the coordinates P1 (X1, Y1) of the position P1 are obtained.
- the collation navigation position output controller 33 outputs the position information IFp including the coordinates P1 (X1, Y1) together with the first time t1 to the first signal line 35 as information IF3.
- the information IF3 is the same as the second information IF2.
- the body controller 20 When the body controller 20 receives the information IF3 via the first signal line 35, the body controller 20 corrects the position P1 corresponding to the position information IFp of the information IF3 using dead reckoning navigation at the second time t2. At this time, a delay time ⁇ t that is a difference between the second time t2 and the first time t1 is used. Then, the vehicle body controller 20 controls the dump truck 2 using the corrected position P1c, which is the corrected position P1. Thus, also in the modification, the verification navigation position output controller 33 obtains the position using the vehicle body information IFs for obtaining the position P1.
- the vehicle body information IFs is the second time t2 when the vehicle body controller 20 corrects the position P1, and the time before the second time t2.
- Is used which is a delay time ⁇ t that is a difference from the first time t1 when.
- the vehicle body controller 20 that controls the dump truck 2 sets the delay time ⁇ t including the information transmission delay in the control system 30 such as the communication delay and the information transmission delay due to the difference in the control cycle.
- the position of the dump truck 2 obtained by the verification navigation position output controller 33 is corrected.
- the vehicle body controller 20 controls the dump truck 2 using the correction position P1c obtained by the correction.
- the control system 30 can reduce the influence of the delay in information transmission in the control system 30, specifically, the delay when the vehicle body controller 20 receives the information on the position P 1 from the verification navigation position output controller 33.
- the control system 30 causes a delay and a decrease in accuracy when the vehicle body controller 20 controls the dump truck 2. Can be suppressed.
- the work vehicle is a mining machine used in a mine
- the work vehicle is not limited to a mining machine.
- the work vehicle only needs to include at least the traveling device 23 and the braking device 2B, and may be, for example, a work vehicle used in an underground mine or a work vehicle used in a work site on the ground.
- the work vehicle is a concept including a mining machine.
- the work vehicle is the dump truck 2, but may be a wheel loader, a grader, or a general vehicle 3C.
- the dump truck 2 is an unmanned dump truck, it is not limited to this, The form which assists the driving
- the method by which the reference navigation position output controller 33 obtains the position of the dump truck 2 is not limited to that of the embodiment and the modified example, and the detection result by the non-contact sensor 24 is compared with the map information 37 stored in advance. Any method for calculating the current position of the dump truck 2 may be used.
- the radar sensor and the laser sensor are exemplified as the non-contact sensor 24, but the non-contact sensor 24 is not limited to these.
- the non-contact sensor 24 may detect a situation around the dump truck 2 using, for example, a stereo camera or a mono camera.
- the position of the work vehicle is detected using the GPS detector.
- the detection of the position of the work vehicle is not limited to the GPS detector, and the position of the work vehicle is based on a known position information generation unit. May be detected.
- GNSS cannot be detected in underground mines, for example, IMES (Indoor Messaging System), pseudolite (sud light), RFID (Radio Frequency Identifier), beacon, surveying instrument, wireless LAN, UWB (Ultra) Self-localization of a working vehicle using a wide band, SLAM (Simultaneous Localization and Mapping), or a landmark (a mark provided beside the travel route) may be used.
- the dump truck 2 when the dump truck 2 is braked so as to achieve the target speed at the target position, the impact generated on the dump truck 2 is suppressed and the position of the work vehicle that has reached the target position is obtained.
- the reduction in accuracy can be suppressed.
- the dump truck 2 used in the mine since the dump truck 2 used in the mine has a large mass, the dump truck 2 is likely to be shocked during braking. Therefore, it is suitable for a large work vehicle used in a mine.
- Management System Dump Truck 3 Mining Machine 3C Vehicle 3S Hydraulic Excavator 7 Control Facility 9 Communication System 10 Management Device 20 Car Body Controller (Control Device) 21 Vehicle Body 22 Vessel 23 Traveling Device 24 Obstacle Sensor 24A Radar (Non-contact Sensor) 24B Laser sensor (non-contact sensor) 26 Gyro sensor 27 Speed sensor 30, 30a Work machine control system (control system) 31 receiver 31A antenna 32 travel route creation device 33 collation navigation position output controller (position output device) 34 Wireless communication device 35 First signal line 36 Second signal line 37 Map DB ⁇ t delay time
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Civil Engineering (AREA)
- Structural Engineering (AREA)
- Mining & Mineral Resources (AREA)
- Optics & Photonics (AREA)
- Electromagnetism (AREA)
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Traffic Control Systems (AREA)
Abstract
Description
図3は、実施形態に係る作業車両の制御システム30を備えたダンプトラック2を示す図である。実施形態において、ダンプトラック2が作業車両の制御システム30を備える例を説明するが、作業車両の制御システム30は、ダンプトラック2以外の作業車両である他の鉱山機械3が備えていてもよい。以下において、作業車両の制御システム30を、適宜、制御システム30と称する。
実施形態において、車体コントローラ20は、推測航法を用いて、ダンプトラック2の位置を推定する。推測航法とは、既知の起点からの方位(方位変化量)と移動距離(速度)とに基づいて、対象物であるダンプトラック2の現在位置を推測する航法をいう。
照合航法走行モード時に、照合航法位置出力コントローラ33は、レーザーセンサ24Bの検出値と、予め作成された鉱山MRの地図情報とを用いて、ダンプトラック2の位置を求める。すなわち、照合航法位置出力コントローラ33は、レーザーセンサ24Bの検出結果と地図情報とを照合することにより、ダンプトラック2の位置を演算する。
実施形態において、照合航法走行モード時に、車体コントローラ20は、通信によって照合航法位置出力コントローラ33からダンプトラック2の位置情報を取得する。また、照合航法位置出力コントローラ33は、照合航法によってダンプトラック2の位置を演算するために必要となる情報であるレーザーセンサ24Bの検出結果、地図情報、自車両の速度及び方位変化量のそれぞれを通信によって受け取る。具体的には、照合航法位置出力コントローラ33は、レーザーセンサ24Bから検出結果を、地図DB37から地図情報を、車体コントローラ20からジャイロセンサ26の検出値及び速度センサ27の検出値を取得する。
図11は、実施形態に係る制御システム30が実施形態に係る作業機械の制御方法を実行したときの処理例を説明するフローチャートである。図12は、車体コントローラ20と照合航法位置出力コントローラ33との情報のやり取りを説明するための図である。
図13は、実施形態の変形例に係る制御システム30aの一部を示す図である。制御システム30aは、車体コントローラ20だけでなく、照合航法位置出力コントローラ33にも、ジャイロセンサ26及び速度センサ27が接続されている。制御システム30aは、車体コントローラ20及び照合航法位置出力コントローラ33に、時間を計数するクロック42の出力が入力される。このような構成により、車体コントローラ20及び照合航法位置出力コントローラ33は、同じ時刻系、すなわちクロック42の時刻系で動作する。
2 ダンプトラック
3 鉱山機械
3C 車両
3S 油圧ショベル
7 管制施設
9 通信システム
10 管理装置
20 車体コントローラ(制御装置)
21 車両本体
22 ベッセル
23 走行装置
24 障害物センサ
24A レーダー(非接触センサ)
24B レーザーセンサ(非接触センサ)
26 ジャイロセンサ
27 速度センサ
30,30a 作業機械の制御システム(制御システム)
31 受信器
31A アンテナ
32 走行経路作成装置
33 照合航法位置出力コントローラ(位置出力装置)
34 無線通信装置
35 第1信号線
36 第2信号線
37 地図DB
Δt 遅延時間
Claims (7)
- 作業機械の周囲を検出する非接触センサと、
少なくとも前記非接触センサの検出結果に基づいて作業機械の位置を求めて、前記位置の情報を出力する位置出力装置と、
前記位置出力装置によって求められた前記位置を、少なくとも前記位置出力装置との通信の遅れを含む遅延時間に基づいて補正する補正位置演算部と、
前記補正位置演算部によって補正された補正位置を用いて前記作業機械を制御する指令を生成する制御装置と、
を備える、作業機械の制御システム。 - 前記制御装置は、推測航法を用いて前記位置を補正する、
請求項1に記載の作業機械の制御システム。 - 前記遅延時間は、前記補正位置演算部が前記位置を補正する時刻である第1時刻と、前記第1時刻よりも前の時刻であって、前記非接触センサにより検出がなされた時刻又は前記位置出力装置が前記非接触センサの検出結果を受け取った時刻である第2時刻との差分である、
請求項1又は請求項2に記載の作業機械の制御システム。 - 前記位置出力装置は、前記制御装置から位置を求めるための情報を受け取って前記作業機械の位置を求めるものであって、
前記位置を求めるための情報が前記制御装置によって前記位置出力装置に出力される時刻を第1時刻とし、前記位置出力装置が求めた前記位置を前記補正位置演算部によって補正する時刻を第2時刻とし、
前記遅延時間は、前記第2時刻と、前記第1時刻との差分である、
請求項1又は請求項2に記載の作業機械の制御システム。 - 前記制御装置は、
前記位置出力装置から受け取った、前記第1時刻に対応した前記位置から、前記遅延時間の間に前記作業機械が移動した位置を、前記推測航法を用いて求め、求めた位置を補正後の前記位置とする、
請求項3又は請求項4に記載の作業機械の制御システム。 - 請求項1から請求項5のいずれか1項に記載の作業機械の制御システムと、
前記作業機械の制御システムが有する前記制御装置によって制御される走行装置と、
を含む、作業機械。 - 非接触センサにより作業機械の周囲を検出し、
検出した結果に基づいて作業機械の位置を求め、前記位置の情報を出力し、
出力された前記位置の情報に基づき、前記位置の情報を受け取る際の遅れを含む遅延時間を用いて推測航法により前記位置を補正して、補正後の前記位置を用いて前記作業機械を制御する指令を生成する、
作業機械の制御方法。
Priority Applications (7)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2016/060847 WO2016148310A1 (ja) | 2016-03-31 | 2016-03-31 | 作業機械の制御システム、作業機械及び作業機械の制御方法 |
US15/316,247 US10120388B2 (en) | 2016-03-31 | 2016-03-31 | Control system for work machine, work machine, and control method for work machine |
AU2016234213A AU2016234213A1 (en) | 2016-03-31 | 2016-03-31 | Control system for work machine, work machine, and control method for work machine |
JP2016540709A JP6271023B2 (ja) | 2016-03-31 | 2016-03-31 | 作業機械の制御システム、作業機械及び作業機械の制御方法 |
CA2951515A CA2951515C (en) | 2016-03-31 | 2016-03-31 | Control system for work machine, work machine, and control method for work machine |
CN201680000621.7A CN106796433A (zh) | 2016-03-31 | 2016-03-31 | 作业机械的控制***、作业机械和作业机械的控制方法 |
AU2018200586A AU2018200586B2 (en) | 2016-03-31 | 2018-01-24 | Control system for work machine, work machine, and control method for work machine |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2016/060847 WO2016148310A1 (ja) | 2016-03-31 | 2016-03-31 | 作業機械の制御システム、作業機械及び作業機械の制御方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2016148310A1 true WO2016148310A1 (ja) | 2016-09-22 |
Family
ID=56920130
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2016/060847 WO2016148310A1 (ja) | 2016-03-31 | 2016-03-31 | 作業機械の制御システム、作業機械及び作業機械の制御方法 |
Country Status (6)
Country | Link |
---|---|
US (1) | US10120388B2 (ja) |
JP (1) | JP6271023B2 (ja) |
CN (1) | CN106796433A (ja) |
AU (2) | AU2016234213A1 (ja) |
CA (1) | CA2951515C (ja) |
WO (1) | WO2016148310A1 (ja) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2018107568A (ja) * | 2016-12-26 | 2018-07-05 | 日本電気株式会社 | 遠隔制御装置、遠隔制御システム、遠隔制御方法及び遠隔制御プログラム |
JP2018124812A (ja) * | 2017-02-01 | 2018-08-09 | 株式会社Soken | 危険度判定システム、サーバ及びコンピュータプログラム |
US10883256B2 (en) | 2018-05-25 | 2021-01-05 | Deere & Company | Object responsive control system for a work machine |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102017210070A1 (de) * | 2017-06-14 | 2018-12-20 | Robert Bosch Gmbh | Verfahren zum Erstellen einer digitalen Karte für ein automatisiertes Fahrzeug |
US11180902B2 (en) * | 2018-08-08 | 2021-11-23 | Deere & Company | Forward looking sensor for predictive grade control |
EP3660231B1 (en) * | 2018-11-08 | 2022-02-23 | Intsite Ltd | System and method for autonomous operation of heavy machinery |
DE102019101569A1 (de) * | 2019-01-23 | 2020-07-23 | Bayerische Motoren Werke Aktiengesellschaft | Verfahren zum fahrerlosen Umsetzen eines Fahrzeugs über eine Strecke innerhalb eines abgeschlossenen Geländes |
US11029681B2 (en) | 2019-03-04 | 2021-06-08 | Deere & Company | Semi-autonomous payload retrieval system |
CN110747933A (zh) * | 2019-10-25 | 2020-02-04 | 广西柳工机械股份有限公司 | 挖掘机自主移动作业控制方法和*** |
WO2021102333A1 (en) * | 2019-11-20 | 2021-05-27 | Autonomous Solutions, Inc. | Autonomous loader controller |
JP7164278B2 (ja) * | 2020-03-27 | 2022-11-01 | 日立建機株式会社 | 作業機械の遠隔操縦システム |
SE2051115A1 (en) * | 2020-09-24 | 2022-03-25 | Husqvarna Ab | CONSTRUCTION MACHINERY WITH REDUCED LATENCY ACTUATOR CONTROLS |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001033549A (ja) * | 1999-07-16 | 2001-02-09 | Yanmar Diesel Engine Co Ltd | 移動体の位置認識方法 |
WO2015097909A1 (ja) * | 2013-12-27 | 2015-07-02 | 株式会社小松製作所 | 鉱山機械の管理システム、鉱山機械及び管理方法 |
Family Cites Families (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11183590A (ja) | 1997-12-17 | 1999-07-09 | Mazda Motor Corp | 移動体用ディファレンシャルgps装置 |
US7268700B1 (en) * | 1998-01-27 | 2007-09-11 | Hoffberg Steven M | Mobile communication device |
US6315062B1 (en) | 1999-09-24 | 2001-11-13 | Vermeer Manufacturing Company | Horizontal directional drilling machine employing inertial navigation control system and method |
US6292751B1 (en) * | 2000-02-08 | 2001-09-18 | Bae Systems | Positioning refinement algorithm |
US8306726B2 (en) | 2009-04-28 | 2012-11-06 | Caterpillar Inc. | Position monitoring system for a mobile machine |
DE112011100458B4 (de) | 2010-02-05 | 2024-02-01 | Trimble Navigation Limited | Systeme und Verfahren zur Verarbeitung von Kartierungs- und Modellierungsdaten |
EP2423871B1 (en) * | 2010-08-25 | 2014-06-18 | Lakeside Labs GmbH | Apparatus and method for generating an overview image of a plurality of images using an accuracy information |
EP2423873B1 (en) * | 2010-08-25 | 2013-12-11 | Lakeside Labs GmbH | Apparatus and Method for Generating an Overview Image of a Plurality of Images Using a Reference Plane |
US8378854B1 (en) * | 2010-09-16 | 2013-02-19 | Glenview Properties LLC | Systems and methods for improved augmentation for GPS calculations |
US9134426B1 (en) * | 2010-09-16 | 2015-09-15 | United Parcel Service Of America, Inc. | Systems and methods for identifying attributes located along segments of a driving route |
US8655588B2 (en) * | 2011-05-26 | 2014-02-18 | Crown Equipment Limited | Method and apparatus for providing accurate localization for an industrial vehicle |
US9784843B2 (en) * | 2012-01-17 | 2017-10-10 | Limn Tech LLC | Enhanced roadway mark locator, inspection apparatus, and marker |
US9064352B2 (en) | 2013-04-24 | 2015-06-23 | Caterpillar Inc. | Position identification system with multiple cross-checks |
WO2015029234A1 (ja) * | 2013-08-30 | 2015-03-05 | 株式会社小松製作所 | 鉱山機械の管理システム及び鉱山機械の管理方法 |
JP2015055906A (ja) | 2013-09-10 | 2015-03-23 | 株式会社日立産機システム | 移動体の走行制御手段に対して制御指令を出力する位置検出装置及び移動体システム |
US10111044B2 (en) * | 2015-05-29 | 2018-10-23 | Verity Studios Ag | Methods and systems for scheduling the transmission of localization signals and operating self-localizing apparatus |
-
2016
- 2016-03-31 JP JP2016540709A patent/JP6271023B2/ja active Active
- 2016-03-31 US US15/316,247 patent/US10120388B2/en active Active
- 2016-03-31 CN CN201680000621.7A patent/CN106796433A/zh active Pending
- 2016-03-31 CA CA2951515A patent/CA2951515C/en active Active
- 2016-03-31 AU AU2016234213A patent/AU2016234213A1/en not_active Abandoned
- 2016-03-31 WO PCT/JP2016/060847 patent/WO2016148310A1/ja active Application Filing
-
2018
- 2018-01-24 AU AU2018200586A patent/AU2018200586B2/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001033549A (ja) * | 1999-07-16 | 2001-02-09 | Yanmar Diesel Engine Co Ltd | 移動体の位置認識方法 |
WO2015097909A1 (ja) * | 2013-12-27 | 2015-07-02 | 株式会社小松製作所 | 鉱山機械の管理システム、鉱山機械及び管理方法 |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2018107568A (ja) * | 2016-12-26 | 2018-07-05 | 日本電気株式会社 | 遠隔制御装置、遠隔制御システム、遠隔制御方法及び遠隔制御プログラム |
JP2018124812A (ja) * | 2017-02-01 | 2018-08-09 | 株式会社Soken | 危険度判定システム、サーバ及びコンピュータプログラム |
US10883256B2 (en) | 2018-05-25 | 2021-01-05 | Deere & Company | Object responsive control system for a work machine |
US11828046B2 (en) | 2018-05-25 | 2023-11-28 | Deere & Company | Object responsive control system for a work machine |
Also Published As
Publication number | Publication date |
---|---|
US10120388B2 (en) | 2018-11-06 |
CA2951515C (en) | 2019-12-31 |
CN106796433A (zh) | 2017-05-31 |
AU2016234213A1 (en) | 2017-10-19 |
AU2018200586A1 (en) | 2018-02-15 |
US20170285657A1 (en) | 2017-10-05 |
AU2018200586B2 (en) | 2019-02-14 |
JPWO2016148310A1 (ja) | 2017-04-27 |
JP6271023B2 (ja) | 2018-01-31 |
CA2951515A1 (en) | 2016-09-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6271023B2 (ja) | 作業機械の制御システム、作業機械及び作業機械の制御方法 | |
JP6055120B2 (ja) | 作業機械の制御システム、作業機械、作業機械の管理システム、作業機械の制御方法及びプログラム | |
JP6059846B2 (ja) | 鉱山用作業機械の制御システム、鉱山用作業機械、鉱山用作業機械の管理システム、鉱山用作業機械の制御方法及びプログラム | |
CN106104401B (zh) | 作业机械的控制***、作业机械以及作业机械的管理*** | |
WO2017072980A1 (ja) | 作業機械の制御システム、作業機械、作業機械の管理システム、及び作業機械の管理方法 | |
AU2017279833B2 (en) | Work vehicle control system | |
JP6617192B2 (ja) | 作業機械の管理システム、及び作業機械 | |
JP6657257B2 (ja) | 作業機械の管理システム、作業機械及び作業機械の管理装置 | |
JP6757749B2 (ja) | 作業機械の管理システム、作業機械、作業機械の管理方法 | |
JP6672339B2 (ja) | 作業機械の管理システム及び作業機械 | |
JP6538793B2 (ja) | 作業機械の制御システム、作業機械、及び作業機械の管理システム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
ENP | Entry into the national phase |
Ref document number: 2016540709 Country of ref document: JP Kind code of ref document: A |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 16765137 Country of ref document: EP Kind code of ref document: A1 |
|
WWE | Wipo information: entry into national phase |
Ref document number: 15316247 Country of ref document: US |
|
ENP | Entry into the national phase |
Ref document number: 2951515 Country of ref document: CA |
|
ENP | Entry into the national phase |
Ref document number: 2016234213 Country of ref document: AU Date of ref document: 20160331 Kind code of ref document: A |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 16765137 Country of ref document: EP Kind code of ref document: A1 |