JP6247904B2 - Mine transport vehicle - Google Patents

Description

  The present invention relates to a mine transport vehicle such as a dump truck used in a mine.

  In recent years, unmanned vehicles capable of autonomous traveling are being introduced as dump trucks used in mines. In this type of unmanned vehicle, for example, a distance to a front vehicle (obstacle) traveling ahead is measured by an external recognition device or the like, and speed control is performed to avoid a collision with the front vehicle. In general, millimeter wave sensors, laser scanners, stereo cameras, and the like are known as means for detecting a vehicle ahead.

  For example, Patent Document 1 discloses a conventional technique related to avoiding a collision with a preceding vehicle. The collision accident prevention apparatus disclosed in Patent Document 1 has different detection directions of a plurality of contact-type millimeter wave sensors that can detect only the speed, and a speed threshold for determination in order from the millimeter wave sensor that can detect the farthest distance. Is set small, and when the speed measured by each millimeter wave sensor is equal to or higher than the set speed threshold, it is determined that there is a possibility of collision with the preceding vehicle.

JP 2012-21893 A

  In the prior art disclosed in Patent Document 1, a contact-type millimeter wave sensor capable of detecting only the speed is used to determine the possibility of a collision with a preceding vehicle. In situations where the road gradient changes, such as when approaching or passing through a slope, a preceding vehicle exists at a position moved upward or downward, and the preceding vehicle is outside the millimeter wave irradiation range. Therefore, the speed of the vehicle ahead may not be detected by a plurality of millimeter wave sensors with different detection directions.

  The present invention has been made from the above-described prior art, and an object of the present invention is to provide a mine transport vehicle capable of appropriately detecting an obstacle even on a traveling road where the gradient changes.

To this end, the present invention provides a vehicle body and the obstacle detecting unit for detecting a forward obstacle vehicle body and the detection direction adjustment unit to adjust the detection direction of the obstacle detecting unit A position detection unit that detects a travel position, and a storage unit that stores map information including inclination angle information of the travel path, and the detection direction adjustment unit includes the travel position detected by the position detection unit, The detection direction is adjusted in the vertical direction based on the map information stored in the storage unit .

  The present invention configured as described above can be used on a road where the gradient changes by appropriately adjusting the detection direction of the obstacle detection unit in the vertical direction by the detection direction adjustment unit when the gradient of the road changes. Obstacles can be detected properly.

The present invention includes a vehicle body, a plurality of obstacle detection unit for detecting a forward obstacle of the vehicle body, a position detection unit for detecting a running position, the map information including the inclination information of the road A plurality of obstacle detection units attached to different positions in the height direction of the vehicle main body, the travel positions detected by the position detection unit, and stored in the storage unit Based on the map information, the detection information detected by any of the plurality of obstacle detection units is determined .

Since the present invention configured as described above has a plurality of obstacle detection units attached to different positions in the height direction of the vehicle body, it can be detected by a suitable obstacle detection unit in accordance with a change in the gradient of the travel path. Obstacles can be appropriately detected even on a road where the slope changes .

According to the present invention, in the above invention, a position detection unit that detects a traveling position, a storage unit that stores map information including inclination angle information of a traveling path, a traveling position detected by the position detection unit, and the storage based on the stored map information in parts, it is characterized by comprising, a detected information correcting unit for correcting the detection information of the obstacle detecting unit.

In the present invention configured as described above , the control unit corrects the detection information of the obstacle detection unit based on the travel position detected by the position detection unit and the map information including the inclination angle information of the travel path. The detection information of the obstacle detection unit can be made more accurate even on the traveling road where the slope changes, and the obstacle can be detected appropriately.

The present invention, in the invention, the loading platform, and a load weight detector for detecting a load weight of the cargo that is loaded on the loading platform, further wherein the detected information correcting unit, at further the load weight detecting section The detection information of the obstacle detection unit is corrected based on the detected load weight.

  In the present invention configured as described above, since the detection information of the obstacle detection unit is corrected based on the loading weight of the loading platform detected by the loading weight detection unit, the obstacle according to the change in the loading weight of the load loaded on the loading platform. Since the change in the detection information of the detection unit can be corrected, the obstacle can be detected more appropriately.

  The present invention is configured such that the detection direction of the obstacle detection unit that detects an obstacle in the forward direction of the vehicle body is adjusted in the vertical direction by the detection direction adjustment unit. With this configuration, the present invention allows the detection direction adjusting unit to appropriately adjust the detection direction of the obstacle detection unit in the vertical direction when the gradient of the road changes, so that the obstacle can be detected even on the road where the gradient changes. Can be detected appropriately. Problems, configurations, and effects other than those described above will be made clear from the following description of embodiments.

It is the schematic which shows the mine where the transport vehicle for mines which concerns on 1st Embodiment of this invention is used. It is the schematic which shows the said transport vehicle for mines. It is the schematic which shows the traveling drive apparatus of the said mine transport vehicle. It is a schematic block diagram which shows the relationship between the control center used for the said mine system, and the said mine transport vehicle. It is explanatory drawing which shows the detection of the front vehicle on the flat road of the said transport vehicle for mines. It is explanatory drawing which shows the detection of the front vehicle in the uphill front position of the said mine transport vehicle. It is explanatory drawing which shows the detection of the front vehicle in the position before the uphill terminal end of the said mine transport vehicle. It is explanatory drawing which shows the detection of the front vehicle in the downhill front position of the said mine transport vehicle. It is explanatory drawing which shows the detection of the front vehicle in the downhill end position before the said mine transport vehicle. It is the schematic which shows the transport vehicle for mines which concerns on 2nd Embodiment of this invention. It is a schematic block diagram which shows the relationship between the said mine transport vehicle and a control center. It is explanatory drawing which shows the detection of the front vehicle in the uphill front position of the said mine transport vehicle. It is explanatory drawing which shows the detection of the front vehicle in the position before the uphill terminal end of the said mine transport vehicle. It is the schematic which shows the transport vehicle for mines which concerns on 3rd Embodiment of this invention. It is explanatory drawing which shows the detection of the front vehicle in the position before the uphill terminal end of the said mine transport vehicle. It is the schematic which shows the transport vehicle for mines which concerns on 4th Embodiment of this invention.

  EMBODIMENT OF THE INVENTION Hereinafter, the form for implementing the front vehicle detection system using the transport vehicle for mines which concerns on this invention is demonstrated based on figures.

[First Embodiment]
In the first embodiment, a plurality of, for example, two millimeter-wave sensors 2a and 2b attached to a dump truck 1 which is a mine transport vehicle with a fixed detection direction are preceded by other dump trucks 1 and the like. The forward vehicle α traveling is detected. FIG. 1 is a schematic view showing a mine in which a dump truck 1 according to a first embodiment of the present invention is used. FIG. 2 is a schematic view showing the dump truck 1. FIG. 3 is a schematic diagram showing the travel drive device 3 of the dump truck 1.

  As shown in FIG. 1, the dump truck 1 is an unmanned traveling type capable of autonomous traveling in a transport area A which is a traveling path provided in advance in a mine. In the mine, for example, a loading area B for loading the load γ such as earth and sand on the dump truck 1 with an excavator β, a discharging area C for discharging the loading γ loaded in the loading area B, and maintenance And a parking area D where the dump truck 1 is parked. These areas B to D are connected by a transfer area A. In the mine, a control center 11 that transmits and receives predetermined information to and from the dump truck 1 and performs traffic control such as traveling of the plurality of dump trucks 1 is installed.

  As shown in FIG. 2, the dump truck 1 includes a vehicle main body 1a, a driver's seat 1b that is a cabin provided on the upper front side of the vehicle main body 1a, a loading platform 1c that can be raised and lowered on the vehicle main body 1a, A hoist cylinder (not shown) that moves the loading platform 1c up and down, and left and right front wheels 1d and rear wheels 1e that support the vehicle body 1a so as to travel are provided.

  As shown in FIG. 3, the dump truck 1 includes a travel drive device 3. The travel drive device 3 includes an engine 3a, a power generator 3b driven by the engine 3a, a power control device 3c to which power generated by the power generator 3b is supplied, and travel for driving the rear wheels 1e. A motor 3d. The power supplied to the travel motor 3d is controlled by the power control device 3c. The power control device 3 c is connected to the controller 4 and controlled by the controller 4. As shown in FIG. 4, the controller 4 includes a steering motor 3e of a steering device for steering the vehicle main body 1a and a brake device 3f that is a braking device for braking the vehicle main body 1a via the power control device 3c. Etc. are also controlled.

  On the front side of the vehicle main body 1a, an external environment recognition device 2 for recognizing the periphery of the vehicle main body 1a, particularly the front in the traveling direction is attached. The external environment recognition device 2 detects obstacles on the recognized transport area A, in particular, the forward vehicle α, and as shown in FIG. 2, a plurality of, for example, attached at different positions in the height direction (vertical direction) Two millimeter wave sensors 2a and 2b are provided.

  The millimeter wave sensors 2a and 2b are obstacle detection units that detect obstacles such as the forward vehicle α based on the millimeter wave that is irradiated and reflected by the millimeter wave, and the irradiation direction of the millimeter wave, that is, the detection direction is an angle in the horizontal direction. Fixed and attached. The millimeter wave sensors 2a and 2b irradiate millimeter waves over an irradiation range of about 3 ° to 5 °, for example, from the horizontal direction to the vertical direction. The millimeter wave sensors 2a and 2b are attached so as to be aligned in the vertical direction which is the vertical direction which is the center position in the width direction of the front surface of the vehicle main body 1a.

  The millimeter wave sensor 2a is attached at a height position of about 1.5 m from the ground, for example, and the millimeter wave sensor 2b is attached at a height position of about 4 m to 5 m from the ground, for example. These millimeter wave sensors 2a and 2b are configured to detect a distant vehicle, and the upper millimeter wave sensor 2b has a position closer to the vehicle body 1a than the lower millimeter wave sensor 2a. It has become.

  As shown in FIG. 4, the vehicle main body 1a detects positions of a stereo camera 2c, a laser radar 2d, and a vehicle main body 1a for detecting a situation outside the vehicle main body 1a in addition to the millimeter wave sensors 2a and 2b. A GPS device 2e as a position detection unit, an IMU device 2f as an inclination detection unit for detecting the inclination of the vehicle main body 1a, a vehicle speed sensor 2g for detecting the vehicle speed of the vehicle main body 1a, and the like are attached as in-vehicle sensors. Yes.

  The controller 4 includes an environment recognition unit 5 for recognizing the surroundings (external environment) of the vehicle body 1a, a self-position estimation unit 6 for estimating the self-position of the vehicle body 1a, and a load loaded on the loading platform 1c. A load weight detector 7 for detecting the load weight of γ is connected. The environment recognition unit 5 receives detection information detected by the external environment recognition device 2, and acquires external information such as the forward vehicle α and the road shoulder position based on the detection information. That is, the environment recognizing unit 5 detects the obstacles such as the front vehicle α using the millimeter wave sensors 2a and 2b, and also, based on the shooting information with the stereo camera 2c and the detection information with the laser radar 2d, for example, The occurrence of dust on the shoulder of A and the conveyance area A is detected.

  The environment recognizing unit 5 applies the self-position estimated by the self-position estimating unit 6 based on the traveling position information detected by the GPS device 2e to the map information stored in the storage unit 8, and the like. It is also a detection information correction unit that calculates an inclination angle and corrects detection information of the upper or lower millimeter wave sensors 2a and 2b in accordance with the calculated inclination angle.

  The self-position estimation unit 6 receives detection information detected by, for example, the GPS device 2e, the IMU device 2f, the vehicle speed sensor 2g, and the like, and based on this detection information, the self-position estimation unit 6 at the time of detection in the transport area A of the vehicle body 1a Estimate the position. The self-position estimation unit 6 is connected to a storage unit 8 in which map information related to the mine where the dump truck 1 travels is stored in advance, and compares the travel position information by the GPS device 2e with the map information stored in the storage unit 8. To estimate the self-position at the time of detection. The map information stored in the storage unit 8 also includes inclination angle information related to the inclination angle of each location on the transport area A where the dump truck 1 on the mine travels. The storage unit 8 also stores information for sharing the roles of detection by the millimeter wave sensors 2a and 2b in accordance with the traveling environment in the transport area A on the map information. As this information, the uphill front position information and downhill end position information detected by the upper millimeter wave sensor 2b, the uphill end position information and the downhill end position information detected by the lower millimeter wave sensor 2a, and the downhill position information. There is location information before the slope.

  The load weight detection unit 7 is based on a strain amount detected by a load cell (not shown) provided at a predetermined location of the vehicle body 1a, for example, from a load weight table or the like determined in advance corresponding to the strain amount. A load weight of the load γ loaded on 1c is calculated, and load weight information corresponding to the calculated load weight is output to the controller 4. The environment recognizing unit 5 refers to a blot amount table that determines the amount of smear of the dump truck 1 in accordance with the load weight based on the load weight information output from the load weight detecting unit 7, and determines the amount of smear of the dump truck 1. The detection information of the millimeter wave sensors 2a and 2b is corrected according to the calculated amount of blur. The load weight detection unit 7 detects the load weight of the load γ from the displacement of the suspension (not shown) or the change in hydraulic pressure that is converted according to the load weight of the load γ loaded on the loading platform 1c. Also good.

  The controller 4 is connected to a communication unit 9 for transmitting and receiving predetermined information to and from the control center 11, and is estimated by the external environment information detected by the environment recognition unit 5 and the self-position estimation unit 6 via the communication unit 9. The position information related to the self position is transmitted to the control center 11, and the autonomous traveling information of the dump truck 1 is received from the control center 11.

  The control center 11 manages the operation of each dump truck 1 based on the storage unit 12 in which map information of a mine such as the transport area A where each dump truck 1 travels is stored in advance, and the map information stored in the storage unit 12. The operation management part 13 to be provided. The operation management unit 13 is also a communication unit that transmits conveyance information such as a destination, a travel route, and a travel permitted area of the dump truck 1 to the communication unit 9 of the predetermined dump truck 1.

  The operation management unit 13 is connected to a vehicle allocation management unit 14 that manages vehicle allocation of the dump truck 1 and a traffic control unit 15 that controls traffic of all vehicles traveling in the mine, and is stored in the storage unit 12. Based on the information, the vehicle allocation management information output from the vehicle allocation management unit 14, and the traffic control information output from the traffic control unit 15, the operation management of each dump truck 1 or the like is performed in comparison with a predetermined operation pattern or the like. Data is created, and conveyance information of each dump truck 1 based on the operation management data is wirelessly transmitted to each dump truck 1. In each dump truck 1, the power control device 3 c is controlled by the controller 4 based on the conveyance information received from the operation management unit 13 of the control center 11, and each dump truck 1 travels autonomously.

<Detection method>
Next, detection of the forward vehicle α using the millimeter wave sensors 2a and 2b of the dump truck 1 according to the first embodiment will be described with reference to FIGS. FIG. 5 is an explanatory diagram showing detection of the forward vehicle α on the flat road of the dump truck 1. FIG. 6 is an explanatory diagram showing detection of the forward vehicle α at a position before the uphill of the dump truck 1. FIG. 7 is an explanatory diagram showing detection of the forward vehicle α at the position before the end of the uphill of the dump truck 1. FIG. 8 is an explanatory diagram showing detection of the forward vehicle α at the position before the downhill of the dump truck 1. FIG. 9 is an explanatory diagram showing detection of the forward vehicle α at the position before the end of the downhill of the dump truck 1.

(Flat road)
In a state where the vehicle travels on a flat road in the transfer area A, as shown in FIG. 5, the millimeter wave in the millimeter wave irradiation range a1 at the lower millimeter wave sensor 2a and at the upper millimeter wave sensor 2b. Each of the irradiation ranges b1 includes a forward vehicle α that travels ahead, and the forward vehicle α can be detected. The environment recognizing unit 5 calculates the inclination of the vehicle main body 1a from the map information stored in the storage unit 8 based on the self position estimated by the self position estimating unit 6, and is currently running from the calculated inclination. When the road surface of the transport area A is determined to be a flat road, the forward vehicle α is detected by each of the millimeter wave sensors 2a and 2b.

  At this time, when the controller 4 compares the detection information by the lower millimeter wave sensor 2a and the detection information by the upper millimeter wave sensor 2b, and the difference between the detected detection information is equal to or greater than a predetermined threshold value In the case of false detection, if necessary, an error lamp (not shown) provided in the driver's seat 1b or the like is turned on, or the vehicle a ahead is detected based on detection information on the higher risk side, The forward vehicle α is detected again by the millimeter wave sensors 2a and 2b.

(Uphill)
In a state where the vehicle is traveling at a position near the uphill in the conveyance area A, the conveyance area A is inclined forward and upward as shown in FIG. The millimeter wave irradiation ranges a2 and b2 at the millimeter wave sensors 2a and 2b are reduced and narrowed. Specifically, the forward vehicle α traveling uphill cannot be detected in the millimeter wave irradiation range a2 of the lower millimeter wave sensor 2a and cannot be detected.

  On the other hand, the forward vehicle α traveling uphill is included in the millimeter wave irradiation range b2 of the upper millimeter wave sensor 2b and can be detected. Based on the self-position estimated by the self-position estimating unit 6, the environment recognizing unit 5 determines the travel position on the transport area A that is currently traveling from the map information stored in the storage unit 8 and the pre-uphill position information. , The forward vehicle α is detected based on the detection information output from the upper millimeter wave sensor 2b.

  At the same time, the environment recognition unit 5 calculates the inclination angle of the uphill by applying the self-position estimated by the self-position estimation unit 6 to the map information stored in the storage unit 8, and the calculated inclination angle. Accordingly, the detection information of the upper millimeter wave sensor 2b is corrected. Specifically, the distance to the preceding vehicle α is the sum of the distance from the self-position to the starting point of the uphill and the traveling distance of the uphill according to the inclination angle of the uphill.

(Uphill end)
In a state where the vehicle is traveling in the position before the end of the uphill in the conveyance area A, as shown in FIG. 7, the conveyance area A is inclined forward and downward, and the vehicle travels on the inclined conveyance area A ahead. The preceding vehicle α cannot enter the millimeter wave irradiation range b3 of the upper millimeter wave sensor 2b and cannot be detected.

  On the other hand, in the millimeter wave irradiation range a3 of the lower millimeter wave sensor 2a, a forward vehicle α passing through an uphill and traveling on a flat road is detected. Based on the self-position estimated by the self-position estimating unit 6, the environment recognizing unit 5 travels on the transport area A that is currently traveling from the map information stored in the storage unit 8 and the position information before the uphill end. When it is determined that the position is the position before the end of the uphill, the forward vehicle α is detected based on the detection information output from the lower millimeter wave sensor 2a.

  At the same time, the environment recognition unit 5 calculates the inclination angle of the uphill by applying the self-position estimated by the self-position estimation unit 6 to the map information stored in the storage unit 8, and the calculated inclination angle. Accordingly, the detection information of the lower millimeter wave sensor 2a is corrected. Specifically, the distance from the self-position corresponding to the inclination angle of the uphill to the end of the uphill and the distance traveled on the flat road surface is defined as the distance to the forward vehicle α.

(Before Downhill)
As shown in FIG. 8, in the state where the vehicle is traveling in the near position approaching the downhill in the conveyance area A, the conveyance area A is inclined forward and downward, and travels in the inclined conveyance area A in the front. The forward vehicle α to be detected does not enter the millimeter wave irradiation range b4 of the upper millimeter wave sensor 2b and cannot be detected.

  On the other hand, in the millimeter wave irradiation range a4 of the lower millimeter wave sensor 2a, the forward vehicle α traveling downhill is included and can be detected. Based on the self-position estimated by the self-position estimating unit 6, the environment recognizing unit 5 determines the travel position on the transport area A that is currently traveling from the map information and the downhill-front position information stored in the storage unit 8. , The forward vehicle α is detected based on the detection information output from the lower millimeter wave sensor 2a.

  At the same time, the environment recognizing unit 5 calculates the inclination angle of the downhill by applying the self-position estimated by the self-position estimating unit 6 to the map information stored in the storage unit 8, and the calculated inclination angle. Accordingly, the detection information of the lower millimeter wave sensor 2a is corrected. Specifically, a distance obtained by adding the distance from the own position to the starting point of the downhill and the traveling distance of the downhill according to the inclination angle of the downhill is defined as the distance to the forward vehicle α.

(Downhill end)
In a state where the vehicle is traveling at a position before the end of the downhill in the conveyance area A, as shown in FIG. 9, the conveyance area A is inclined forward and upward, and each millimeter is moved by the inclined conveyance area A. The millimeter wave irradiation ranges a5 and b5 at the wave sensors 2a and 2b are reduced and narrowed. That is, in the millimeter wave irradiation range a5 of the lower millimeter wave sensor 2a, the forward vehicle α passing through the downhill and traveling on the flat road does not enter and cannot be detected.

  On the other hand, in the millimeter wave irradiation range b5 of the upper millimeter wave sensor 2b, a forward vehicle α passing through a downhill and traveling on a flat road is detected. Based on the self-position estimated by the self-position estimating unit 6, the environment recognizing unit 5 travels on the transport area A currently traveling from the map information stored in the storage unit 8 and the position information before the downhill end. When the position is determined to be the position before the downhill end, the forward vehicle α is detected based on the detection information output from the upper millimeter wave sensor 2b.

  At the same time, the environment recognizing unit 5 calculates the inclination angle of the downhill by applying the self-position estimated by the self-position estimating unit 6 to the map information stored in the storage unit 8, and the calculated inclination angle. Accordingly, the detection information of the upper millimeter wave sensor 2b is corrected. Specifically, a distance obtained by adding the distance from the self-position corresponding to the inclination angle of the downhill to the end of the downhill and the traveling distance of the flat road surface is set as the distance to the forward vehicle α.

(Travel control)
The controller 4 manages the operation of the control center 11 through the communication unit 9 as position information, using the preceding vehicle information related to the preceding vehicle α detected by the environment recognition unit 5 and the self-location information estimated by the self-position estimation unit 6. To the unit 13. At this time, the controller 4 corrects the distance information to the preceding vehicle α calculated based on the detection information from the millimeter wave sensors 2 a and 2 b in accordance with the amount of blur of the dump truck 1.

  Based on the position information transmitted from each dump truck 1, the control center 11 is output from the map information stored in the storage unit 12, the dispatch management information output from the dispatch management unit 14, and the traffic control unit 15. The operation management unit 13 creates conveyance information for each dump truck 1 considering the traffic control information, and wirelessly transmits the created conveyance information to the communication unit 9 of each dump truck 1. Each dump truck 1 is controlled by the controller 4 based on the conveyance information received from the operation management unit 13 of the control center 11 and is autonomously traveling in consideration of the position and traveling speed of the preceding vehicle α. The

  In particular, the operation management unit 13 of the control center 11 compares the position information of the obstacle detected by the environment recognition unit 5 with the information of the operation management unit 13, identifies the vehicle of the detected obstacle, and sends it to the dump truck 1. Wireless transmission. Alternatively, when it is determined that the obstacle cannot be identified, the operation management unit 13 activates a vehicle such as a service car to check the obstacle, and activates and removes a maintenance car such as a grader as necessary. . At the same time, conveyance information including traveling / stop / avoidance control according to the analyzed obstacle is wirelessly transmitted to each dump truck 1 to control autonomous traveling of each dump truck 1 and to an obstacle of a predetermined dump truck 1 To avoid collisions.

<Effect>
As described above, the dump truck 1 according to the first embodiment has a configuration in which a plurality of, for example, two fixed millimeter wave sensors 2a and 2b are attached to different positions in the height direction of the vehicle body 1a. With this configuration, even when the gradient of the transport area A where the dump truck 1 travels is changed, the millimeter wave irradiation ranges a1 and b1 at the millimeter wave sensors 2a and 2b are shifted in the vertical direction. The front vehicle α that cannot be detected by the millimeter wave sensors 2a and 2b can be detected by the other millimeter wave sensors 2b and 2a.

  In particular, the forward vehicle α that cannot be detected without entering the millimeter wave irradiation ranges a2 and a5 of the lower millimeter wave sensor 2a at the position before the uphill shown in FIG. 6 or the position before the end of the downhill shown in FIG. It is possible to detect within the millimeter wave irradiation ranges b2 and b5 of the upper millimeter wave sensor B. Further, at the position before the end of the uphill shown in FIG. 7 or the position before the downhill shown in FIG. 8, the forward vehicle α that cannot be detected without entering the millimeter wave irradiation ranges b3 and b4 of the upper millimeter wave sensor 2b is It can be detected by entering the millimeter wave irradiation range a3, a4 of the side millimeter wave sensor 2a. Therefore, also in the conveyance area A where the gradient changes, the forward vehicle α can be detected appropriately, and the detection range of the forward vehicle α on the dump truck 1 can be expanded.

  Furthermore, the detection information of the millimeter wave sensors 2a and 2b changes according to the amount of smear of the dump truck 1 corresponding to the load weight of the load γ of the loading platform 1c. For this reason, the environment recognition unit 5 corrects the detection information of the millimeter wave sensors 2 a and 2 b based on the loading weight information detected by the loading weight detection unit 7. As a result, the calculation error such as the distance to the preceding vehicle α due to the change in the load weight of the load γ of the dump truck 1 can be reduced, and the position information transmitted to the control center 11 can be more accurate. The operation of the dump truck 1 can be managed more accurately.

[Second Embodiment]
FIG. 10 is a schematic view showing a dump truck 1A according to the second embodiment of the present invention. FIG. 11 is a schematic configuration diagram showing the relationship between the dump truck 1A and the control center 11. As shown in FIG. The second embodiment is different from the first embodiment described above in that the first embodiment uses two fixed millimeter wave sensors 2a and 2b attached at different positions in the height direction to drive the vehicle α ahead. In the second embodiment, the forward vehicle α is detected by one variable millimeter wave sensor 21 whose detection direction is variable. In the second embodiment, the same or corresponding parts as those in the first embodiment are denoted by the same reference numerals.

<Configuration>
In the second embodiment, as shown in FIG. 10, the millimeter wave sensor 21 is the center position in the width direction of the front surface of the vehicle main body 1a of the dump truck 1A, similarly to the millimeter wave sensor 2a according to the first embodiment. For example, it is attached at a height of about 1.5 m from the ground. As shown in FIG. 11, the millimeter wave sensor 21 has a detection direction adjustment unit that allows the angle of the central direction of the millimeter wave irradiation range a in the millimeter wave sensor 21, that is, the detection direction (irradiation direction) b to be adjusted in the vertical direction. It is attached to the drive part 22 as. The drive unit 22 is connected to the controller 4 and is driven and controlled by the controller 4.

  In the millimeter wave sensor 21, the millimeter wave irradiation range a is changed by drive control of the drive unit 22 by the controller 4. When the millimeter wave sensor 21 determines that the self-position of the dump truck 1A is traveling on a flat road in the conveyance area A by the controller 4, the millimeter wave detection direction b of the millimeter wave sensor 21 is Adjusted horizontally.

<Detection method>
Next, detection of the forward vehicle α using the millimeter wave sensor 21 of the dump truck 1A according to the second embodiment will be described with reference to FIGS. 12 and 13. FIG. 12 is an explanatory diagram showing detection of the forward vehicle α at a position before the uphill of the dump truck 1A. FIG. 13 is an explanatory diagram showing detection of the forward vehicle α at the position before the end of the uphill end of the dump truck 1A.

  When the self-position of the dump truck 1A is determined by the controller 4 to be a predetermined position before reaching the predetermined uphill in the transport area A or a predetermined position before the end of the downhill as shown in FIG. The millimeter wave detection direction b of the millimeter wave sensor 21 is driven by the drive unit 22 by a predetermined angle θ upward from the horizontal direction to be the detection direction b ′. (Target gaze distance) c is adjusted upward. In this case, to reduce the irradiation range of the millimeter wave by the millimeter wave sensor 21 by the front conveyance area A calculated by applying the self-position of the dump truck 1A to the map information stored in the storage unit 8 or the like. Correspondingly, the millimeter wave detection direction b in the millimeter wave sensor 21 may be gradually changed.

  Further, when the self-position of the dump truck 1A is determined by the controller 4 and the predetermined position before the end of the uphill as shown in FIG. 13, the millimeter wave detection direction b by the millimeter wave sensor 21 is horizontal. Driven by the drive unit 22 by a predetermined angle θ downward from the direction to the detection direction b ″, the millimeter wave irradiation position (target gaze distance) c of the millimeter wave sensor 21 is adjusted downward. In this case, the millimeter wave detection direction b of the millimeter wave sensor 21 may be gradually changed in correspondence with the irradiation range in which the forward vehicle α traveling in the flat front conveyance area A can be detected. .

<Effect>
As described above, in the dump truck 1A according to the second embodiment, the front vehicle α is detected by the single millimeter wave sensor 21 that can adjust the millimeter wave detection direction b in the vertical direction. When the controller 4 determines that the self position of 1A is a predetermined position before reaching a predetermined uphill in the conveyance area A or a predetermined position before the end of the downhill, the millimeter wave sensor 21 detects the millimeter position. The wave detection direction b is adjusted upward. If the controller 4 determines that a predetermined position before reaching a predetermined downhill in the transport area A or a predetermined position before the end of the uphill is detected by the controller 4, the millimeter wave sensor 21 detects the millimeter wave. The direction b is adjusted downward.

  As a result, even if the gradient of the transport area A changes, the controller is based on the inclination information calculated by applying the self-position estimated by the self-position estimation unit 6 to the map information stored in the storage unit 8. 4, the millimeter wave detection direction b of the millimeter wave sensor 21 is appropriately adjusted in the vertical direction so that the front vehicle α can be detected by the single variable millimeter wave sensor 21 even in the conveyance area A where the gradient changes. It can be detected properly.

[Third Embodiment]
FIG. 14 is a schematic view showing a dump truck 1B according to the third embodiment of the present invention. The third embodiment differs from the first embodiment described above in that the first embodiment detects the forward vehicle α with the two millimeter wave sensors 2a and 2b whose detection directions are fixed. In the third embodiment, the forward vehicle α is detected by one millimeter wave sensor 2a having a fixed detection direction and one millimeter wave sensor 21 having a variable detection direction. In the third embodiment, the same or corresponding parts as those in the first and second embodiments are denoted by the same reference numerals.

<Configuration>
In the third embodiment, as shown in FIG. 14, the millimeter wave sensor 2a is the center position in the width direction of the front surface of the vehicle body 1a of the dump truck 1B, as in the first embodiment. Is installed at a height of about 1.5m. The millimeter wave sensor 21 is mounted in a state in which the height direction is different from that of the millimeter wave sensor 2a, that is, above the millimeter wave sensor 2a, in a state in which the vertical direction is aligned. The millimeter wave sensor 21 is attached to the drive unit 22 as in the second embodiment, and is driven and controlled by the controller 4 via the drive unit 22.

<Detection method>
When the self-position of the dump truck 1B is determined by a predetermined flat road in the transport area A and the controller 4, only the fixed millimeter wave sensor 2a is turned on and output from the millimeter wave sensor 2a. Based on the detection information, the environment recognition unit 5 detects the forward vehicle α.

  On the other hand, the self-position of the dump truck 1B is a predetermined position before reaching a predetermined uphill in the transport area A or a predetermined position before the end of the downhill, and is measured by the millimeter wave sensor 2a. When the controller 4 determines that the vehicle 4 is located at a predetermined position where it is necessary to detect the forward vehicle α located above the wave irradiation range a, the variable millimeter wave sensor 21 is turned on. Next, the detection direction b of the millimeter wave sensor 21 is driven by the drive unit 22 above the horizontal direction by a predetermined angle θ, and the environment certification unit 5 is made to detect based on the detection information output from the variable millimeter wave sensor 21. To detect the forward vehicle α.

  Further, the self-position of the dump truck 1B is a predetermined position before reaching a predetermined downhill in the transport area A or a predetermined position before the end of the uphill, and is measured by the millimeter wave sensor 2a. When the controller 4 determines a predetermined position where the forward vehicle α located below the wave irradiation range a needs to be detected and the controller 4, as shown in FIG. 15, the fixed millimeter wave sensor 2a The front vehicle α does not enter the irradiation range “a” and cannot be detected. In this case, the variable millimeter wave sensor 21 is turned on, and the detection direction b of the millimeter wave sensor 21 is driven by the drive unit 22 below the horizontal direction by a predetermined angle θ to be the detection direction b ′. Based on the detection information output from the wave sensor 21, the environment recognition unit 5 detects the forward vehicle α.

<Effect>
As described above, the dump truck 1B according to the third embodiment includes the fixed millimeter-wave sensor 2a and the variable millimeter-wave sensor 21, and the fixed millimeter-wave sensor according to the change in the gradient of the transport area A. When it is necessary to detect the forward vehicle α outside the millimeter wave irradiation range a at 2a, the variable millimeter wave sensor 21 is driven by the drive unit 22 and the millimeter wave sensor 21 detects the millimeter wave. It is set as the structure which adjusts b.

  As a result, even if the gradient of the transport area A changes, the variable millimeter wave sensor is based on the inclination information calculated by applying the self-position estimated by the self-position estimation unit 6 to the map information. By adjusting the irradiation direction b of the millimeter wave at 21, the forward vehicle α outside the irradiation range a of the fixed millimeter wave sensor 2a can be detected, and the forward vehicle α is appropriately detected in the conveyance area A where the gradient changes. it can.

[Fourth Embodiment]
FIG. 16 is a schematic view showing a dump truck 1C according to the fourth embodiment of the present invention. The fourth embodiment differs from the third embodiment described above in that the third embodiment has a fixed millimeter-wave sensor 2a and a variable millimeter-wave sensor 21 attached at different positions in the height direction. On the other hand, in the fourth embodiment, the fixed millimeter wave sensor 2a and the variable millimeter wave sensor 21 are horizontally aligned and attached. In the fourth embodiment, the same or corresponding parts as those in the first to third embodiments are denoted by the same reference numerals.

<Configuration>
In the fourth embodiment, as shown in FIG. 16, the fixed millimeter wave sensor 2a and the variable millimeter wave sensor 21 are arranged horizontally from the center position in the width direction on the front surface of the vehicle main body 1a of the dump truck 1C. It is a position spaced apart at equal intervals in the direction (left-right direction), for example, at a height of about 1.5 m from the ground. The millimeter wave sensors 2a and 21 are mounted at equal height positions, and the millimeter wave detection direction b of each of the millimeter wave sensors 2a and 21 is inclined to the center position side in the width direction of the vehicle body 1a. Yes. The millimeter wave sensor 21 is driven and controlled by the controller 4 via the drive unit 22.

<Detection method>
At a predetermined position for detecting the forward vehicle α at a position that cannot be detected by the fixed millimeter wave sensor 2a, the variable millimeter wave sensor 21 is turned on, and the detection direction b of the millimeter wave sensor 21 is moved upward by a predetermined angle θ. Alternatively, it is driven downward by the drive unit 22. Then, based on the detection information output from the variable millimeter wave sensor 21, the environment recognition unit 5 detects the forward vehicle α.

<Effect>
As described above, in the dump truck 1C according to the fourth embodiment, the fixed millimeter wave sensor 2a and the variable millimeter wave sensor 21 are horizontally arranged. Based on this configuration, the variable millimeter wave sensor 21 is turned on according to the change in the gradient in the transport area A, and the millimeter wave irradiation range α of the millimeter wave sensor 21 is changed by the drive unit 22. The forward vehicle α outside the millimeter wave irradiation range a can be detected by the fixed millimeter wave sensor 2a. Therefore, it is possible to appropriately detect the forward vehicle α in the transfer area A where the gradient changes.

[Others]
In addition, this invention is not limited to embodiment mentioned above, Various deformation | transformation aspects are included. For example, the above-described embodiments have been described in order to explain the present invention in an easy-to-understand manner, and the present invention is not necessarily limited to those having all the configurations described.

  In each of the above embodiments, the unmanned traveling type dump trucks 1 to 1C have been described as examples. However, the present invention is not limited thereto, and may be a manned traveling type dump truck that can be operated by an operator. . Moreover, you may make it detect the preceding vehicles (alpha), such as a patrol car and a grader other than the other dump trucks 1-1C, the obstruction on the other conveyance area A, etc. Further, the map information is stored in the storage unit 8 of the dump trucks 1 to 1C, and the self-position of the dump trucks 1 to 1C, the inclination state, and the like are detected based on the map information stored in the storage unit 8. However, the map information stored in the storage unit 12 of the control center 11 is received by the dump trucks 1 to 1C, and the self-position and the like of the dump trucks 1 to 1C are detected based on the received map information. Good.

  Further, in each of the above embodiments, the configuration using the millimeter wave sensors 2a, 2b, and 21 as the obstacle detection unit for detecting the forward vehicle α has been described, but for example, other than a millimeter wave sensor such as a stereo camera or the like. It may be an obstacle detection unit. In particular, since the stereo camera is less affected by the dust covering the front field of view, the stereo camera is attached to the upper side where the height direction is different, and the millimeter wave sensor 2a and the like are attached to the lower side, thereby reducing detection of the front vehicle α due to dust. Can be prevented.

  In the first embodiment, two fixed millimeter wave sensors 2a and 2b attached at different positions in the height direction are used. In the second embodiment, one variable millimeter wave is used. In the third and fourth embodiments, the sensor 21 is used, and one fixed millimeter wave sensor 2a and one variable millimeter wave sensor 21 are used. The fixed millimeter wave sensors 2a and 2b and the variable millimeter wave sensor 21 may be used in appropriate combination according to the gradient state of the transport area A to be performed.

1, 1A, 1B, 1C Dump truck (Mine transport vehicle)
DESCRIPTION OF SYMBOLS 1a Vehicle main body 1b Driver's seat 1c Loading platform 1d Front wheel 1e Rear wheel 2a, 2b Millimeter wave sensor (obstacle detection part)
2c Stereo camera 2d Laser radar 2e GPS device (position detector)
2f IMU device 2g vehicle speed sensor 3 travel drive device 3a engine 3b generator 3c power control device 3d travel motor 3e steering motor 3f brake device 4 controller 5 environment recognition unit (detection information correction unit)
6 Self-position estimation unit 7 Load weight detection unit 8 Storage unit 9 Communication unit 11 Control center 12 Storage unit 13 Operation management unit 14 Vehicle dispatch management unit 15 Traffic control unit 21 Millimeter wave sensor (obstacle detection unit)
22 Drive unit (detection direction adjustment unit)

Claims (6)

A vehicle body,
An obstacle detection unit for detecting an obstacle in the forward direction of the vehicle body;
A detecting direction adjustment unit to adjust the detection direction of the obstacle detecting unit,
A position detection unit for detecting a traveling position;
A storage unit that stores map information including inclination angle information of the traveling road,
The detection direction adjustment unit adjusts the detection direction in the vertical direction based on the travel position detected by the position detection unit and the map information stored in the storage unit. . A vehicle body,
A plurality of obstacle detectors for detecting obstacles in the forward direction of the vehicle body;
A position detection unit for detecting a traveling position;
A storage unit that stores map information including inclination angle information of the traveling road ,
The plurality of obstacle detection units are attached to different positions in the height direction of the vehicle body, and based on the travel position detected by the position detection unit and the map information stored in the storage unit, A mine transport vehicle that determines which detection information detected by any of the obstacle detection units is used . In the mine transport vehicle according to claim 1 or 2 ,
A traveling position detected in the previous SL position detection unit, wherein based on the stored map information in the storage unit, detected information correcting unit for correcting the detection information of the obstacle detecting unit
A mine transport vehicle characterized by further comprising: In the mine transport vehicle according to claim 3 ,
Loading platform,
Additionally and a load weight detector for detecting a load weight of the cargo that is loaded on the loading platform,
The detection information correction unit further corrects the detection information of the obstacle detection unit based on the loading weight detected by the loading weight detection unit. A vehicle body,
An obstacle detection unit for detecting an obstacle in the forward direction of the vehicle body;
A detection direction adjustment unit that adjusts the detection direction of the obstacle detection unit in the vertical direction;
A position detection unit for detecting a traveling position;
A storage unit for storing map information including inclination angle information of the traveling road;
A detection information correction unit that corrects the detection information of the obstacle detection unit based on the travel position detected by the position detection unit and the map information stored in the storage unit;
A mine transport vehicle characterized by comprising: A vehicle body,
A plurality of obstacle detectors for detecting obstacles in the forward direction of the vehicle body;
A position detection unit for detecting a traveling position;
A storage unit for storing map information including inclination angle information of the traveling road;
A detection information correction unit that corrects the detection information of the obstacle detection unit based on the travel position detected by the position detection unit and the map information stored in the storage unit ;
The plurality of obstacle detection units are attached to different positions in the height direction of the vehicle main body.