WO2017109977A1 - 作業機械の制御システム、作業機械、作業機械の管理システム、及び作業機械の管理方法 - Google Patents
作業機械の制御システム、作業機械、作業機械の管理システム、及び作業機械の管理方法 Download PDFInfo
- Publication number
- WO2017109977A1 WO2017109977A1 PCT/JP2015/086340 JP2015086340W WO2017109977A1 WO 2017109977 A1 WO2017109977 A1 WO 2017109977A1 JP 2015086340 W JP2015086340 W JP 2015086340W WO 2017109977 A1 WO2017109977 A1 WO 2017109977A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- map data
- data
- work machine
- divided
- dump truck
- Prior art date
Links
- 238000007726 management method Methods 0.000 title claims description 85
- 238000001514 detection method Methods 0.000 claims abstract description 149
- 238000004364 calculation method Methods 0.000 claims abstract description 43
- 238000000034 method Methods 0.000 claims description 33
- 238000005065 mining Methods 0.000 description 62
- 238000004891 communication Methods 0.000 description 56
- 238000005259 measurement Methods 0.000 description 54
- 238000012545 processing Methods 0.000 description 42
- 238000010586 diagram Methods 0.000 description 28
- 238000012795 verification Methods 0.000 description 15
- 101100023365 Caenorhabditis elegans mif-2 gene Proteins 0.000 description 11
- 238000006243 chemical reaction Methods 0.000 description 10
- 101100023369 Caenorhabditis elegans mif-3 gene Proteins 0.000 description 9
- 230000006870 function Effects 0.000 description 9
- 230000005540 biological transmission Effects 0.000 description 5
- 230000001276 controlling effect Effects 0.000 description 5
- 238000007599 discharging Methods 0.000 description 5
- 239000000284 extract Substances 0.000 description 5
- 238000002485 combustion reaction Methods 0.000 description 4
- 101001035137 Homo sapiens Homocysteine-responsive endoplasmic reticulum-resident ubiquitin-like domain member 1 protein Proteins 0.000 description 3
- 102100039923 Homocysteine-responsive endoplasmic reticulum-resident ubiquitin-like domain member 1 protein Human genes 0.000 description 3
- 239000002689 soil Substances 0.000 description 3
- 238000004590 computer program Methods 0.000 description 2
- 238000012937 correction Methods 0.000 description 2
- 230000007423 decrease Effects 0.000 description 2
- 239000000428 dust Substances 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000011156 evaluation Methods 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 230000005856 abnormality Effects 0.000 description 1
- 238000009825 accumulation Methods 0.000 description 1
- 230000001174 ascending effect Effects 0.000 description 1
- 238000009412 basement excavation Methods 0.000 description 1
- 238000003745 diagnosis Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 230000014509 gene expression Effects 0.000 description 1
- 239000005433 ionosphere Substances 0.000 description 1
- 238000002955 isolation Methods 0.000 description 1
- 239000004973 liquid crystal related substance 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
- 239000011159 matrix material Substances 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 239000013049 sediment Substances 0.000 description 1
- 230000011218 segmentation Effects 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/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
-
- 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/20—Instruments for performing navigational calculations
-
- 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/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
-
- 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
- G05D1/028—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using a RF signal
- G05D1/0282—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using a RF signal generated in a local control room
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/20—Monitoring the location of vehicles belonging to a group, e.g. fleet of vehicles, countable or determined number of vehicles
- G08G1/207—Monitoring the location of vehicles belonging to a group, e.g. fleet of vehicles, countable or determined number of vehicles with respect to certain areas, e.g. forbidden or allowed areas with possible alerting when inside or outside boundaries
Definitions
- the present invention relates to a work machine control system, a work machine, a work machine management system, and a work machine management method.
- the vehicle When the vehicle travels on a general road, the vehicle may travel while acquiring road information and referring to the road information (see Patent Document 1).
- aspects of the present invention include a work machine control system, a work machine, a work machine management system, and a work machine management capable of efficiently extracting only necessary map data while suppressing an increase in the amount of data read into a storage unit. It aims to provide a method.
- a position detection device that detects a position of a work machine that travels along a travel route, and a non-contact sensor that detects an object near the travel route traveled by the work machine in a non-contact manner.
- a map data creation unit for creating management map data indicating a map of the mine management area based on the detection data of the position detection device and the detection data of the non-contact sensor; and the management area is divided and set A first storage unit that stores division map data indicating a map of the divided areas, a second storage unit different from the first storage unit, and the first storage based on detection data of the position detection device
- An update unit for determining specific map data from the plurality of divided map data stored in the unit and reading the specific map data into the second storage unit; and reading into the second storage unit.
- a work machine including the work machine control system according to the first aspect.
- a work machine management system including a management device that outputs course data defining the travel route to the work machine according to the second aspect.
- the detection data of the position detection device that detects the position of the work machine that travels along the travel route and the object near the travel route that the work machine travels are detected in a non-contact manner.
- the specific map data determined based on the second storage unit different from the first storage unit, the specific map data read into the second storage unit and the previous Working machine management method comprising, and calculating the position of the working machine by collating the detection data of the non-contact sensor is provided.
- an increase in the amount of data read into the storage unit is suppressed, and a work machine control system, a work machine, a work machine management system, and a work machine that can efficiently extract only necessary map data A management method is provided.
- FIG. 1 is a diagram illustrating an example of a work machine management system according to the first embodiment.
- FIG. 2 is a control block diagram of the dump truck according to the first embodiment.
- FIG. 3 is a hardware configuration diagram of the dump truck according to the first embodiment.
- FIG. 4 is a diagram illustrating a part of map data stored in the map storage database of the control system according to the first embodiment.
- FIG. 5 is an enlarged view of the XIV part in FIG.
- FIG. 6 is an example of a flowchart of the control system according to the first embodiment.
- FIG. 7 is an example of a flowchart of step ST4.
- FIG. 8 is an example of a flowchart of step ST6.
- FIG. 9 is a diagram illustrating an example of a management area according to the first embodiment.
- FIG. 9 is a diagram illustrating an example of a management area according to the first embodiment.
- FIG. 10 is a diagram illustrating an example of management map data, divided map data, and specific map data according to the first embodiment.
- FIG. 11 is a flowchart showing an example of the operation of the dump truck 2 in SMN traveling.
- FIG. 12 is a schematic diagram showing a state in which specific map data to be read into the storage unit is changed by the movement of the dump truck.
- FIG. 13 is a schematic diagram illustrating a state in which specific map data to be read into the storage unit is changed by moving the dump truck.
- FIG. 14 is a schematic diagram showing a state in which specific map data to be read into the storage unit is changed by moving the dump truck.
- FIG. 15 is a diagram schematically illustrating a plurality of divided areas into which the management area is divided.
- FIG. 16 is a schematic diagram for explaining a method of calculating the divided map ID after the change.
- FIG. 17 is a flowchart illustrating the operation of the dump truck in creating map data according to the second embodiment.
- FIG. 18 is a schematic diagram for explaining the operation of the map storage database according to the second embodiment.
- FIG. 19 is a schematic diagram for explaining a process of calculating a logical sum of divided map data MIp according to the second embodiment.
- FIG. 20 is a schematic diagram showing the configuration of the dump truck 2.
- FIG. 21 is a schematic diagram showing the configuration of the management system.
- FIG. 1 is a diagram illustrating an example of a management system 1 for a work machine 4 according to the first embodiment.
- the work machine 4 is a mining machine operating in a mine will be described.
- the work machine 4 is appropriately referred to as a mining machine 4.
- the work machine 4 may not be a work machine operating in a mine.
- Management system 1 manages the mining machine 4.
- the management of the mining machine 4 is at least one of operation management of the mining machine 4, evaluation of the productivity of the mining machine 4, evaluation of operation technology of the operator of the mining machine 4, maintenance of the mining machine 4, and abnormality diagnosis of the mining machine 4. Including one.
- Mining machine 4 is a general term for machines used for various operations in a mine.
- the mining machine 4 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 mining machine for excavating a mine.
- the loading machine is a mining machine for loading a load on a transporting machine.
- the loading machine includes at least one of a hydraulic excavator, an electric excavator, and a wheel loader.
- the transporting machine includes a moving body such as a dump truck movable in the mine, and is a mining machine for transporting a load.
- the load includes at least one of sediment and ore generated by mining.
- the crusher crushes the soil discharged from the transport machine.
- Embodiment 1 an example in which a dump truck 2 that is a transport machine capable of traveling in a mine is managed by the management system 1 will be described.
- the dump truck 2 travels at least a part of the mine work area PA and the conveyance path HL leading to the work place PA.
- the work place PA includes at least one of a loading place LPA and a dumping place DPA.
- the conveyance path HL includes an intersection IS.
- the dump truck 2 travels on a travel route RP set in the mine.
- An object is provided beside the travel route RP.
- the object provided beside the travel route RP is the bank BK.
- the object provided beside the travel route RP may be a wall or an artificially manufactured structure.
- the object may include metal or concrete.
- the dump truck 2 is a movable body that can move in the mine.
- the travel route RP is set to at least a part of the loading site LPA, the earth removal site DPA, and the transport route HL.
- the loading site LPA is an area where loading work for loading the dump truck 2 is performed.
- the earth removal site DPA is an area where a discharging operation for discharging the load from the dump truck 2 is performed.
- a crusher CR is provided in at least a part of the soil disposal site DPA.
- the dump truck 2 is a so-called unmanned dump truck that autonomously travels on the travel route RP based on a command signal from the management device 10.
- the autonomous traveling of the dump truck 2 refers to traveling based on a command signal from the management device 10 without depending on the operator's operation.
- the dump truck 2 may travel by an operator's operation.
- a management system 1 is a mine that is a management device 10 disposed in a control facility 7 installed in a mine, a communication system 9, a dump truck 2, and another mining machine 4 different from the dump truck 2.
- the management device 10 is installed in the mine control facility 7 and does not substantially move.
- the management apparatus 10 may be movable.
- the communication system 9 wirelessly communicates data or command signals among the management device 10, the dump truck 2, and other mining machines 3.
- the communication system 9 can bidirectionally wirelessly communicate between the management device 10 and the dump truck 2, between the management device 10 and another mining machine 3, and between the dump truck 2 and another mining machine 3.
- the communication system 9 includes a plurality of repeaters 6 that relay data or command signals (radio waves).
- the position of the dump truck 2 and the position of the other mining machine 3 are detected using RTK-GNSS (Real Time Kinematic-Global Navigation Satellite System).
- GNSS refers to the global navigation satellite system.
- GPS Global Positioning System
- the RTK-GNSS has a plurality of positioning satellites 5.
- the RTK-GNSS detects a position defined by latitude, longitude, and altitude coordinate data.
- the position detected by RTK-GNSS is an absolute position defined in the global coordinate system.
- the position of the dump truck 2 and the position of other mining machines 3 in the mine are detected by the RTK-GNSS.
- the position detected by the RTK-GNSS will be referred to as a GPS position as appropriate.
- the GPS position is an absolute position and is coordinate data of latitude, longitude, and altitude.
- the positioning state changes due to the influence of at least one of the positioning satellite 5 arrangement, the ionosphere, the troposphere, and the topography around the antenna that receives data from the positioning satellite 5.
- the positioning state includes a Fix solution (accuracy ⁇ 1 cm to about 2 cm), a Float solution (accuracy ⁇ 10 cm to about several meters), a Single solution (accuracy ⁇ about several meters), and non-positioning (positioning calculation impossible).
- the management system 1 determines the position and orientation of the dump truck 2 in the mine, Manage position and orientation.
- the direction of the dump truck 2 and the direction of the other mining machines 3 are managed such that the north is zero degrees, the east is 90 degrees, the south is 180 degrees, and the west is 270 degrees.
- the direction of the dump truck 2 and the direction of the other mining machine 3 are the traveling directions of the traveling dump truck 2 and the other mining machine 3.
- the management device 10 transmits data and a command signal to the dump truck 2 and receives data from the dump truck 2.
- the management device 10 includes a computer 11, a display device 16, an input device 17, a wireless communication device 18, and a GPS base station 19.
- the computer 11 includes a processing device 12, a storage device 13, and an input / output unit (input / output interface) 15.
- the display device 16, the input device 17, the wireless communication device 18, and the GPS base station 19 are connected to the computer 11 via the input / output unit 15.
- 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 processes the position data of the dump truck 2 and the position data of other mining machines 3 acquired via the communication system 9.
- the processing device 12 sets a travel route RP along which the dump truck 2 travels.
- the travel route RP is defined by the course data.
- the course data is a collection of a plurality of points each having an absolute position.
- the processing device 12 functions as a course data creation unit that creates course data of the dump truck 2.
- the processing device 12 creates course data and sets a travel route RP.
- the storage device 13 is connected to the processing device 12.
- the storage device 13 stores various data related to management of the dump truck 2 and various data related to management of other mining machines 3.
- the storage device 13 stores position data of the dump truck 2 and position data of other mining machines 3.
- the storage device 13 stores a computer program for causing the processing device 12 to execute various processes.
- the display device 16 includes a flat panel display such as a liquid crystal display.
- the display device 16 can display the position data of the dump truck 2 and the position data of other mining machines 3.
- the input device 17 includes at least one of a keyboard, a touch panel, and a mouse.
- the input device 17 functions as an operation unit that can input an operation signal to the processing device 12.
- the wireless communication device 18 is disposed in the control facility 7.
- the wireless communication device 18 is a part of the communication system 9.
- the wireless communication device 18 is connected to the processing device 12 via the input / output unit 15.
- the wireless communication device 18 has an antenna 18A.
- the wireless communication device 18 can receive data transmitted from at least one of the dump truck 2 and the other mining machine 3. Data received by the wireless communication device 18 is output to the processing device 12 and stored in the storage device 13.
- the wireless communication device 18 can transmit data to at least one of the dump truck 2 and the other mining machine 3.
- the GPS base station 19 is disposed in the control facility 7.
- the GPS base station 19 includes an antenna 19A that receives data from a plurality of positioning satellites 5, and a transmission / reception device 19B connected to the antenna 19A.
- the transceiver 19B includes a receiver that receives data from the positioning satellite 5 via the antenna 19A, a transmitter that transmits data to the dump truck 2 via the antenna 19C, and a micro processor such as a CPU (Central Processing Unit).
- An arithmetic processing unit having a processor and a storage device having a memory such as a ROM (Read Only Memory) or a RAM (Random Access Memory) are provided.
- the transmitting / receiving device 19B calculates the GPS position of the GPS base station 19 based on the data received via the antenna 19A, and generates corrected observation data for correcting the GPS position of the dump truck 2.
- the transmission / reception device 19B transmits the corrected observation data to the dump truck 2 and other mining machines 3 via the antenna 19C.
- the computer 11 includes a communication input / output unit 15, an arithmetic processing unit having a microprocessor such as a CPU (Central Processing Unit) for executing a control program, and a ROM (Read Only Memory) for storing the control program.
- a microprocessor such as a CPU (Central Processing Unit) for executing a control program
- ROM Read Only Memory
- An external storage device a main storage device (internal storage device) such as RAM (Random Access Memory) used as a work area for the CPU, and an external storage device such as a nonvolatile memory in which data is registered by the CPU (auxiliary Storage device).
- the function of the processing device 12 is realized by the CPU reading a control program stored in the ROM and executing it in the work area of the RAM.
- the function of the storage device 13 is realized by storing a control program in the ROM and registering data in the nonvolatile memory by the CPU.
- the nonvolatile memory includes at least one of a flash memory and a hard disk drive, and realizes the database 13B.
- a plurality of processing circuits may cooperate to realize the functions of the processing device 12 and the storage device 13.
- the other mining machine 3 is a mining machine other than the dump truck 2 and is operated by an operator's operation.
- the other mining machine 3 includes a CPU (Central Processing Unit) and executes various processes related to work contents, a GPS receiver that detects a GPS position, a wireless communication device 18 of the control facility 7, and data. And a wireless communication device for transmitting and receiving. In other mining machines 3, the wireless communication device transmits the GPS position to the wireless communication device 18 of the control facility 7 at predetermined time intervals.
- CPU Central Processing Unit
- FIG. 2 is a control block diagram of the dump truck 2 according to the first embodiment.
- FIG. 3 is a hardware configuration diagram of the dump truck 2 according to the first embodiment.
- the dump truck 2 includes a vehicle main body 21, a vessel 22, wheels 23, a non-contact sensor 24, and a control system 30.
- the vehicle body 21 is provided with an internal combustion engine 2E such as a diesel engine, a generator 2G that operates by the internal combustion engine 2E, and an electric motor 23M that operates by electric power generated by the generator.
- the wheel 23 includes a front wheel 23F and a rear wheel 23R.
- the rear wheel 23R is driven by the electric motor 23M.
- the power of the internal combustion engine 2E may be transmitted to the rear wheel 23R via a transmission including a torque converter.
- the vehicle body 21 is provided with a steering device 2S that steers the front wheels 23F.
- a load is loaded on the vessel 22 by a loading machine. In the discharging operation, the vessel 22 is lifted and the load is discharged from the vessel 22.
- the non-contact sensor 24 is disposed at the lower part of the front part of the vehicle main body 21.
- the non-contact sensor 24 detects an object around the dump truck 2 in a non-contact manner.
- Objects around the dump truck 2 include objects (obstacles) present on the travel route RP and objects (bank BK) present along the travel route RP.
- the non-contact sensor 24 functions as an obstacle sensor that detects an obstacle in front of the dump truck 2 in a non-contact manner.
- the non-contact sensor 24 can detect the relative position of the object with respect to the non-contact sensor 24 (dump truck 2).
- the non-contact sensor 24 includes a radar 24A and a laser sensor 24B.
- the resolution of the laser sensor 24B is higher than the resolution of the radar 24A.
- the non-contact sensor 24 including the radar 24A and the laser sensor 24B is connected to the second communication line 37A of the control system 30.
- the laser sensor 24 ⁇ / b> B is connected to the position measurement controller 33 of the control system 30.
- FIG. 4 is a diagram illustrating a part of the map data MI stored in the map storage database 36 of the control system 30 according to the first embodiment.
- FIG. 5 is an enlarged view of the XIV part in FIG.
- the control system 30 is installed in the dump truck 2.
- the control system 30 makes the dump truck 2 autonomously travel according to the travel route RP.
- the control system 30 includes a gyro sensor 26, a speed sensor 27, a GPS receiver 31, a travel route creation device 32, a position measurement controller 33, a travel controller 20, and a non-contact sensor 24.
- the control system 30 includes a first signal line 35, a second signal line 37, and a safety controller 40.
- the travel controller 20, the travel route creation device 32, the position measurement controller 33, the map storage database 36, and the safety controller 40 are connected to the first communication line 35.
- the travel controller 20, the travel route creation device 32, the position measurement controller 33, the map storage database 36, and the safety controller 40 are in data communication via the first communication line 35.
- the travel controller 20 and the safety controller 40 are also connected to the second communication line 37A.
- the travel controller 20 and the safety controller 40 perform data communication via the second communication line 37A.
- the standard of communication using the first communication line 35 and the second communication line 37A is CAN (Controller Area Network) standardized as ISO11898 and ISO11519.
- the gyro sensor 26 detects the direction (direction change amount) of the dump truck 2.
- the gyro sensor 26 is connected to the travel controller 20.
- the gyro sensor 26 outputs detection data to the travel controller 20.
- the traveling controller 20 calculates the direction (direction change amount) of the dump truck 2 based on the detection data of the gyro sensor 26.
- the speed sensor 27 detects the traveling speed of the dump truck 2.
- the speed sensor 27 detects the rotational speed of the wheel 23 and detects the traveling speed of the dump truck 2.
- the speed sensor 27 is connected to the travel controller 20.
- the speed sensor 27 outputs detection data to the travel controller 20.
- the travel controller 20 calculates the travel distance of the dump truck 2 based on the detection data of the speed sensor 27 and the time data measured by a timer built in the travel controller 20.
- the GPS receiver 31 is provided in the dump truck 2.
- the GPS receiver 31 is a position detection device that detects the absolute position (GPS position) of the dump truck 2.
- An antenna 31A that receives data from the positioning satellite 5 and an antenna 31B that receives corrected observation data from the GPS base station 19 are connected to the GPS receiver 31.
- the antenna 31 ⁇ / b> A outputs a signal based on the data received from the positioning satellite 5 to the GPS receiver 31.
- the antenna 31B outputs a signal based on the received corrected observation data to the GPS receiver 31.
- the GPS receiver 31 detects the position (GPS position) of the antenna 31 ⁇ / b> A using the data from the positioning satellite 5 and the corrected observation data from the GPS base station 19.
- the GPS receiver 31 compares the data from the positioning satellite 5 with the corrected observation data from the GPS base station 19 to obtain the distance to the arbitrary positioning satellite 5 and checks the phase of the radio wave from the positioning satellite 5.
- the position of the antenna 31A is detected.
- the GPS receiver 31 detects the position (GPS position) of the dump truck 2 by detecting the position of the antenna 31A.
- the GPS receiver 31 detects, in the process of detecting the position of the antenna 31A, a fix solution, a float solution, or a single solution indicating the accuracy of the detected GPS position based on the number of positioning satellites 5 that the antenna 31A has received data. It is detected which one is.
- the accuracy of the GPS position of the Fix solution is the accuracy with which the dump truck 2 can autonomously travel.
- the accuracy of the GPS position of the float solution and the accuracy of the GPS position of the single solution are such that the dump truck 2 cannot travel autonomously.
- the GPS receiver 31 detects a Fix solution, Float solution, or Single solution indicating the accuracy of the detected GPS position, the GPS receiver 31 outputs a positioning signal indicating the GPS position accuracy and indicating that the GPS position has been calculated. To do.
- the GPS receiver 31 outputs a non-positioning signal indicating non-positioning when the GPS position cannot be calculated.
- the positioning signal or the non-positioning signal is output to the travel controller 20 and the position measurement controller 33 via the travel route creation device 32.
- the travel route creation device 32 includes a route position storage unit 32 ⁇ / b> A that stores course data generated by the processing device 12 of the management device 10.
- 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 can receive a command signal or data transmitted from at least one of the mining machine 4 other than the management device 10 and the host vehicle.
- the mining machine 4 other than the own vehicle includes a mining machine 4 other than the dump truck 2 such as a boring machine, an excavating machine, a loading machine, a transporting machine, and a vehicle driven by an operator, and a dump truck 2 other than the own vehicle. including.
- the wireless communication device 34 receives the course data transmitted from the wireless communication device 18 of the control facility 7 and the position data of the mining machine 4 other than the host vehicle, and outputs them to the travel route creation device 32 and the position measurement controller 33.
- the course data and the position data of the mining machine 4 other than the host vehicle are defined in the XY coordinate system.
- the travel route creation device 32 receives the course data and the location data of the mining machine 4 other than the host vehicle from the wireless communication device 34 and stores them in the route location storage unit 32A. Further, the travel route creation device 32 uses the wireless communication device 34 to transmit the position data and direction data of the dump truck 2 that is the host vehicle detected by the reference navigation calculation unit 33B of the travel controller 20 or the position measurement controller 33 via the wireless communication device 34. It transmits to the wireless communication device 18 of the control facility 7. In addition, the travel route creation device 32 is connected to the first communication line 35.
- the travel route creation device 32, the travel controller 20, and the position measurement controller 33 each include a computer. These computers operate according to the read computer program.
- the travel controller 20 receives the position data indicating the GPS position of the dump truck 2 detected by the GPS receiver 31 and the position data indicating the absolute position of the dump truck 2 calculated by the collation navigation calculation unit 33B of the position measurement controller 33. To do.
- the travel controller 20 includes position data indicating the GPS position of the dump truck 2 detected by the GPS receiver 31, and position data indicating the absolute position of the dump truck 2 calculated by the reference navigation calculation unit 33B of the position measurement controller 33. Based on at least one, the dump truck 2 autonomously travels according to the travel route RP defined by the course data.
- the travel controller 20 includes not only the position data of the dump truck 2 but also the direction data indicating the direction (direction change amount) of the dump truck 2 which is detection data of the gyro sensor 26 and the data of the dump truck 2 which is detection data of the speed sensor 27. Travel speed data indicating the travel speed is acquired.
- the travel controller 20 includes the position data of the dump truck 2 that is detection data of the GPS receiver 31, the travel speed data of the dump truck 2 that is detection data of the speed sensor 27, and the data of the dump truck 2 that is detection data of the gyro sensor 26. Based on the orientation data, the position and orientation of the dump truck 2 are calculated. Based on the GPS position when the GPS position is input from the GPS receiver 31 and the azimuth that is the detection result of the gyro sensor 26, the travel controller 20 determines the travel speed that is the detection result of the speed sensor 27 based on the time data from the timer. Integrate to detect position and orientation. The travel controller 20 converts the GPS position into a position in the XY coordinate system before, during, or after detecting the position and direction.
- the travel controller 20 has at least one of the accelerator of the dump truck 2, the braking device 23B, and the steering device 2S so that the position of the dump truck 2 overlaps the travel route RP, that is, the dump truck 2 travels according to the travel route RP. To control. By such control, the travel controller 20 causes the dump truck 2 to travel along the travel route RP.
- the function of the travel controller 20 is realized by the CPU reading a control program stored in the ROM and executing it in the work area of the RAM. A plurality of processing circuits may cooperate to realize the function of the travel controller 20.
- the position measurement controller 33 includes a determination unit 33A, a collation navigation position calculation unit 33B, a map data creation unit 33C, a storage unit 33D, an update unit 33E, and a position data acquisition unit 33F. Prepare.
- the position measurement controller 33 is connected to the first communication line 35.
- the position measurement controller 33 acquires the detection data of the gyro sensor 26 and the detection data of the speed sensor 27 via the first communication line 35 and the travel controller 20.
- the position measurement controller 33 is connected to the GPS receiver 31 via the wireless communication device 34, the travel route creation device 32, and the first communication line 35.
- the position measurement controller 33 acquires the detection data of the GPS receiver 31.
- the position measurement controller 33 detects the position data of the dump truck 2 detected by the GPS receiver 31 and the bank BK outside the travel route RP detected by the laser sensor 24B.
- the map data MI of the travel route RP including the position data of the bank BK is created based on the position data and stored in the map storage database 36.
- the determination unit 33A determines whether or not the GPS position error detected by the GPS receiver 31 is equal to or less than a predetermined error.
- the determination unit 33A determines whether or not the GPS position solution is a Fix solution. When the solution of the GPS position is the Fix solution, the determination unit 33A determines that the accuracy of the detected GPS position of the dump truck 2 is high and the error of the GPS position is equal to or less than a predetermined error.
- the GPS position solution is a float solution, when it is a single solution, or when the GPS position is non-positioning, the determination unit 33A determines that the accuracy of the detected GPS position of the dump truck 2 is low and the GPS position Is determined to exceed a predetermined error.
- the predetermined error is an error (accuracy) of the GPS position at which the dump truck 2 can autonomously travel according to the travel route RP by dead reckoning navigation to be described later.
- the GPS receiver 31 detects the GPS position and the solution, but the solution may be detected by another device (for example, the determination unit 33A).
- the map data creation unit 33C detects the detection result of the gyro sensor 26 and the detection result of the speed sensor 27. Based on the detection result of the laser sensor 24B, the position of the bank BK provided on at least one of the outer side of the loading field LPA, the outer side of the soil discharging field DPA, and the outer side of the transport path HL is detected. The position data is stored in the map storage database 36 as map data MI of the travel route RP.
- the map data creation unit 33C integrates the position and orientation of the dump truck 2 detected by the determination unit 33A and the detection result of the laser sensor 24B, deletes the detection results other than the bank BK from the integrated data, and performs the bank BK. The position of is detected.
- the map data creation unit 33C stores the map data in the map storage database 36.
- the map data MI includes the position in the XY coordinate system of the grid GR obtained by dividing the mine by a square (rectangle or square) of a predetermined size and the bank BK in each grid GR in plan view. Indicates whether or not it exists.
- Each grid GR of the map data MI includes binary data (1 bit data) indicating whether or not the bank BK exists, that is, “0” or “1”. As shown in FIGS. 4 and 5, in the first embodiment, each grid GR of the map data MI is indicated by a black square in the figure as “1” when there is a bank BK, and “0” when there is no bank BK. As white squares in the figure.
- the map storage database 36 stores the position data of the bank BK as the map data MI of the travel route RP.
- the map storage database 36 is connected to the first communication line 35.
- the map storage database 36 is an external storage device (auxiliary storage device) configured by at least one of a ROM (Read Only Memory), a flash memory, and a hard disk drive.
- the map storage database 36 includes a bank that surrounds the travel route RP from the detection result of the laser sensor 24B.
- the detection result regarding BK is extracted, and the detection result regarding the extracted bank BK is stored as map data MI of the travel route RP.
- the map storage database 36 stores the detection result detected by the map data creation unit 33C as map data MI every time the map data creation unit 33C detects it.
- the map data MI stored in the map storage database 36 is overwritten each time the map data creation unit 33C detects, but the present invention is not limited to this.
- the storage unit 33D is a main storage device (internal storage device) whose operating speed is faster than the map storage database 36.
- the storage unit 33D is configured by a RAM (Random Access Memory).
- the update unit 33E causes the storage unit 33D to read at least a part of the map data MI stored in the map storage database 36.
- the verification navigation calculation unit 33B detects the detection result of the gyro sensor 26 and the detection of the speed sensor 27. As a result, the position and orientation of the dump truck 2 are calculated based on the detection result of the laser sensor 24B and the map data MI read from the map storage database 36 into the storage unit 33D and stored in the storage unit 33D.
- the position data acquisition unit 33F acquires position data indicating the absolute position of the dump truck 2. Position data indicating the absolute position of the dump truck 2 is detected by the GPS receiver 31. Further, the position data indicating the absolute position of the dump truck 2 is calculated by the verification navigation calculation unit 33B. The position data acquisition unit 33F acquires position data indicating the absolute position of the dump truck 2 from at least one of the GPS receiver 31 and the reference navigation calculation unit 33B.
- the position measurement controller 33 detects the position data and direction of the dump truck 2 that is the host vehicle detected by the GPS receiver 31 or the reference navigation calculation unit 33B. Data is transmitted to the wireless communication device 18 of the control facility 7 via the wireless communication device 34.
- the position measurement controller 33 includes an observation point coordinate conversion unit 38 and an observation point availability determination unit 39.
- the observation point coordinate conversion unit 38 converts the position of the detection result of the laser sensor 24B indicated by coordinates defined by the direction and distance from the laser sensor 24B into the XY coordinate system.
- the position of the detection result whose coordinates are converted by the observation point coordinate conversion unit 38 is defined by the X-axis direction and the height direction (Z-axis direction) orthogonal to the Y-axis direction in addition to the X-axis direction and the Y-axis direction.
- the observation point availability determination unit 39 acquires the position data of the mining machine 4 other than the host vehicle from the route position storage unit 32A.
- the observation point availability determination unit 39 detects various noises from the detection results obtained by converting the coordinates by the observation point coordinate conversion unit 38, detection results below a predetermined height from the ground surface, and the mining machine 4 other than the host vehicle. Remove expected detection results.
- the observation point availability determination unit 39 combines the detection result of the laser sensor 24B from which noise has been removed with the detection result of the grid GR.
- the observation point availability determination unit 39 outputs the combined detection result to both the map data creation unit 33C and the matching navigation calculation unit 33B.
- the safety controller 40 obtains the relative position between the dump truck 2 and the object (obstacle) based on the detection signals of the radar 24A and the laser sensor 24B, and outputs the relative position to the travel controller 20.
- the travel controller 20 generates a command for controlling at least one of the accelerator, the braking device 23B, and the steering device 2S using the relative position with respect to the object, and controls the dump truck 2 based on the command to Avoid collision of the track 2 with the object.
- the traveling controller 20 determines that the determination unit 33A determines that the GPS position solution is a float solution, a single solution, or that the GPS position is non-positioned after a predetermined time, and the reference navigation calculation unit 33B When the estimation accuracy and reliability of the map data MI stored in the storage database 36 are only a predetermined value and the detection result of the laser sensor 24B lower than the predetermined reliability, the vehicle main body 21 is connected to the travel controller 20. A command for controlling the braking device 23B to be stopped is output.
- FIG. 6 is an example of a flowchart of the control system 30 according to the first embodiment.
- FIG. 7 is an example of a flowchart of step ST4 in FIG.
- FIG. 8 is an example of a flowchart of step ST6 in FIG.
- the processing device 12 transmits a command signal to the travel route creation device 32 and the position measurement controller 33 of the dump truck 2 via the wireless communication device 18.
- the command signal includes travel condition data indicating the travel condition of the dump truck 2 and position data of the mining machine 4 other than the host vehicle.
- the traveling condition data includes course data generated by the processing device 12 and traveling speed data of the dump truck 2.
- the travel route creation device 32 stores the course data and the position data of the mining machine 4 other than the host vehicle in the command signal from the processing device 12 transmitted via the communication system 9 in the route position storage unit 32A.
- the position measurement controller 33 transmits the position data and direction data of the dump truck 2 that is the host vehicle to the processing device 12 via the wireless communication device 34. To do.
- the travel controller 20 controls the travel of the dump truck 2 by controlling the accelerator of the dump truck 2, the braking device 23B, and the steering device 2S based on the command signal from the processing device 12.
- the management device 10 causes the dump truck 2 to travel according to the travel route RP in only three travel modes.
- the first travel mode is a dead reckoning travel mode in which the dump truck 2 travels based on dead reckoning.
- the second travel mode is a GPS travel mode in which the dump truck 2 travels based on detection data from the GPS receiver 31.
- position data indicating the absolute position of the dump truck 2 is calculated based on the map data MI and the detection data of the non-contact sensor 24, and the dump truck is calculated based on the calculated position data of the dump truck 2.
- 2 is a verification navigation driving mode in which the vehicle 2 is driven. In the verification navigation travel mode, the position data of the dump truck 2 is calculated by the verification navigation calculation unit 33B.
- map data creation processing is performed, and map data MI created in the map data creation processing is stored in the map storage database 36.
- Dead reckoning refers to navigation in which the current position of the target object (dump truck 2) is estimated based on the azimuth (azimuth change) from a known position and the moving distance.
- the azimuth (azimuth change amount) of the dump truck 2 is detected by using a gyro sensor 26 disposed on the dump truck 2.
- the moving distance of the dump truck 2 is detected using a speed sensor 27 arranged on the dump truck 2.
- the detection signal of the gyro sensor 26 and the detection signal of the speed sensor 27 are output to the travel controller 20 of the dump truck 2.
- the traveling controller 20 can obtain the direction (direction change amount) of the dump truck 2 from a known starting point based on the detection signal from the gyro sensor 26.
- the travel controller 20 can determine the moving distance of the dump truck 2 from a known starting point based on the detection signal from the speed sensor 27.
- the travel controller 20 controls the travel of the dump truck 2 based on the detection signal from the gyro sensor 26 and the detection signal from the speed sensor 27 so that the dump truck 2 travels according to the course data set in the travel route RP. Generate quantity.
- the control amount includes an accelerator signal, a braking signal, and a steering signal.
- the travel controller 20 controls the travel (operation) of the dump truck 2 based on the steering signal, the accelerator signal, and the braking signal.
- the travel controller 20 calculates the position (estimated position) of the dump truck 2 derived (estimated) by dead reckoning by the GPS position data detected by the GPS receiver 31 or the collation navigation calculation unit 33B. The dump truck 2 is made to travel while correcting using the position data.
- the dump truck 2 is driven by combining the dead reckoning travel mode and at least one of the GPS travel mode and the verification navigation travel mode.
- the dump truck 2 may travel only in the dead reckoning traveling mode, may travel only in the GPS traveling mode, or may travel only in the reference navigation traveling mode.
- the traveling controller 20 Based on the detection signal from the gyro sensor 26, the detection signal from the speed sensor 27, and the GPS position from the GPS receiver 31 or the position detected by the collation navigation calculation unit 33B, the traveling controller 20 A control amount related to the traveling of the dump truck 2 is calculated, including a correction amount for correcting the position of the dump truck 2 so as to travel according to the traveling route RP defined by the course data.
- the travel controller 20 controls the travel (operation) of the dump truck 2 based on the calculated correction amount and control amount so that the dump truck 2 travels according to the travel route RP.
- the travel controller 20 of the control system 30 executes step ST1 of causing the dump truck 2 to travel by dead reckoning according to the course data set in the travel route RP based on the GPS position of the dump truck 2 detected by the GPS receiver 31. .
- the travel controller 20 loads the loading site LPA according to the course data generated by the processing device 12 of the management device 10 and the travel condition data including the travel speed (target travel speed) set by the processing device 12.
- the dump truck 2 is caused to travel in at least a part of the earth removal site DPA and the conveyance path HL.
- the determination unit 33A of the position measurement controller 33 executes step ST2 for determining whether or not the GPS position error of the dump truck 2 detected by the GPS receiver 31 is equal to or less than a predetermined error. That is, in step ST2, the determination unit 33A of the position measurement controller 33 determines whether or not the accuracy of the GPS position of the dump truck 2 detected by the GPS receiver 31 is high. Specifically, the determination unit 33A of the position measurement controller 33 determines whether the GPS position solution detected by the GPS receiver 31 is a Fix solution. The determination unit 33A of the position measurement controller 33 determines that the solution of the GPS position detected by the GPS receiver 31 is a Fix solution, that is, the error of the GPS position of the dump truck 2 detected by the GPS receiver 31 is a predetermined value.
- step ST2 If it is determined that the error is equal to or less than the error (step ST2: Yes), whether or not the state of the dump truck 2 is a state that reduces the accuracy of the map data MI, that is, data relating to the detected position of the bank BK is used for map storage. It is determined whether or not the accuracy of the map data MI stored in the database 36 is to be lowered (step ST3).
- the determination unit 33A of the position measurement controller 33 determines whether or not the traveling speed of the dump truck 2 is zero based on the detection signal of the speed sensor 27, that is, the state of the dump truck 2 Determines whether or not the dump truck 2 is in a state where the accuracy of the map data MI is lowered.
- the dump truck 2 whose traveling speed is zero is stopped, noise is mixed in the map information MI due to dust generated by the operation of the mining machine 4 other than the own vehicle, and the accuracy of the map information MI is lowered. Because it may be.
- step ST3 determines that the state of the dump truck 2 is not in a state of reducing the accuracy of the map data MI (step ST3: No).
- the map data creation unit 33C performs map data creation processing.
- the map data creation unit 33C creates map data MI (step ST4). That is, when the position measurement controller 33 determines that the GPS position error detected by the GPS receiver 31 is equal to or less than a predetermined error, the position measurement controller 33 based on the GPS position of the dump truck 2 detected by the GPS receiver 31.
- the dump truck 2 autonomously travels in accordance with the course data stored in 32A, extracts the detection result for the bank BK from the detection result of the laser sensor 24B, and saves the extracted detection result for the bank BK as map data MI of the travel route RP.
- Step ST4 stored in the database 36 is executed. Specifically, first, the observation point coordinate conversion unit 38 indicates the position of the detection result of the laser sensor 24B indicated by the coordinates specified by the direction and the distance from the laser sensor 24B, in the coordinates indicated by the XY coordinates. (Step ST41).
- the observation point availability determination unit 39 extracts the detection result related to the bank BK from the detection result obtained by converting the coordinates by the observation point coordinate conversion unit 38 (step ST42).
- the observation point availability determination unit 39 extracts the detection result related to the bank BK, first, the observation point coordinate conversion unit 38 removes various noises from the detection result obtained by converting the coordinates.
- the observation point availability determination unit 39 synthesizes the detection result from which various noises and the like are removed into a detection result whose position is indicated in the XY coordinate system and is configured by a grid GR having a predetermined size.
- the observation point availability determination unit 39 outputs the combined detection result to both the map data creation unit 33C and the matching navigation calculation unit 33B.
- the map data creation unit 33C of the position measurement controller 33 stores the position of the bank BK, which is the detection result synthesized by the observation point availability determination unit 39, in the map storage database 36 as the map data MI of the travel route RP (step ST43). ).
- control system 30 executes step ST1 to step ST4, so that the error in the GPS position of the dump truck 2 detected by the GPS receiver 31 is equal to or less than a predetermined error, and the speed sensor 27 is 2 is detected from the detection result of the laser sensor 24B while it is determined that the state of the dump truck 2 is not in a state of lowering the accuracy of the map data MI.
- the detection result regarding the extracted bank BK is continuously stored as the map data MI of the travel route RP.
- step ST3: Yes determines that the state of the dump truck 2 is a state that reduces the accuracy of the map data MI.
- the storage of the map data MI is paused (step ST10), and the process returns to step ST1.
- the ROM (external storage device) 333 of the position measurement controller 33 stores a program that causes the position measurement controller 33, which is a computer, to execute step ST3, step ST4, and step ST10.
- the control system 30 pauses the storage of the map data MI (step ST10).
- the map storage database 36 causes the speed sensor 27 to detect that the dump truck 2 has stopped, that is, the state of the dump truck 2 reduces the accuracy of the map data MI. While it is determined that the vehicle is in the state, the storage of the map data MI of the travel route RP is suspended.
- the determination unit 33A of the position measurement controller 33 determines that the solution of the GPS position detected by the GPS receiver 31 is not a Fix solution, that is, the error of the GPS position of the dump truck 2 detected by the GPS receiver 31 is If it is determined that the predetermined error has been exceeded (step ST2: No), whether or not the state of the dump truck 2 is a state that decreases the position measurement accuracy, that is, the position of the bank BK detected by the grid map creation unit 33C. It is determined whether or not the position measurement accuracy stored in the map storage database 36 is reduced (step ST5).
- the determination unit 33A of the position measurement controller 33 determines whether or not the traveling speed of the dump truck 2 is zero based on the detection signal of the speed sensor 27, that is, the state of the dump truck 2 Determines whether or not the dump truck 2 is in a state of lowering the position measurement accuracy.
- the dump truck 2 whose traveling speed is zero is stopped, noise is mixed into the detection result of the laser sensor 24B due to dust generated by the operation of the mining machine 4 other than the own vehicle, and the collation navigation calculation unit 33B. This is because the accuracy of position measurement may be reduced. Moreover, it is because the position of the dump truck 2 does not change when the dump truck 2 whose traveling speed is zero is stopped.
- step ST5 determines that the state of the dump truck 2 is not in a state of reducing the position measurement accuracy
- the navigation calculation unit 33B calculates the position and orientation of the dump truck 2 based on the detection data of the laser sensor 24B and the map data MI stored in the map storage database 36 and read into the storage unit 33D.
- the dump truck 2 is made to collate and travel according to the route RP (step ST6). That is, if the position measurement controller 33 determines that the GPS position error detected by the GPS receiver 31 exceeds a predetermined error, the position measurement controller 33 and the map data MI stored in the map storage database 36 are stored in the map storage database 36. Are detected to detect the position and orientation of the dump truck 2.
- the observation point coordinate conversion unit 38 converts the position of the detection result of the laser sensor 24B indicated by the coordinates defined by the direction and distance from the laser sensor 24B into the position of the XY coordinates (step ST61).
- the observation point availability determination unit 39 extracts the detection result related to the bank BK from the detection result obtained by converting the coordinates by the observation point coordinate conversion unit 38 (step ST62). Since step ST61 is the same process as step ST41, and step ST62 is the same process as step ST42, detailed description thereof will be omitted.
- the collation navigation calculation unit 33B passes the detection result from which the noise has been removed by the observation point availability determination unit 39 through an isolation filter, and thins out the detection result (step ST63). Specifically, the collation navigation calculation unit 33B leaves only the detection results that are a predetermined distance apart from the detection results from which noise has been removed by the observation point availability determination unit 39, and removes other detection results. By the processing in step ST63, the detection result of the laser sensor 24B can be reduced to about 5 to 1/6.
- the collation navigation calculation unit 33B uses the particle filter to detect the detection data of the gyro sensor 26, the detection data of the speed sensor 27, the detection data of the laser sensor 24B, and the map data MI stored in the map storage database 36 and read into the storage unit 33D.
- the position and orientation of the dump truck 2 are calculated by integrating with the PF (step ST64).
- the calculated plurality of positions and orientations are used as the plurality of positions and orientations calculated in step ST641 when step ST6 is executed next.
- the verification navigation calculation unit 33B detects the calculated position and orientation of the dump truck 2 from the detection result detected when the laser sensor 24B is out of order, and the detection result detected when the gyro sensor 26 is out of order. Detected from the detection results of the laser sensors 24B less than the predetermined number, the reliability is lower than the predetermined reliability, the likelihood is lower than the predetermined value, and the estimation accuracy is lower than the predetermined value If the gap between the position and the direction by the dead reckoning navigation is larger than the predetermined value and does not correspond to all of the detected data using the map data MI, the dead reckoning navigation using the detected position and the orientation ( Step ST1) is executed, and the position measurement controller 33 controls the travel (operation) of the dump truck 2 so that the dump truck 2 travels according to the travel route RP.
- step ST1, step ST2, step ST5, and step ST6, so that the error of the GPS position of the dump truck 2 detected by the GPS receiver 31 exceeds a predetermined error, and While the speed sensor 27 detects that the dump truck 2 is not stopped, that is, while it is determined that the state of the dump truck 2 is not in a state of lowering the position measurement accuracy, the laser sensor 24B.
- the position and orientation of the dump truck 2 are continuously detected by collating the detection result with the map data MI of the travel route RP stored in the map storage database 36. Based on the detected position and direction of the dump truck 2, To run the track 2.
- step ST5 determines that the dump truck 2 is stopped, that is, determines that the state of the dump truck 2 is a state that decreases the position measurement accuracy (step ST5: Yes), step ST1. Return to.
- the determination unit 33A determines that the state of the dump truck 2 is a state in which the position measurement accuracy is lowered (step ST5: Yes)
- the position measurement controller 33 causes the speed sensor 27 to return to the dump truck by returning to step ST1.
- the detection result of the laser sensor 24B and the map storage database 36 are By detecting the stored map data MI of the travel route RP, the detection of the position and direction of the dump truck 2 is suspended.
- the dump truck 2 non-contacts the GPS receiver 31 that is a position detection device that detects the GPS position of the dump truck 2, the travel route RP that the dump truck 2 travels, and the bank BK that is an object near the travel route RP. And a laser sensor 24B which is a non-contact sensor to detect.
- the map data creation unit 33C creates map data MI of the mine travel route RP including the bank BK based on the detection data of the GPS detector 31 and the detection data of the laser sensor 24B.
- the map data MI created by the map data creation unit 33C is stored in the map storage database 36.
- the map data creation process is performed when the error in the GPS position of the dump truck 2 detected by the GPS receiver 31 is equal to or less than a predetermined error.
- the map data MI stored in the map storage database 36 is read into the storage unit 33D having an operation speed higher than that of the map storage database 36.
- the collation navigation calculation unit 33B collates the map data MI read from the map storage database 36 into the storage unit 33D and the detection data of the laser sensor 24B, and calculates the position of the dump truck 2.
- the travel controller 20 functioning as a travel control unit is based on the position of the dump truck 2 calculated by the collation navigation calculation unit 33B and the travel route RP (course data) set by the processing device 12 and the travel route creation device 32. Then, the dump truck 2 is caused to travel.
- the storage unit (RAM) 33D needs to be increased in capacity.
- the verification navigation traveling of the dump truck 2 only the map data MI around the traveling dump truck 2 among the map data MI stored in the map storage database 36 is detected by the laser sensor 24B. What is necessary is just to collate with data DR2.
- the calculation process extraction process
- management map data MIm indicating a map of a predetermined area (management area) of a mine created by the map data creation unit 33C is divided into a plurality of divided map data MIp.
- the predetermined area (management area) is an area where the dump truck 2 operates.
- the division map data MIp indicates a map of each of a plurality of division areas set by dividing the mine management area.
- the map storage database 36 which is the first storage unit, stores a plurality of divided map data MIp.
- the updating unit 33E is based on the plurality of divided map data MIp stored in the map storage database 36 based on the position data indicating the absolute position of the dump truck 2 acquired by the position data acquiring unit 33F.
- the specific map data MIf is determined, and the determined specific map data MIf is read into the storage unit 33D which is the second storage unit.
- the collation navigation calculation unit 33B collates the specific map data MIf read into the storage unit 33D with the detection data of the laser sensor 24B, and calculates the absolute position of the dump truck 2.
- the travel controller 20 controls the travel of the dump truck 2 so that the dump truck 2 travels according to the set course data based on the absolute position of the dump truck 2 calculated by the verification navigation calculation unit 33B.
- FIG. 9 is a diagram illustrating an example of a management area.
- the management area is a predetermined area of the mine. As shown in FIG. 9, a travel route RP including a plurality of transport paths HL and a plurality of intersections IS is set in the management area.
- the outer shape of the management area is substantially rectangular.
- FIG. 10 is a diagram illustrating an example of the management map data MIm, the divided map data MIp, and the specific map data MIf.
- management map data MIm indicating a management area is divided into a plurality of divided map data MIp.
- the outer shape of the divided area is substantially square.
- the specific map data MIf is determined based on position data indicating the absolute position of the dump truck 2 acquired by the position data acquisition unit 33F.
- the absolute position of the dump truck 2 is detected by the GPS detector 31. Further, the absolute position of the dump truck 2 is calculated by the verification navigation calculation unit 33B.
- the position data acquisition unit 33F acquires the position data of the dump truck 2 from at least one of the GPS detector 31 and the collation navigation calculation unit 33B.
- the specific map indicated by the specific map data MIf is determined so as to include the current position (absolute position) of the dump truck 2.
- the specific map data MIf is an aggregate of nine divided map data MIp.
- the specific map data MIf is divided map data MIpi indicating a divided area where the dump truck 2 exists, and a divided map indicating each of a plurality (eight) divided areas arranged around the divided area where the dump truck 2 exists. Data.
- the division map data MIp is defined by a plurality of grids GR.
- the absolute position of each of the plurality of grids GR is defined. In the global coordinate system, the coordinate data in the XY coordinate system of each of the plurality of grids GR is known data.
- Identification data (ID) is assigned to each of the plurality of grids GR. Also, identification data (ID) is assigned to each of the plurality of divided areas. For convenience, the grid GR is not shown in FIG.
- FIG. 11 is a flowchart showing an example of the operation of the dump truck 2 in the reference navigation traveling.
- the map storage database 36 stores the map data MI created in the map data creation process.
- the map data MI stored in the map storage database 36 includes management map data MIm and management map data created by the map data creation unit 33C based on the detection data of the GPS detector 31 and the detection data of the laser sensor 24B.
- the division map data MIp set by dividing MIm is included.
- Position data indicating the current absolute position of the dump truck 2 traveling on the travel route RP is detected by the GPS receiver 31 or the collation navigation calculation unit 33B.
- the update unit 33E of the position measurement controller 33 identifies the current position of the dump truck 2 and the grid GR corresponding to the current position of the dump truck 2 based on the position data of the dump truck 2 acquired by the position data acquisition unit 33F. To do.
- the updating unit 33E acquires the grid GR ID indicating the current position of the dump truck 2 and the ID of the divided area including the grid ID (step ST70).
- the update unit 33E determines specific map data MIf from the plurality of divided map data MIp stored in the map storage database 36 based on the ID of the divided area specified from the detection data of the GPS detector 31, and determines The specified map data MIf is read into the storage unit 33D (step ST71).
- the specific map data MIf includes the divided map data MIpi indicating the divided area where the dump truck 2 exists, and a plurality of divided areas arranged around the divided area where the dump truck 2 exists. Includes divided map data MIp.
- nine division map data MIp indicating each of the nine adjacent division areas are read into the storage unit 33D.
- the collation navigation calculation unit 33B collates the specific map data MIf read into the storage unit 33D with the detection data of the laser sensor 24, and calculates the absolute position of the dump truck 2 (step ST72).
- the travel controller 20 controls the travel of the dump truck 2 so that the dump truck 2 travels according to the course data set by the processing device 12 based on the absolute position of the dump truck 2 calculated by the reference navigation calculation unit 33B. (Step ST73).
- the current position of the dump truck 2 is changed, and after the vehicle position estimation step by collation navigation or dead reckoning is performed, the grid GR indicating the current position of the dump truck 2 and the grid GR are displayed.
- the containing divided area is changed.
- the updating unit 33E determines whether or not the divided area to which the current position of the dump truck 2 belongs is changed based on the position data indicating the current absolute position of the dump truck 2 acquired by the position data acquiring unit 33F. It is determined whether or not the division map ID in which the track 2 exists is changed (step ST74).
- step ST74 If it is determined in step ST74 that the division map ID has not been changed (step ST74: No), the control of the traveling of the dump truck 2 is continued.
- step ST74 If it is determined in step ST74 that the divided map ID has been changed (step ST74: Yes), the updating unit 33E calculates the changed divided map ID (step ST75).
- the update unit 33E determines the specific map data MIf from the plurality of divided map data MIp stored in the map storage database 36 based on the calculated divided area ID, and stores the determined specific map data MIf in the storage unit 33D. (Step ST76).
- the specific map data MIf is divided map data MIpi indicating the divided area where the dump truck 2 is present, and a plurality of divided areas arranged around the divided area where the dump truck 2 is present. Includes map data MIp.
- As specific map data MIf nine division map data MIp indicating each of the nine adjacent division areas are read into the storage unit 33D.
- the collation navigation calculation unit 33B collates the specific map data MIf read into the storage unit 33D with the detection data of the laser sensor 24, and calculates the absolute position of the dump truck 2 (step ST77).
- the travel controller 20 controls the travel of the dump truck 2 so that the dump truck 2 travels according to the course data set by the processing device 12 based on the absolute position of the dump truck 2 calculated by the reference navigation calculation unit 33B. (Step ST78).
- FIGS. 12, 13 and 14 are schematic diagrams showing a state in which the specific map data MIf read by the storage unit 33D is changed by the movement of the dump truck 2.
- FIG. 12, 13 and 14 show a state in which the dump truck 2 moves from the divided area Ap1 to the divided area Ap3 via the divided area Ap2.
- the divided area Ap1 and the divided area Ap2 are adjacent to each other.
- the divided area Ap2 and the divided area Ap3 are adjacent to each other.
- the divided area Ap3 is adjacent to the divided area Ap2 in the traveling direction of the dump truck 2 moving from the divided area Ap1 to the divided area Ap2.
- the update unit 33E can identify the divided area Ap in which the dump truck 2 exists based on the detection data of the GPS detector 31.
- the specific map data MIf1 read into the storage unit 33D is adjacent to the divided map data MIp indicating the divided area Ap1 and the divided area Ap1. And divided map data MIp indicating each of the plurality of divided areas Ap arranged around the divided area Ap1.
- the specific map data MIf1 read into the storage unit 33D in a state where the dump truck 2 exists in the divided area Ap1 includes nine divided map data MIp.
- the specific map data MIf2 read into the storage unit 33D is adjacent to the divided map data MIp indicating the divided area Ap2 and the divided area Ap2. And division map data MIp indicating each of the plurality of division areas Ap arranged around the division area Ap2.
- the specific map data MIf2 read into the storage unit 33D in a state where the dump truck 2 exists in the divided area Ap2 includes nine divided map data MIp.
- the specific map data MIf3 read into the storage unit 33D is adjacent to the divided map data MIp indicating the divided area Ap3 and the divided area Ap3. And divided map data MIp indicating each of the plurality of divided areas Ap arranged around the divided area Ap3.
- the specific map data MIf3 read into the storage unit 33D in a state where the dump truck 2 exists in the divided area Ap3 includes nine divided map data MIp.
- the specific map data MIf2 read into the storage unit 33D is different from the specific map data MIf3 read into the storage unit 33D when the dump truck 2 exists in the divided area Ap3.
- the updating unit 33E changes the specific map data Mif to be read by the storage unit 33D based on the detection data of the GPS detector 31.
- the update unit 33E determines that the dump truck 2 has moved from the divided area Ap1 to the divided area Ap2 based on the position data of the dump truck 2 acquired by the position data acquiring unit 33F, the update unit 33E stores the specific map data MIf2 in the storage unit
- the specific map data MIf read by 33D and stored in the storage unit 33D is changed from the specific map data MIf1 to the specific map data Mif2. Accordingly, the specific map data MIf stored in the storage unit 33D is updated from the specific map data MIf1 to the specific map data MIf2.
- the updating unit 33E determines that the dump truck 2 has moved from the divided area Ap2 to the divided area Ap3 based on the position data of the dump truck 2 acquired by the position data acquiring unit 33F
- the specific map data Mif3 Is read into the storage unit 33D and the specific map data MIf stored in the storage unit 33D is changed from the specific map data MIf2 to the specific map data MIf3.
- the specific map data MIf stored in the storage unit 33D is updated from the specific map data MIf2 to the specific map data MIf3.
- the divided map data MIp indicating the divided area Ap existing in the traveling direction of the dump truck 2 (forward in the traveling direction) as the dump truck 2 travels is the specific map.
- the division map data MIp indicating the division area Ap existing in the reverse direction of the traveling direction of the dump truck 2 (the rear of the traveling direction) is sequentially read as data MIf and sequentially erased from the storage unit 33D.
- the division map data MIp indicating the division area Ap4 arranged in the traveling direction of the dump truck 2 is not yet read into the storage unit 33D, but is stored in the map storage database 36.
- the updating unit 33E When it is determined that the dump truck 2 moves from the divided area Ap1 to the divided area Ap2, and the dump truck 2 moves from the divided area Ap1, through the divided area Ap2, to the divided area Ap3, the updating unit 33E The divided map data MIp indicating the divided area Ap4 stored in the map storage database 36 is read into the storage unit 33D.
- the update unit 33E causes the storage unit 33D to read the division map data MIp indicating the division area Ap5 that is stored in the map storage database 36 and that is arranged in the traveling direction of the dump truck 2 with respect to the division area Ap4.
- the updating unit 33E performs the operation on the divided area Ap1 stored in the storage unit 33D.
- the divided map data MIp indicating the divided area Ap5 arranged in the direction opposite to the traveling direction of the dump truck 2 is erased from the storage unit 33D.
- the content of the specific map data Mif1, the content of the specific map data MIf2, and the content of the specific map data Mif3 are different.
- the specific map data MIf1, the specific map data MIf2, and the specific map data MIf3 each include a data amount of nine divided map data MIp. That is, the data amount of the specific map data Mif1, the data amount of the specific map data MIf2, and the data amount of the specific map data MIf3 are equal.
- the updating unit 33E performs dumping so that the data amount of the specific map data MIf stored in the storage unit 33D is maintained at a constant value even when the dump truck 2 moves in a plurality of divided areas Ap.
- a process of erasing at least a part of is performed.
- FIG. 15 is a diagram schematically illustrating a plurality of divided areas into which the management area is divided.
- FIG. 16 is a schematic diagram for explaining a method of calculating the divided map ID after the change.
- the management area is divided into a plurality of divided areas. Divided areas that divide the management area are arranged by the first number of divisions in the X-axis direction and by the second number of divisions in the Y-axis direction.
- the management area includes a plurality of division maps arranged by 12 in the X-axis direction in the XY plane and by 7 in the Y-axis direction in the XY plane orthogonal to the X-axis direction. That is, the management area is divided into a plurality of divided areas “1” to “84”. Each divided area is given a number that is incremented by one in the X-axis direction.
- the updating unit 33E always calculates the ID of the divided area where the dump truck 2 exists, and acquires the ID of the changed divided area when it is determined that the ID of the divided area is changed to the ID of the adjacent divided area.
- Equation (1) is a formula for calculating an index in the X-axis direction.
- Equation (2) is a formula for calculating an index in the Y-axis direction.
- Equation (3) is a formula for calculating the index of the data matrix.
- cx and cy indicate the center coordinates of the divided area in the global coordinate system.
- Re indicates the resolution of the divided map data.
- w shows the 1st division number of the management area by the division area in the X-axis direction.
- h indicates the second division number of the management area by the division area in the Y-axis direction.
- the coordinate data of each of the eight adjacent divided areas can be calculated at high speed only by four arithmetic operations using the first division number w.
- the coordinate value of the divided area adjacent to the + X side of the central divided area is “i + 1”
- the coordinate value of the divided area adjacent to the ⁇ X side is “i ⁇ 1”
- + Y The coordinate value of the divided area adjacent to the side is “i + w”
- the coordinate value of the divided area adjacent to the ⁇ Y side is “i ⁇ w”.
- the coordinate value of the divided area adjacent to the + X side of the divided area having the coordinate value “i + w” is “i + w + 1”, and the coordinate value of the divided area adjacent to the ⁇ X side is “i + w ⁇ 1”.
- the coordinate value of the divided area adjacent to the + X side of the divided area whose ID is “i ⁇ w” is “i ⁇ w + 1”, and the coordinate value of the divided area adjacent to the ⁇ X side is “i ⁇ w ⁇ ”. 1 ”.
- the updating unit 33E is provided in association with the coordinate value of the division map and the coordinate value based on the coordinate value “i” and the first division number w in the division area where the dump truck 2 exists.
- the specific map data MIf to be read into the storage unit 33D after the ID has been changed can be determined.
- the updating unit 33D allows the coordinate data in the XY plane of the divided area where the dump truck 2 exists,
- the specific map data MIf to be read by the storage unit 33D can be determined based on the number of divisions h.
- the management area is divided into a plurality of divided maps, and the plurality of divided map data MIp indicating the maps of the plurality of divided areas are stored in the map storage database 36, and the position Since the specific map data MIf is determined from the plurality of divided map data MIp stored in the map storage database 36 based on the position data indicating the absolute value of the dump truck 1 acquired by the data acquisition unit 33F.
- the plurality of divided map data MIp stored in the map storage database 36 only the specific map data MIf indicating the map around the dump truck 2 necessary for the reference navigation traveling can be read into the storage unit 33D. . Accordingly, the position of the dump truck 2 is calculated using the specific map data MIf read into the storage unit 33D without causing an increase in the capacity of the storage unit 33D and an increase in calculation processing load, and the verification navigation is performed. be able to.
- the updating unit 33E changes the specific map data MIf to be read by the storage unit 33D based on the detection data of the GPS detector 31, so that the dump truck 2 travels on the travel route RP.
- the specific map data MIf indicating the map around the dump truck 2 necessary for collation navigation traveling can always be read into the storage unit 33D, and data unnecessary for collation navigation traveling is read into the storage unit 33D. Is suppressed.
- the specific map data MIf read into the storage unit 33D includes a plurality of divided map data MIp indicating adjacent divided areas.
- the updating unit 33E determines that the dump truck 2 has moved from one of the two adjacent divided areas to the other divided area based on the detection data of the GPS receiver 31, the updating unit 33E obtains the specific map data MIf.
- Update The update timing of the specific map data MIf is regulated by the timing when the dump truck 2 moves from one divided area to the other divided area, so that the minimum specific map data MIf necessary for collation navigation is always used. can do.
- the update unit 33E uses the divided area Ap existing in the forward direction of the dump truck 2 as the moving area 33E.
- the divided map data MIp shown is sequentially read into the storage unit 33D as the specific map data MIf, so that the specific map data MIf necessary for collation navigation travel can be stored in the storage unit 33D.
- the updating unit 33E sequentially erases the division map data MIp indicating the division area Ap existing behind the dump truck 2 from the storage unit 33D, and thus is stored in the storage unit 33D. Increase in the amount of data to be stored can be suppressed.
- the specific map data MIf includes the divided map data MIp indicating the divided area where the dump truck 2 exists, and a plurality of divided areas arranged around the divided area where the dump truck 2 exists. It includes division map data MIp indicating each.
- the updating unit 33D has the divided map stored in the map storage database 36 so that the data amount of the specific map data MIf stored in the storage unit 33D is maintained at a constant value.
- a process of reading at least a part of the data MIp into the storage unit 33D and a process of erasing at least a part of the divided map data MIp stored in the storage unit 33D are performed. Thereby, specific map data MIf necessary and sufficient for collation navigation travel can be stored in the storage unit 33D while suppressing an increase in the amount of data stored in the storage unit 33D.
- the update unit 33E stores the storage unit 33D based on the coordinate value of the divided area where the dump truck 2 exists and at least one of the first divided number w and the second divided number h.
- the specific map data MIf to be read can be calculated and determined at high speed.
- Embodiment 2 will be described.
- the same or equivalent components as those in the first embodiment are denoted by the same reference numerals, and the description thereof is simplified or omitted.
- the method for suppressing the increase in the capacity and the data amount of the storage unit 33D as the second storage unit has been described.
- a method for suppressing an increase in capacity and an increase in data volume of the map storage database 36 serving as the first storage unit will be described.
- FIG. 17 is a flowchart showing the operation of the dump truck 2 in creating the map data MI according to the second embodiment.
- FIG. 18 is a schematic diagram for explaining the operation of the map storage database 36 according to the second embodiment.
- the map storage database 36 stores the divided map data MIp created in the map data creation process in the past predetermined period. That is, the divided map data MIp created based on the detection data of the GPS detector 31 and the detection data of the laser sensor 24B acquired in the past predetermined period is stored in the map storage database 36.
- the dump truck 2 stopped at the parking lot is started (step ST80).
- the updating unit 33E causes the elapsed time from the creation of the divided map data MIp created in the past predetermined period and stored in the map storage database 36. It is determined whether or not the specified time is exceeded (step ST81).
- a plurality of divided map data MIp is stored in the map storage database 36.
- the updating unit 33E determines whether or not the elapsed time from the creation of each of the plurality of divided map data MIp exceeds the specified time.
- the specified time is, for example, 3 days.
- each of the plurality of divided map data MIp is filed and managed as a folder. As shown in FIG. 18, the divided map data MIp whose elapsed time since the creation has not exceeded the specified time is stored in the new folder. The divided map data MIp whose elapsed time since creation exceeds the specified time is stored in the old folder.
- File 1 is division map data MIp indicating a first division area among a plurality of division areas.
- File 2 is divided map data MIp indicating a second divided area among a plurality of divided areas.
- File 3 is divided map data MIp indicating a third divided area among a plurality of divided areas.
- File 4 is division map data MIp indicating the fourth division area among the plurality of division areas.
- the file 2 stored in the new folder and the file 2 stored in the old folder are divided map data MIp indicating the same divided area (second divided area).
- the file 3 stored in the new folder and the file 3 stored in the old folder are division map data MIp indicating the same division area (third division area).
- step ST81 the updating unit 33E determines the elapsed time since the creation of each of the plurality of divided map data MIp (file 1, file 2, file 3) created in the past predetermined period and stored in the new folder. It is determined whether or not exceeds the specified time. If it is determined in step ST81 that there is division map data MIp whose elapsed time since creation exceeds a certain time (step ST81: Yes), the update unit 33E causes the division map stored in the new folder to be stored. Data MIp is moved to the old folder (step ST82).
- all of the plurality of divided map data MIp stored in the new folder that is, all of file 1, file 2, and file 3, are moved from the new folder to the old folder.
- the files 1, 2, and 3 stored in the new folder are moved to the old folder, the file 1 is stored in the old folder.
- the file 2 stored in the old folder is updated (overwritten) to the folder 2 moved from the new folder to the old folder.
- the file 3 stored in the old folder is updated (overwritten) to the folder 3 moved from the new folder to the old folder.
- the file 4 stored in the old folder continues.
- At least a part of the divided map folder MIp created in the past first period and stored in the old folder of the map storage database 36 is a divided map created in the second period after the first period. Updated by data MIp.
- step ST81 When it is determined in step ST81 that there is no divided map data MIp whose elapsed time since creation exceeds a certain time (step ST81: No), or when the process of step ST82 is completed, the dump truck 2 Starts work in the mine (step ST83). The dump truck 2 travels on the travel route RP.
- the position measurement controller 33 detects the bank BK with the laser sensor 24B while acquiring the position data of the dump truck 2 with the position data acquisition unit 33F.
- the map data creation unit 33C of the position measurement controller 33 creates divided map data MIp based on the detection data of the GPS receiver 31 and the detection data of the laser sensor 24B.
- the created divided map data MIp is stored in a new folder of the map storage database 36.
- the traveling controller 20 determines whether or not to perform collation navigation traveling (step ST84).
- step ST84 when it is determined that the GPS navigation is performed without performing the verification navigation traveling (step ST84: No), the map data creation process is continued.
- the updating unit 33E stores the divided map data MIp created using the laser sensor 24B in a new folder (step ST85).
- step ST84 If it is determined in step ST84 that GPS traveling is not possible and collation navigation traveling is to be performed (step ST84: Yes), the updating unit 33E updates the divided map data MIp stored in the old folder and the new folder.
- the stored divided map data MIp is integrated (step ST86).
- the division map data stored in the new folder includes division map data MIp that is being created in real time using the laser sensor 24B.
- the integration of the divided map data MIp stored in the old folder and the divided map data MIp stored in the new folder is the same as that of the files stored in the old folder. If the file stored in the new folder is division map data indicating the same division area, the file in the old folder is updated (overwritten) to the file in the new folder, and either the new folder or the old folder A file that only exists includes being maintained without being erased or updated.
- the integration of the divided map data MIp stored in the old folder and the divided map data MIp stored in the new folder is created in the past first period for a certain divided area and stored in the old folder. Calculating the logical sum of the divided map data MIp and the divided map data MIp created in the second period after the first period for the same divided area.
- FIG. 19 is a schematic diagram for explaining the process of calculating the logical sum of the divided map data MIp.
- the old folder stores a file A1, which is division map data created in the past first period for a certain division area Apa.
- a file A2 which is division map data created in a second period after the first period for the same division area Apa, is stored.
- the file A1 and the file A2 are each defined by a plurality of grids GR.
- a coordinate value in the XY coordinates is given to each of the plurality of grids GR.
- the coordinate value of the grid GR indicates an absolute position in the global coordinate system.
- File A1 and file A2 are division map data of the same division area Apa. Therefore, for example, the coordinate value (x1, y1) of the file A1 and the coordinate value (x1, y1) of the file A2 indicate the same position.
- the data included in the coordinate values of the file A1 and the file A2 is binary data (1 bit data) indicating the presence / absence of the bank BK.
- the file A1 includes binary data indicating that a bank BK exists at coordinate values (x3, y1), (x2, y2), (x2, y3), (x3, y4), (x3, y5).
- the file A2 includes binary data indicating that the bank BK exists at the coordinate values (x2, y1), (x2, y2), (x3, y3), (x3, y4), (x3, y5).
- the logical sum of the file A1 and the file A2 is a logical sum of coordinate values indicating the same position. Therefore, as shown in FIG. 19, the integrated division map data indicating the logical sum of the file A1 and the file A2 has coordinate values (x2, y1), (x3, y1), (x2, y2), (x2 , Y3), (x3, y3), (x3, y4), and (x3, y5) include binary data indicating that the bank BK exists.
- the position calculation unit 33B collates the integrated divided map data (logical sum) with the detection data of the laser sensor 24B. Thus, the position of the dump truck 2 in the divided area Apa is calculated.
- the travel controller 20 causes the dump truck 2 to perform collation navigation based on the position of the dump truck 2 calculated by the position calculator 33B and the set course data (step ST87).
- the created divided map data MIp are grouped at regular time intervals and stored and managed in one folder.
- the divided map data MIp created in the past first period (for example, the period from 6 days to 3 days before the current time) is stored in the old folder of the map storage database 36, and the second period after the first period.
- the divided map data MIp created during the period from three days ago to the present time with respect to the current time is stored in the new folder.
- the divided map data MIp created in the first period is updated with the divided map data MIp created in the second period.
- the file 4 that does not exist in the new folder and exists in the old folder is maintained. Thereby, the data of the file 4 that could not be acquired in the second period can be effectively used.
- the divided map data of the old folder and the divided map data of the new folder are integrated.
- collation navigation running is performed using data of file 1, file 2, file 3, and file 4. Thereby, collation navigation driving
- files that exist in the old folder and do not exist in the new folder are maintained in the old folder.
- a second prescribed time (for example, one month) longer than the prescribed time may be provided for the elapsed time since creation, and a file whose elapsed time after creation exceeds the second prescribed time may be deleted. Thereby, it is suppressed that the too old divided file data continues to exist in the old folder.
- the map storage database 36 is arranged in the dump truck 2, and the map data is stored in the map storage database 36 arranged in the dump truck 2.
- the division map data created in the creation process is managed and used for verification navigation.
- a map storage database 36 for storing and managing the divided map data may be provided in the computer 11 of the control facility 7 arranged at a position different from the dump truck 2.
- an external storage device of the storage device 13 of the computer 11 may function as the map storage database 36.
- the divided map data created by the map data creation process performed by the dump truck 2 is transmitted wirelessly to the computer 11 of the management facility 7 by the communication system 9.
- the specific map data MIf determined from a plurality of divided map data stored in the external storage device of the storage device 13 of the computer 11 is wirelessly dumped by the communication system 9. 2 is supplied to the storage unit 33D.
- the detection data of the laser sensor 24B among the non-contact sensors 24 is used during collation navigation traveling and map data creation processing.
- the detection data of the radar 24A in the non-contact sensor 24 may be used during at least one of the verification navigation traveling and the map data creation process.
- the non-contact sensor 24 may be a distance measuring sensor that can measure a relative position with an object around the dump truck 2. For example, a camera that acquires an optical image of an object around the dump truck 2 may be used as the non-contact sensor 24.
- the work machine includes a mining machine.
- the position of the mining machine is detected using the GPS detector.
- the present invention is not limited to this, and the position of the mining machine may be detected based on a known “position detection device”.
- GPS cannot be detected in underground mines, for example, IMES (Indoor Messaging System), pseudo satellites (Pseudolite), RFID (Radio Frequency IDentifier), beacons, surveying instruments, wireless LAN, UWB (UWB ( Self-localization of a working machine using an Ultra Wide Band, SLAM (Simultaneous Localization and Mapping), or a landmark (a mark provided beside the travel route) may be used. You may use these position detection apparatuses for the working machine used in the mining machine in an above-ground mine, or the work site on the ground.
- the corrected observation information using the GPS base station 19 is used for detecting the GPS position has been described, but the position may be detected by the GPS receiver 31 of the dump truck 2 alone.
- whether or not the GPS position error (accuracy) is equal to or less than a predetermined error is determined based on the GPS receiver 31 alone of the dump truck 2 without using the corrected observation information of the GPS base station 19. May be determined.
- a work machine control system for a work machine (hydraulic excavator, bulldozer, wheel loader, etc.) used on a work machine or on the ground, which includes a “position detection device”, a “non-contact sensor”, and a “position calculation unit” Also included.
- Management system Dump truck (mining equipment) 2E Internal combustion engine 2G Generator 2S Steering device 3 Other mining machinery 4 Mining machinery 5 Positioning satellite 6 Repeater 7 Control facility 9 Communication system 10 Management device 11 Computer 12 Processing device (course data creation unit) 13 storage device 13B database 15 input / output unit 16 display device 17 input device 18 wireless communication device 18A antenna 19 GPS base station 19A antenna 19B transmission / reception device 19C antenna 20 travel controller (travel control unit) 21 Vehicle body 22 Vessel 23 Wheel 23B Braking device 23F Front wheel 23M Motor 23R Rear wheel 24 Non-contact sensor 24A Radar 24B Laser sensor 26 Gyro sensor 27 Speed sensor 30 Control system 31 GPS receiver (position detection device) 31A Antenna 31B Antenna 32 Travel route creation device 32A Route position storage unit 33 Position measurement controller 33A Determination unit 33B Collation navigation calculation unit (position calculation unit) 33C Map data creation unit 33D Storage unit (second storage unit) 33E update unit 33F position data acquisition unit 34 wireless communication device 34A antenna 35 first signal line 36 map storage database 37A second
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Optics & Photonics (AREA)
- Electromagnetism (AREA)
- Navigation (AREA)
- Traffic Control Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Instructional Devices (AREA)
Abstract
Description
<鉱山機械の管理システムの概要>
図1は、実施形態1に係る作業機械4の管理システム1の一例を示す図である。実施形態1においては、作業機械4が、鉱山で稼働する鉱山機械である例について説明する。以下の説明においては、作業機械4を適宜、鉱山機械4、と称する。なお、作業機械4は、鉱山で稼働する作業機械でなくてもよい。
次に、管制施設7に配置される管理装置10について説明する。管理装置10は、ダンプトラック2に対してデータ及び指令信号を送信し、ダンプトラック2からデータを受信する。図1に示すように、管理装置10は、コンピュータ11と、表示装置16と、入力装置17と、無線通信装置18と、GPS基地局19と、を備える。
次に、他の鉱山機械3について説明する。他の鉱山機械3は、ダンプトラック2以外の鉱山機械であり、作業者の操作により作動する。他の鉱山機械3は、CPU(Central Processing Unit)を含みかつ作業内容に関する各種の処理を実行する処理装置と、GPS位置を検出するGPS受信器と、管制施設7の無線通信装置18とデータを送受信する無線通信装置とを備える。他の鉱山機械3は、所定時間毎にGPS位置を無線通信装置が管制施設7の無線通信装置18に送信する。
次に、ダンプトラック2について説明する。図2は、実施形態1に係るダンプトラック2の制御ブロック図である。図3は、実施形態1に係るダンプトラック2のハードウエア構成図である。
次に、作業機械の制御システム30を説明する。図4は、実施形態1に係る制御システム30のマップ保存用データベース36に記憶されるマップデータMIの一部を示す図である。図5は、図4中のXIV部を拡大して示す図である。
次に、実施形態1に係るダンプトラック2の走行モードの一例について説明する。図6は、実施形態1に係る制御システム30のフローチャートの一例である。図7は、図6のステップST4のフローチャートの一例である。図8は、図6のステップST6のフローチャートの一例である。
上述したように、ダンプトラック2が走行経路RPを走行する場合、推測航法により導出されたダンプトラック2の位置が、GPS受信器31により検出されたGPS位置又は照合航法演算部33Bにより算出された絶対位置により補正される。以下の説明においては、GPS受信器31により検出された検出データであるGPS位置を使ってダンプトラック2の走行を制御することを適宜、GPS走行、と称し、照合航法演算部33Bにより算出された絶対位置を使ってダンプトラック2の走行を制御することを適宜、照合航法走行、と称する。
以上説明したように、実施形態1によれば、管理エリアを複数の分割マップに分割し、複数の分割エリアそれぞれのマップを示す複数の分割マップデータMIpをマップ保存用データベース36に記憶させ、位置データ取得部33Fで取得されたダンプトラック1の絶対値を示す位置データに基づいて、マップ保存用データベース36に記憶されている複数の分割マップデータMIpから特定マップデータMIfを決定するようにしたので、マップ保存用データベース36に記憶されている複数の分割マップデータMIpのうち、照合航法走行に必要なダンプトラック2の周辺のマップを示す特定マップデータMIfのみを記憶部33Dに読み込ませることができる。これにより、記憶部33Dの大容量化及び演算処理の負荷の増大を招くことなく、記憶部33Dに読み込まれた特定マップデータMIfを使ってダンプトラック2の位置を算出して、照合航法走行させることができる。
実施形態2について説明する。以下の説明において、上述の実施形態1と同一又は同等の構成要素については同一の符号を付し、その説明を簡略又は省略する。
図17は、実施形態2に係るマップデータMIの作成におけるダンプトラック2の動作を示すフローチャートである。図18は、実施形態2に係るマップ保存用データベース36の動作を説明するための模式図である。
以上説明したように、実施形態2によれば、マップ保存用データベース36に記憶されている分割マップデータMIpについて、作成されてからの経過時間が規定時間(例えば3日間)を超えているか否かが判定され、作成された分割マップデータMIpが規定時間毎にグループ化され、1つのフォルダに格納されて管理される。過去の第1期間(例えば現時点を基準として6日前から3日前までの期間)に作成された分割マップデータMIpがマップ保存用データベース36の旧フォルダに格納され、第1期間の後の第2期間(例えば現時点を基準として3日前から現時点までの期間)に作成された分割マップデータMIpが新フォルダに格納される。第1期間において作成された分割マップデータMIpは、第2期間において作成された分割マップデータMIpにより更新される。これにより、最新の分割マップデータが残りつつ、古い分割マップデータが消去されるので、マップ保存用データベース36に記憶されるデータ量の増大化が抑制される。
なお、上述の各実施形態においては、図20の模式図に示すように、マップ保存用データベース36がダンプトラック2に配置され、ダンプトラック2に配置されているマップ保存用データベース36において、マップデータ作成処理で作成された分割マップデータが管理され、照合航法走行に使用されることとした。図21の模式図に示すように、分割マップデータを記憶し管理するマップ保存用データベース36が、ダンプトラック2とは別の位置に配置される管制施設7のコンピュータ11に設けられてもよい。例えば、コンピュータ11の記憶装置13の外部記憶装置が、マップ保存用データベース36として機能してもよい。ダンプトラック2によって実施されたマップデータ作成処理で作成された分割マップデータは、通信システム9により無線で管理施設7のコンピュータ11に送信される。ダンプトラック2において照合航法走行が実行される場合、コンピュータ11の記憶装置13の外部記憶装置に記憶されている複数の分割マップデータから決定された特定マップデータMIfが通信システム9により無線でダンプトラック2の記憶部33Dに供給される。
2 ダンプトラック(鉱山機械)
2E 内燃機関
2G 発電機
2S 操舵装置
3 他の鉱山機械
4 鉱山機械
5 測位衛星
6 中継器
7 管制施設
9 通信システム
10 管理装置
11 コンピュータ
12 処理装置(コースデータ作成部)
13 記憶装置
13B データベース
15 入出力部
16 表示装置
17 入力装置
18 無線通信装置
18A アンテナ
19 GPS基地局
19A アンテナ
19B 送受信装置
19C アンテナ
20 走行コントローラ(走行制御部)
21 車両本体
22 ベッセル
23 車輪
23B 制動装置
23F 前輪
23M 電動機
23R 後輪
24 非接触センサ
24A レーダ
24B レーザセンサ
26 ジャイロセンサ
27 速度センサ
30 制御システム
31 GPS受信器(位置検出装置)
31A アンテナ
31B アンテナ
32 走行経路作成装置
32A 経路位置記憶部
33 位置計測コントローラ
33A 判定部
33B 照合航法演算部(位置演算部)
33C マップデータ作成部
33D 記憶部(第2記憶部)
33E 更新部
33F 位置データ取得部
34 無線通信装置
34A アンテナ
35 第1信号線
36 マップ保存用データベース
37A 第2通信線
38 観測点座標変換部
39 観測点利用可能判断部
40 安全コントローラ
BK 土手
CR 破砕機
DPA 排土場
GR グリッド
HL 搬送路
IAH 照射エリア
IAV 照射エリア
IS 交差点
KF カルマンフィルタ
LPA 積込場
MI マップデータ
MIf 特定マップデータ
MIm 管理マップデータ
MIp 分割マップデータ
RP 走行経路
Claims (12)
- 走行経路を走行する作業機械の位置を検出する位置検出装置と、
前記作業機械が走行する走行経路の傍らの物体を非接触で検出する非接触センサと、
前記位置検出装置の検出データと前記非接触センサの検出データとに基づいて、前記鉱山の管理エリアのマップを示す管理マップデータを作成するマップデータ作成部と、
前記管理エリアが分割されて設定された分割エリアのマップを示す分割マップデータを記憶する第1記憶部と、
前記第1記憶部とは別の第2記憶部と、
前記位置検出装置の検出データに基づいて、前記第1記憶部に記憶されている複数の前記分割マップデータから特定マップデータを決定し、前記特定マップデータを前記第2記憶部に読み込ませる更新部と、
前記第2記憶部に読み込まれた前記特定マップデータと前記非接触センサの検出データとを照合して、前記作業機械の位置を算出する位置演算部と、
を備える作業機械の制御システム。 - 前記第2記憶部に読み込まれる前記特定マップデータは、第1分割エリアを示す第1分割マップデータ及び前記第1分割エリアに隣接する第2分割エリアを示す第2分割マップデータを含み、
前記更新部は、前記位置検出装置の検出データに基づいて、前記作業機械が前記第1分割エリアから前記第2分割エリアに移動したと判定したとき、前記特定マップデータを更新する、
請求項1に記載の作業機械の制御システム。 - 前記第1記憶部に記憶されている前記分割マップデータは、前記第2分割エリアに対して前記作業機械の進行方向に隣接して配置されている第3分割エリアを示す第3分割マップデータを含み、
前記更新部は、前記作業機械が前記第1分割エリアから前記第2分割エリアに移動したと判定したとき、前記第1記憶部に記憶されている前記第3分割マップデータを前記第2記憶部に読み込ませる、
請求項2に記載の作業機械の制御システム。 - 前記更新部は、前記作業機械が前記第1分割エリアから前記第2分割エリアに移動したと判定したとき、前記第2記憶部に記憶されている、前記第1分割エリアに対して前記作業機械の進行方向とは逆方向に隣接して配置されている第4分割エリアを示す第4分割マップデータを前記第2記憶部から消去する、
請求項3に記載の作業機械の制御システム。 - 前記特定マップデータは、前記作業機械が存在する分割エリアを示す分割マップデータ、及び前記作業機械が存在する分割エリアの周囲に配置される複数の分割エリアのそれぞれを示す分割マップデータを含む、
請求項1から請求項4のいずれか一項に記載の作業機械の制御システム。 - 前記更新部は、前記第2記憶部に記憶される前記特定マップデータのデータ量が一定値に維持されるように、前記作業機械の位置の変化に伴って、前記第1記憶部に記憶されている前記分割マップデータの少なくとも一部を前記第2記憶部に読み込ませる処理、及び前記第2記憶部に記憶されている前記分割マップデータの少なくとも一部を消去する処理を実施する、
請求項5に記載の作業機械の制御システム。 - 前記管理エリアは、所定面内の第1軸方向に第1分割数だけ配置され、前記第1軸方向と直交する前記所定面内の第2軸方向に第2分割数だけ配置された複数の前記分割マップを含み、
前記更新部は、前記作業機械が存在する前記分割エリアの前記所定面内における座標値と、前記第1分割数及び前記第2分割数の少なくとも一方とに基づいて、前記第2記憶部に読み込ませる前記特定マップデータを決定する、
請求項6に記載の作業機械の制御システム。 - 第1期間において取得された前記位置検出装置の検出データと前記非接触センサの検出データとに基づいて作成された前記分割マップデータが前記第1記憶部に記憶され、
前記第1期間の後の第2期間において前記位置検出装置の検出データと前記非接触センサの検出データとに基づいて作成された前記分割マップデータにより、前記第1記憶部に記憶されている前記分割マップデータの少なくとも一部が更新される、
請求項1から請求項7のいずれか一項に記載の作業機械の制御システム。 - 前記更新部は、所定の分割エリアについて前記第1期間において作成された分割マップデータと、前記所定の分割エリアについて前記第2期間において作成された分割マップデータとの論理和を算出し、
前記位置演算部は、論理和と前記非接触センサの検出データとを照合して、前記所定の分割エリアにおける前記作業機械の位置を算出する、
請求項8に記載の作業機械の制御システム。 - 請求項1から請求項9のいずれか一項に記載の作業機械の制御システムを備える作業機械。
- 請求項10に記載の作業機械に前記走行経路を規定するコースデータを出力する管理装置を備える作業機械の管理システム。
- 走行経路を走行する作業機械の位置を検出する位置検出装置の検出データと、前記作業機械が走行する前記走行経路の傍らの物体を非接触で検出する非接触センサの検出データとに基づいて、前記鉱山の管理エリアのマップを示す管理マップデータを作成することと、
前記管理エリアを分割して複数の分割エリアを設定し、前記分割エリアのマップを示す分割マップデータを第1記憶部に記憶させることと、
前記作業機械の位置データを取得することと、
前記第1記憶部に記憶されている複数の前記分割マップデータから前記作業機械の位置データに基づいて決定された特定マップデータを前記第1記憶部とは別の第2記憶部に読み込ませることと、
前記第2記憶部に読み込まれた前記特定マップデータと前記非接触センサの検出データとを照合して前記作業機械の位置を算出することと、
を含む作業機械の管理方法。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017557649A JP6672336B2 (ja) | 2015-12-25 | 2015-12-25 | 作業機械の制御システム、作業機械、作業機械の管理システム、及び作業機械の管理方法 |
US15/762,680 US10768634B2 (en) | 2015-12-25 | 2015-12-25 | Control system for work machine, work machine, management system for work machine, and management method for work machine |
PCT/JP2015/086340 WO2017109977A1 (ja) | 2015-12-25 | 2015-12-25 | 作業機械の制御システム、作業機械、作業機械の管理システム、及び作業機械の管理方法 |
AU2015418445A AU2015418445B2 (en) | 2015-12-25 | 2015-12-25 | Control system for work machine, work machine, management system for work machine, and management method for work machine |
CA2999229A CA2999229A1 (en) | 2015-12-25 | 2015-12-25 | Control system for work machine, work machine, management system for work machine, and management method for work machine |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2015/086340 WO2017109977A1 (ja) | 2015-12-25 | 2015-12-25 | 作業機械の制御システム、作業機械、作業機械の管理システム、及び作業機械の管理方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2017109977A1 true WO2017109977A1 (ja) | 2017-06-29 |
Family
ID=59089820
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2015/086340 WO2017109977A1 (ja) | 2015-12-25 | 2015-12-25 | 作業機械の制御システム、作業機械、作業機械の管理システム、及び作業機械の管理方法 |
Country Status (5)
Country | Link |
---|---|
US (1) | US10768634B2 (ja) |
JP (1) | JP6672336B2 (ja) |
AU (1) | AU2015418445B2 (ja) |
CA (1) | CA2999229A1 (ja) |
WO (1) | WO2017109977A1 (ja) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019187654A1 (ja) * | 2018-03-30 | 2019-10-03 | 株式会社小松製作所 | 作業機械の制御システム、作業機械、及び作業機械の制御方法 |
JP2020020155A (ja) * | 2018-07-31 | 2020-02-06 | 株式会社小松製作所 | 作業機械を制御するためのシステム及び方法 |
CN111120827A (zh) * | 2019-12-18 | 2020-05-08 | 北京海益同展信息科技有限公司 | 一种检测设备的升降平台的控制设备、检测设备 |
CN111741923A (zh) * | 2018-03-07 | 2020-10-02 | 宝洁公司 | 使用独立导向的载具同时生产产品的***和方法 |
JP2020535410A (ja) * | 2017-09-26 | 2020-12-03 | ロベルト・ボッシュ・ゲゼルシャフト・ミト・ベシュレンクテル・ハフツングRobert Bosch Gmbh | レーダ測定に基づいて車両をマッピング及び位置特定する方法及びシステム |
JP2021505978A (ja) * | 2018-07-19 | 2021-02-18 | 馭勢科技(北京)有限公司Uisee Technologies (Beijing) Ltd. | 視覚的自己位置推定マップの記憶及びロード方法、装置、システム並びに記憶媒体 |
AU2019255005B2 (en) * | 2018-04-20 | 2022-03-31 | Komatsu Ltd. | Control system for work machine, work machine, and control method for work machine |
JP2022172444A (ja) * | 2021-05-03 | 2022-11-16 | バイエリシエ・モトーレンウエルケ・アクチエンゲゼルシヤフト | 原動機付き車両の走行動作を補助する方法及びアシスト装置並びに原動機付き車両 |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102016218232B4 (de) * | 2016-09-22 | 2024-02-15 | Volkswagen Aktiengesellschaft | Positionsbestimmungssystem für eine mobile Einheit, Fahrzeug und Verfahren zum Betreiben eines Positionsbestimmungssystems |
US11320830B2 (en) | 2019-10-28 | 2022-05-03 | Deere & Company | Probabilistic decision support for obstacle detection and classification in a working area |
CN111829507B (zh) * | 2020-07-20 | 2022-04-22 | 北京易控智驾科技有限公司 | 应用于露天矿山自动驾驶的排土场挡墙地图更新方法 |
US20220197301A1 (en) * | 2020-12-17 | 2022-06-23 | Aptiv Technologies Limited | Vehicle Localization Based on Radar Detections |
CN112595334B (zh) * | 2020-12-24 | 2024-04-30 | 江苏徐工工程机械研究院有限公司 | 露天矿山的卸载区的地图更新方法、装置和*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002215236A (ja) * | 2001-01-22 | 2002-07-31 | Komatsu Ltd | 無人車両の走行制御装置 |
JP2003114613A (ja) * | 2001-10-03 | 2003-04-18 | Netgene Co Ltd | 地図データ分割方法、カーナビゲイションシステム、及びカーナビゲイション装置 |
JP2008021023A (ja) * | 2006-07-11 | 2008-01-31 | Fujitsu Ltd | 移動ロボット装置および移動ロボット制御方法 |
JP2012118694A (ja) * | 2010-11-30 | 2012-06-21 | Komatsu Ltd | 無人車両の走行システムにおける走行制御方法および無人車両の走行システム |
JP2014219721A (ja) * | 2013-05-01 | 2014-11-20 | 村田機械株式会社 | 自律移動体 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5610815A (en) * | 1989-12-11 | 1997-03-11 | Caterpillar Inc. | Integrated vehicle positioning and navigation system, apparatus and method |
US5680313A (en) * | 1990-02-05 | 1997-10-21 | Caterpillar Inc. | System and method for detecting obstacles in a road |
EP1913235B1 (en) * | 2005-07-26 | 2011-04-06 | MacDonald Dettwiler & Associates Inc. | Guidance, navigation, and control system for a vehicle |
JP5531733B2 (ja) | 2010-04-01 | 2014-06-25 | トヨタ自動車株式会社 | 道路情報取得装置 |
AU2015331288B2 (en) * | 2015-10-30 | 2017-08-17 | Komatsu Ltd. | Construction machine control system, construction machine, construction machine management system, and construction machine control method and program |
CN105849587B (zh) * | 2015-10-30 | 2018-12-21 | 株式会社小松制作所 | 作业机械的控制***、作业机械、其管理***和控制方法 |
CN106104401B (zh) * | 2016-02-01 | 2021-03-26 | 株式会社小松制作所 | 作业机械的控制***、作业机械以及作业机械的管理*** |
US10031528B2 (en) * | 2016-02-01 | 2018-07-24 | Komatsu Ltd. | Work machine control system, work machine, and work machine management system |
US10119830B2 (en) * | 2016-02-29 | 2018-11-06 | Komatsu Ltd. | Control system for work machine, work machine, and management system for work machine |
-
2015
- 2015-12-25 CA CA2999229A patent/CA2999229A1/en not_active Abandoned
- 2015-12-25 JP JP2017557649A patent/JP6672336B2/ja active Active
- 2015-12-25 WO PCT/JP2015/086340 patent/WO2017109977A1/ja active Application Filing
- 2015-12-25 US US15/762,680 patent/US10768634B2/en active Active
- 2015-12-25 AU AU2015418445A patent/AU2015418445B2/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002215236A (ja) * | 2001-01-22 | 2002-07-31 | Komatsu Ltd | 無人車両の走行制御装置 |
JP2003114613A (ja) * | 2001-10-03 | 2003-04-18 | Netgene Co Ltd | 地図データ分割方法、カーナビゲイションシステム、及びカーナビゲイション装置 |
JP2008021023A (ja) * | 2006-07-11 | 2008-01-31 | Fujitsu Ltd | 移動ロボット装置および移動ロボット制御方法 |
JP2012118694A (ja) * | 2010-11-30 | 2012-06-21 | Komatsu Ltd | 無人車両の走行システムにおける走行制御方法および無人車両の走行システム |
JP2014219721A (ja) * | 2013-05-01 | 2014-11-20 | 村田機械株式会社 | 自律移動体 |
Cited By (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2020535410A (ja) * | 2017-09-26 | 2020-12-03 | ロベルト・ボッシュ・ゲゼルシャフト・ミト・ベシュレンクテル・ハフツングRobert Bosch Gmbh | レーダ測定に基づいて車両をマッピング及び位置特定する方法及びシステム |
US11493624B2 (en) | 2017-09-26 | 2022-11-08 | Robert Bosch Gmbh | Method and system for mapping and locating a vehicle based on radar measurements |
CN111741923B (zh) * | 2018-03-07 | 2022-04-15 | 宝洁公司 | 使用独立导向的载具同时生产产品的***和方法 |
CN111741923A (zh) * | 2018-03-07 | 2020-10-02 | 宝洁公司 | 使用独立导向的载具同时生产产品的***和方法 |
JP7144910B2 (ja) | 2018-03-07 | 2022-09-30 | ザ プロクター アンド ギャンブル カンパニー | 独立案内搬送体を使用して製品を同時に生産するためのシステム及び方法 |
JP2021513487A (ja) * | 2018-03-07 | 2021-05-27 | ザ プロクター アンド ギャンブル カンパニーThe Procter & Gamble Company | 独立案内搬送体を使用して製品を同時に生産するためのシステム及び方法 |
US11745767B2 (en) | 2018-03-30 | 2023-09-05 | Komatsu Ltd. | Work machine control system, work machine, and work machine control method |
WO2019187654A1 (ja) * | 2018-03-30 | 2019-10-03 | 株式会社小松製作所 | 作業機械の制御システム、作業機械、及び作業機械の制御方法 |
AU2019255005B2 (en) * | 2018-04-20 | 2022-03-31 | Komatsu Ltd. | Control system for work machine, work machine, and control method for work machine |
US11307049B2 (en) | 2018-07-19 | 2022-04-19 | Uisee Technologies (Beijing) Co., Ltd | Methods, apparatuses, systems, and storage media for storing and loading visual localization maps |
JP7002574B2 (ja) | 2018-07-19 | 2022-01-20 | 馭勢科技(北京)有限公司 | 視覚的自己位置推定マップの記憶及びロード方法、装置、システム並びに記憶媒体 |
JP2021505978A (ja) * | 2018-07-19 | 2021-02-18 | 馭勢科技(北京)有限公司Uisee Technologies (Beijing) Ltd. | 視覚的自己位置推定マップの記憶及びロード方法、装置、システム並びに記憶媒体 |
JP2020020155A (ja) * | 2018-07-31 | 2020-02-06 | 株式会社小松製作所 | 作業機械を制御するためのシステム及び方法 |
JP7204366B2 (ja) | 2018-07-31 | 2023-01-16 | 株式会社小松製作所 | 作業機械を制御するためのシステム及び方法 |
WO2020026507A1 (ja) * | 2018-07-31 | 2020-02-06 | 株式会社小松製作所 | 作業機械を制御するためのシステム及び方法 |
US11795658B2 (en) | 2018-07-31 | 2023-10-24 | Komatsu Ltd. | System and method for controlling work machine |
CN111120827A (zh) * | 2019-12-18 | 2020-05-08 | 北京海益同展信息科技有限公司 | 一种检测设备的升降平台的控制设备、检测设备 |
US11933452B2 (en) | 2019-12-18 | 2024-03-19 | Jingdong Technology Information Technology Co., Ltd. | Control device of lifting platform for detection device and detection device |
JP2022172444A (ja) * | 2021-05-03 | 2022-11-16 | バイエリシエ・モトーレンウエルケ・アクチエンゲゼルシヤフト | 原動機付き車両の走行動作を補助する方法及びアシスト装置並びに原動機付き車両 |
JP7461399B2 (ja) | 2021-05-03 | 2024-04-03 | バイエリシエ・モトーレンウエルケ・アクチエンゲゼルシヤフト | 原動機付き車両の走行動作を補助する方法及びアシスト装置並びに原動機付き車両 |
Also Published As
Publication number | Publication date |
---|---|
JPWO2017109977A1 (ja) | 2018-10-18 |
CA2999229A1 (en) | 2017-06-29 |
US20180292840A1 (en) | 2018-10-11 |
AU2015418445A1 (en) | 2018-04-19 |
JP6672336B2 (ja) | 2020-03-25 |
AU2015418445B2 (en) | 2019-08-15 |
US10768634B2 (en) | 2020-09-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6087475B2 (ja) | 作業機械の制御システム、作業機械、及び作業機械の管理システム | |
JP6672336B2 (ja) | 作業機械の制御システム、作業機械、作業機械の管理システム、及び作業機械の管理方法 | |
JP6055120B2 (ja) | 作業機械の制御システム、作業機械、作業機械の管理システム、作業機械の制御方法及びプログラム | |
JP6059846B2 (ja) | 鉱山用作業機械の制御システム、鉱山用作業機械、鉱山用作業機械の管理システム、鉱山用作業機械の制御方法及びプログラム | |
CN107407733B (zh) | 作业机械的控制***、作业机械、作业机械的管理***以及作业机械的管理方法 | |
JP6475227B2 (ja) | 作業機械の制御システム、作業機械、及び作業機械の管理システム | |
CN106104401B (zh) | 作业机械的控制***、作业机械以及作业机械的管理*** | |
JP6617192B2 (ja) | 作業機械の管理システム、及び作業機械 | |
JP6657257B2 (ja) | 作業機械の管理システム、作業機械及び作業機械の管理装置 | |
JP6757749B2 (ja) | 作業機械の管理システム、作業機械、作業機械の管理方法 | |
JP6672339B2 (ja) | 作業機械の管理システム及び作業機械 | |
JP6538793B2 (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: 15911411 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2017557649 Country of ref document: JP Kind code of ref document: A |
|
ENP | Entry into the national phase |
Ref document number: 2999229 Country of ref document: CA |
|
WWE | Wipo information: entry into national phase |
Ref document number: 15762680 Country of ref document: US |
|
ENP | Entry into the national phase |
Ref document number: 2015418445 Country of ref document: AU Date of ref document: 20151225 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: 15911411 Country of ref document: EP Kind code of ref document: A1 |