WO2019188015A1 - Dispositif de support d'inversion de machine de travail - Google Patents

Dispositif de support d'inversion de machine de travail Download PDF

Info

Publication number
WO2019188015A1
WO2019188015A1 PCT/JP2019/008367 JP2019008367W WO2019188015A1 WO 2019188015 A1 WO2019188015 A1 WO 2019188015A1 JP 2019008367 W JP2019008367 W JP 2019008367W WO 2019188015 A1 WO2019188015 A1 WO 2019188015A1
Authority
WO
WIPO (PCT)
Prior art keywords
distance
work machine
measuring device
vehicle stop
road surface
Prior art date
Application number
PCT/JP2019/008367
Other languages
English (en)
Japanese (ja)
Inventor
大基 手塚
Original Assignee
日立建機株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 日立建機株式会社 filed Critical 日立建機株式会社
Publication of WO2019188015A1 publication Critical patent/WO2019188015A1/fr

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88—Lidar systems specially adapted for specific applications
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88—Lidar systems specially adapted for specific applications
    • G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes

Definitions

  • the present invention relates to a backward support technology for supporting backward running of a work machine such as a mining dump truck.
  • a work machine such as a mining dump truck.
  • it is related to the technology for assisting retreat in the earth.
  • Patent Document 1 states that “the load of the vessel is discharged at a position where the rear end of the vehicle body or rear end of the rear tire is projected onto the road surface or a position on the road surface which is a predetermined distance away from the projected position.
  • Set a reference distance guideline or a guideline distance for earthwork during the earthing work and display the guideline for the earthwork distance or a guideline for the distance during the earthing operation on the display.
  • a display system for displaying a rear view of a transport vehicle is disclosed.
  • the present invention has been made in view of the above situation, and an object of the present invention is to provide a technique capable of guiding a transport vehicle so that the vehicle can be stopped at an appropriate earthing position at the time of earthing.
  • the present invention relates to a backward support device for a work machine that supports the backward running of the work machine, and measures the distance to the detected object by irradiating a laser and receiving the reflected light reflected by the detected object.
  • a first distance measuring device and a second distance measuring device wherein the first distance measuring device and the second distance measuring device are a first scan surface and a second distance formed by a laser irradiation surface of the first distance measuring device.
  • a second scan plane composed of a laser irradiation surface of the measuring device is orthogonalized, and the first scan plane is perpendicular to the horizontal plane of the vehicle body including the longitudinal axis and the horizontal axis of the vehicle body of the work machine, and the horizontal plane of the vehicle body
  • the second scanning plane has a measuring device disposed on the work machine with a depression angle, and based on the first distance measured by the first distance measuring device and the second distance measured by the second distance measuring device.
  • Progress of work machine Detects the distance to the wheel stop located direction and shape of the bollard, the working machine is characterized in that retraction support apparatus for a working machine and calculates the distance to the contact with the bollard.
  • the transport vehicle can be guided so that the vehicle can be stopped at an appropriate earthing position when earthing.
  • (A) is the schematic diagram for demonstrating the vehicle stop detection process which concerns on embodiment of this invention
  • (b) is the schematic diagram (dump) which plotted the measurement result of the 1st distance measuring device which concerns on embodiment of this invention Track left side view).
  • the flowchart of the vehicle stop position estimation process which concerns on embodiment of this invention.
  • (A) is a flowchart of the vehicle stop width direction shape detection processing according to the embodiment of the present invention
  • (b) is an explanatory diagram of mapping in the vehicle stop width direction shape detection processing according to the embodiment of the present invention (top view of the dump truck) ).
  • the flowchart of the contact distance determination process which concerns on embodiment of this invention.
  • FIG. 1 The schematic diagram for demonstrating the vehicle stop detection process in case the pitch vibration has generate
  • (A) is a figure which shows the case where the road surface which concerns on embodiment of this invention is a plane, (b) is the road surface rotated by inclination-angle (theta) centering
  • (A) is a figure which shows inclination-angle (theta) in the case of the linear approximation of two or more embodiment which concerns on embodiment of this invention,
  • (b) is the case of two or more curve approximation which concerns on embodiment of this invention.
  • the schematic diagram for demonstrating the back detection process in case the dump truck which concerns on embodiment of this invention is drive
  • the schematic diagram for demonstrating the back detection process in case the dump truck which concerns on embodiment of this invention is drive
  • FIG. 1 is an explanatory diagram showing the surrounding environment when the dump truck 1 according to the present embodiment is released.
  • FIG. 2 is a left side view of the dump truck 1.
  • FIG. 3 is a rear perspective view of the dump truck 1.
  • the dump truck 1 travels backward on the traveling road surface 1001 toward a vehicle stop (Bund) 1002 disposed on the cliff when the dump truck 1 is dumped on the dumping ground 1003 under the cliff.
  • the dump truck 1 includes a right front wheel 3r and a left front wheel 3l (see FIG. 2) at a front lower part of a body frame 2 (see FIG. 2), and a right rear wheel 4r and a left rear wheel 4l at a rear lower part. Further, a rear axle 7 is provided at the rear portion of the vehicle body frame 2.
  • a driver's seat 5 (see FIG. 2) is provided at the front upper part of the body frame 2, and a vessel 6 is provided at the rear upper part.
  • the dump truck 1 is provided with a backward support device 100 that supports the backward traveling of the dump truck 1.
  • the backward assistance device 100 includes an imaging device (camera) 102 that captures the rear of the dump truck 1, a contact distance calculation device 101 that calculates a distance (contact distance) to the car stop 1002, and a display image generation device 103 (see FIG. 4). ), An image display device (monitor) 104 (see FIG. 4), an earthmoving place entry determination device 105 (see FIG. 4), an earthing place entry notification device (buzzer, lamp) 106 (see FIG. 4), including.
  • the video display device 104 and the earthing place entry notification device 106 are arranged in the driver's seat 5.
  • the contact distance calculation device 101 scans the back of the dump truck 1 to accumulate the car stop shape and calculates the distance (contact distance) until the dump truck 1 contacts the car stop 1002.
  • the contact distance calculation device 101 includes a measurement device (scanner) 200 including a plurality of laser scanners, a self-position estimation device 300 that detects the self-position of the dump truck 1, a sensor output from the measurement device 200, and a self-position estimation device 300.
  • the vehicle stop detection device 10 that detects the vehicle stop 1002 based on the self-position from the vehicle and the vehicle stop guidance device 60 that calculates information for guiding the dump truck 1 to the detected vehicle stop 1002 (see FIG. 5).
  • the position of the dump truck 1 when the backward support device 100 starts operating is the origin
  • the traveling direction at the moment when the backward support device 100 starts operating is the y axis
  • the vehicle body height of the dump truck 1 is An orthogonal coordinate system 400 is used in which the axis is the z axis and the axis orthogonal to the two axes of the y axis and the z axis is the x axis.
  • the measuring device 200 includes a first distance measuring device 201 and a second distance measuring device 202.
  • the measuring apparatus 200 is installed between the left rear wheel 4l and the right rear wheel 4r at the rear of the dump truck 1, more specifically, above the rear axle 7 and below the vessel 6.
  • the first distance measuring device 201 and the second distance measuring device 202 do not need to be arranged at the same height and may not be symmetrical.
  • the first distance measuring device 201 and the second distance measuring device 202 are, for example, a laser scanner (laser) that irradiates a laser beam in a fan shape, receives reflected light from the detected object, and detects the distance and direction to the detected object. Radar).
  • the first distance measuring device 201 and the second distance measuring device 202 include a laser irradiation surface (hereinafter referred to as “second scan surface”) 22 of the second distance measuring device 202 and a laser irradiation surface (hereinafter referred to as “second scanning surface”) of the first distance measuring device 201. 21) (referred to as “first scan plane”).
  • the orthogonality is not limited to the case where the normal vectors of the first scan plane 21 and the second scan plane 22 are strictly perpendicular, but the same detected object as the detected object detected by the first distance measuring device 201. This includes the case where the first distance measuring device 201 and the second distance measuring device 202 are arranged so that the second scan surface 22 faces in a direction in which the shape in the width direction of the body can be detected.
  • the first scanning surface 21 extends at least vertically downward from the vehicle body horizontal plane H including the front and rear axes and the left and right axes of the vehicle body frame 2 to the direction parallel to the vehicle body horizontal plane H toward the rear of the vehicle body.
  • the first distance measuring device 201 is installed on the dump truck 1 so as to cover it.
  • the second distance measuring device 202 uses a position P1 where the second scanning surface 22 and the traveling road surface 1001 intersect, and the rear end of the left rear wheel 4l and the right rear wheel 4r as the traveling road surface 1001.
  • the second distance measuring device 202 is determined by the detection distance of the second distance measuring device 202, the installation depression angle ⁇ of the second distance measuring device 202 with respect to the vehicle body horizontal plane H, and the shielding of the dump truck 1 with respect to the second scan surface 22. It is installed at a position where the length D2 (see FIG. 3) of the intersection line between the road surface 1001 and the second scan surface 22 is longer than the wheel width (outer width) of the dump truck 1. By installing in this way, it is possible to scan in advance the region through which the wheels of the dump truck 1 pass.
  • first distance measuring device 201 and the second distance measuring device 202 are not limited to the configuration provided one by one, and each measuring device may be configured using a plurality of laser scanners. Further, the first scanning surface 21 is not limited to one for the first distance measuring device 201, and a plurality of first scanning surfaces 21 may be provided. Similarly, the second scanning surface 22 is not limited to one for the second distance measuring device 202 and may be plural.
  • the photographing apparatus 102 is a camera that acquires an image behind the dump truck 1, for example.
  • the imaging device 102 is a first scan behind the dump truck 1, more specifically above the measuring device 200 and below the vessel 6, between the left rear wheel 4 l and the right rear wheel 4 r.
  • the surface 21 and the second scanning surface 22 are installed so as to be included in the visual field range.
  • the vehicle coordinate system of the dump truck 1 is a coordinate whose origin is the center of gravity of the dump truck 1, the vehicle longitudinal axis direction on the horizontal plane of the vehicle body is the y axis, the horizontal axis direction is the x axis, and the direction perpendicular to the horizontal plane of the vehicle body is the z axis direction. It is a system.
  • FIG. 4 is a block diagram showing the functional configuration of the backward support device 100 and FIG. 5 is the functional configuration of the contact distance calculation device 101, respectively.
  • the self-position estimating device 300 is connected to each of a wheel speed measuring device (wheel speed sensor) 301 and a steering angle measuring device (yaw rate sensor, turning angular velocity sensor) 302 provided in the dump truck 1.
  • the rotational speed is acquired, and the measurement result of the turning angular speed of the dump truck 1 is acquired from the steering angle measuring device 302.
  • the self-position estimation apparatus 300 calculates the speed and angular velocity of the dump truck 1 and the position and orientation from the origin of the aforementioned orthogonal coordinate system 400 (see FIG. 1) by executing, for example, dead reckoning processing.
  • an IMU inertia measurement device
  • a steering angle sensor 302 may be used instead of the yaw rate sensor as the steering angle measurement device 302 for the purpose of estimating the turning angular velocity.
  • a GPS Global Positioning System
  • a geomagnetic sensor may be used instead of the self-position estimation apparatus 300.
  • the vehicle stop detection device 10 includes a first vehicle stop detection device 40 that estimates the position of the vehicle stop 1002 and a second vehicle stop detection device 50 that estimates the shape of the vehicle stop 1002 in the width direction.
  • the vehicle stop guidance device 60 includes a vehicle stop guidance determination device 61 and a vehicle body shape storage device 62.
  • the first vehicle stop detection device 40 includes a road surface estimation device 41 and a vehicle stop estimation device 42.
  • the output of the first distance measuring device 201 described above is connected to respective inputs of the road surface estimating device 41 and the car stop estimating device 42.
  • the output of the road surface estimation device 41 is connected to the input of a vehicle stop estimation device 42 and a pitch vibration correction device 51 described later.
  • the output of the first distance measuring device 201 is further connected to the input of the car stop estimating device 42.
  • First distance information R1i output from the first distance measuring device 201 (i: indicates the laser irradiation angle ⁇ in the first distance measuring device 201, for example, ⁇ 45 ⁇ i ⁇ 225, and the second distance information R2i described later is also the same). Includes a measurement point and a distance to the measurement point.
  • the road surface estimation device 41 extracts the distance information indicating the measurement point and distance estimated as the road surface from the first distance information R1i, and calculates the road surface line. Then, the inclination angle ⁇ (see FIG. 12) of the road surface line with respect to the vehicle body horizontal plane H including the front and rear axes and the left and right axes of the vehicle body frame 2 is calculated, and the road surface inclination with respect to the vehicle body horizontal plane H is calculated.
  • the inclination angle ⁇ is also referred to as a pitch angle ⁇ .
  • the vehicle stop estimation device 42 extracts distance information of what is estimated to be the vehicle stop 1002 from the first distance information R1i measured by the first distance measurement device 201, the intersection of the road surface and the vehicle stop 1002, and the inclination of the vehicle stop 1002 with respect to the road surface. Is calculated.
  • the second vehicle stop detection device 50 includes a pitch vibration correction device 51, a vehicle stop shape estimation device 52, and a vehicle stop shape storage device 53.
  • the input of the pitch vibration correcting device 51 is connected to the respective outputs of the second distance measuring device 202 and the road surface estimating device 41.
  • the output of the pitch vibration correcting device 51 is connected to the input of the vehicle stop shape estimating device 52.
  • the input of the car stopper shape estimation device 52 is further connected to the output of the self-position estimation device 300.
  • the vehicle stop shape storage device 53 is connected to a vehicle stop shape estimation device 52 and a vehicle stop guidance determination device 61 described later.
  • the pitch vibration correcting device 51 removes the influence of pitch vibration from the second distance information R2i measured by the second distance measuring device 202 based on the inclination angle ⁇ of the road surface with respect to the vehicle body horizontal plane H estimated by the road surface estimating device 41. The correction process is executed.
  • the car stop shape estimating device 52 is a general SLAM (Simultaneous Localization and Mapping).
  • the topography in the traveling direction of the dump truck 1 is calculated as the shape of the vehicle stop 1002 in the vehicle width direction by a mapping method such as the above.
  • the car stop shape storage device 53 stores width direction shape information indicating the shape of the car stop 1002 in the vehicle width direction calculated by the car stop shape estimation device 52.
  • the vehicle stop shape estimation device 52 may refer to the vehicle stop shape information stored in the vehicle stop shape storage device 53 in order to calculate the width direction shape information more highly.
  • the stored vehicle stop shape information also refers to the display video generation device 103.
  • the vehicle stop guidance device 60 includes a vehicle stop guidance determination device 61 and a vehicle body shape storage device 62.
  • the input of the vehicle stop guidance determination device 61 is connected to the respective outputs of the vehicle stop estimation device 42 and the self-position estimation device 300, and is also connected to the vehicle stop shape storage device 53 and the vehicle body shape storage device 62, respectively.
  • the vehicle stop guidance determination device 61 reads information stored in the vehicle stop shape storage device 53 and the vehicle body shape storage device 62 as necessary.
  • the vehicle stop guidance determination device 61 is connected to the distance to the vehicle stop 1002 estimated by the vehicle stop estimation device 42, the inclination of the vehicle stop 1002, the width direction shape of the vehicle stop 1002 stored in the vehicle stop shape storage device 53, and the self-position estimation device 300. Based on the obtained turning angular velocity measured by the steering angle measuring device 302 and the vehicle body shape (including the size in the vehicle width direction) stored by the vehicle body shape storage device 62, the contact distance required for the determination of guidance is calculated. The vehicle stop guidance determination device 61 outputs the calculated contact distance to the earthing place entry determination device 105.
  • the display video generation device 103 superimposes the vehicle stop shape stored in the vehicle stop shape storage device 53 on the video acquired by the photographing device 102 and generates a display video.
  • the input of the display video generation device 103 is connected to the respective outputs of the photographing device 102 and the contact distance calculation device 101, and the output of the display video generation device 103 is connected to the input of the video display device 104.
  • the display video generation device 103 superimposes the vehicle stop shape on the display video in an identifiable manner.
  • the vehicle stop shape represented by the value of the orthogonal coordinate system 400 is converted into a pixel position using the self-position and posture of the dump truck 1 calculated by the self-position estimation apparatus 300.
  • the video display device 104 displays the display video generated by the display video generation device 103.
  • An example image 410 displayed on the image display device 104 is shown in FIG.
  • the vehicle stop shape 1002b is displayed in an identifiable manner on the image behind the dump truck 1 including the vessel 6, the left rear wheel 4l, and the right rear wheel 4r.
  • the display video generation device 103 When the video around the dump truck 1 can be acquired by the imaging device 102, the display video generation device 103 generates an overhead image from the video acquired by the imaging device 102, and adds a car stop shape 1002b to the generated overhead image.
  • a display image may be generated by superimposing.
  • a display image example 420 in this case is shown in FIG.
  • An icon image 1a representing the dump truck 1 is displayed at the center.
  • the conversion table and icon image 1a used when converting the acquired video into a bird's-eye view image are held in advance in a storage device such as a ROM provided in the backward support device 100.
  • the earthing place entry determination device 105 determines whether or not the dump truck 1 has entered the earthing place from the contact distance calculated by the car stop guidance determination device 61 and the earthing place predetermined by the distance from the car stop 1002. If it is determined and it is determined that the vehicle has entered, a notification signal is output to the earthing place entry notification device 106.
  • the input of the earthing place entry determination device 105 is connected to the output of the contact distance calculation device 101.
  • the output of the earthing place entry determination device 105 is connected to the input of the earthing place entry notification device 106.
  • the earthmoving place entry notification device 106 includes, for example, a buzzer and a lamp.
  • the earthing place entry notification device 106 outputs a sound from the buzzer or turns on the lamp when receiving the notification signal from the earthing place entry determination device 105.
  • the vehicle stop detection device 10, the vehicle stop guidance device 60, the self-position estimation device 300, the display image generation device 103, and the earthing place entry determination device 105 are a microcomputer device including a central processing unit, a storage device, an input / output circuit, and a communication circuit. It may be configured by a combination of hardware and software that realizes the function of each device, or each device may be configured by an arithmetic circuit.
  • FIG. 8A is a schematic diagram for explaining a vehicle stop detection process by the vehicle stop detection device 10.
  • FIG. 8B is a schematic diagram in which the measurement results of the first distance measuring device 201 are plotted.
  • FIG. 8A represents the distance to the detected object (including both the road surface and the vehicle stop 1002) measured by the first vehicle stop detection device 40.
  • the dotted line 1011 in FIG. Further, a black point 1012 in FIG. 8A indicates a measurement point measured by the first distance measuring device 201.
  • a black point 1013 in FIG. 8B indicates a position where the first distance measurement device 201 outputs the first distance information R1i on the orthogonal coordinates.
  • the scanner as the measuring device 200 rotates and irradiates the laser at ⁇ 45 ° to ⁇ 225 ° to incline the car stop 1002 from the rear end of the rear wheel of the dump truck 1.
  • the distance to each point arranged along the surface 1002a is calculated and output as the first distance information R1i.
  • the line of intersection between the first scan surface 21 and the traveling road surface 1001 becomes shorter.
  • the straight line 1021 substantially parallel to the horizontal direction and the vertical height
  • a straight line 1022 having a variable length is obtained.
  • the intersection 1023 of the two straight lines is an inflection point of the first distance information R1i, and can be estimated as a point where the road surface (t load ) and the vehicle stop (t berm ) are in contact with each other.
  • the second scan surface 22 calculates the distance to each point aligned in the width direction on the inclined surface 1002a, not the traveling road surface 1001. And output as the second distance information R2i. Thereafter, as the dump truck 1 further approaches the vehicle stop 1002, the second scan surface 22 moves toward the upper end of the inclined surface 1002a.
  • FIG. 9 is a flowchart showing the vehicle stop position estimation process.
  • the road surface estimation device 41 extracts first distance information estimated as a road surface from the first distance information R1i measured by the first distance measurement device 201 (S101). Specifically, the first distance information R1i whose distance from the road surface road_old estimated by the road surface estimation device 41 in the previous measurement is equal to or less than the first threshold value K1 is extracted.
  • the road surface estimation device 41 compares the number n of the first distance information R1i extracted as the road surface with a predetermined threshold value (road surface threshold Kn). When the number n of the extracted distance information is less than the road threshold Kn (S102 / NO), the road line t road set to an initial value ini_t road (S108), the process proceeds to S104 to be described later.
  • the road surface estimation device 41 calculates the road surface road load from the extracted distance information (S103).
  • the road surface line road is calculated by approximating the extracted first distance information R1i by linear regression.
  • linear regression processing for example, linear approximation may be performed by a first-order least square method, or two or more linear approximations or curve approximations may be used. The same applies to linear regression in the calculation of the vehicle stop line described later.
  • the road surface estimation device 41 outputs the calculated road surface road to the vehicle stop estimation device 42.
  • the vehicle stop estimation device 42 extracts the first distance information R1i estimated as the vehicle stop 1002 from the first distance information R1i measured by the first distance measurement device 201 (S104).
  • the distance from the road surface road is equal to or greater than the second threshold value K2
  • the vehicle stop estimated by the vehicle stop estimation device 42 in the previous measurement First distance information R1i whose distance from the line t berm_old is equal to or smaller than a third threshold value K3 is extracted.
  • the car stop estimation device 42 compares the number m of the first distance information R1i extracted as the car stop 1002 with a predetermined threshold (car stop threshold Km). If the number m of the first distance information R1i extracted as the car stop 1002 is less than the car stop threshold Km (S105 / No), the process ends.
  • the car stop estimation device 42 uses the linear stop to approximate the extracted first distance information R1i. Is calculated (S106).
  • the wheel stop estimating device 42 calculates the wheel stopper inclination angle Ab from the slope of t road and t berm (S107).
  • FIG. 10A is a flowchart showing a vehicle stop width direction shape detection process by the second vehicle stop detection device 50.
  • FIG.10 (b) is a schematic diagram for demonstrating the mapping in a vehicle stop width direction shape detection process.
  • the pitch vibration correction device 51 calculates the installation depression angle ⁇ (see FIG. 2) of the second distance measuring device 202 and the inclination angle ⁇ (see FIG. 12) of the vehicle body horizontal plane H with respect to the road surface estimated by the road surface estimation device 41 (see FIG. 12). Applied to 1) to (3), three-dimensional conversion is performed while correcting pitch vibration for the second distance information R2i (S201).
  • xi R2i ⁇ cos ( ⁇ ) (1)
  • the vehicle stop shape estimation device 52 performs mapping of the second distance information R2i corrected by the pitch vibration correction device 51 based on the self-position estimated by the self-position estimation device 300 (S202). Then, the vehicle stop shape estimation device 52 writes the width direction shape information including the corrected second distance information R2i mapped to the vehicle stop shape storage device 53, and accumulates the mapped distance information (S203).
  • point group R2_c indicates current distance information
  • point group R2_pre1 and point group R2_pre2 indicate past width direction shape information. It should be noted that the point group R2_pre2 is the width direction shape information before the point group R2_pre1.
  • FIG. 11 is a flowchart of the contact distance determination process performed by the vehicle stop guidance device 60.
  • the vehicle stop guidance determination device 61 compares the distance Lb1 to the vehicle stop 1002 and the vehicle stop inclination angle Ab calculated by the vehicle stop estimation device 42 with predetermined fourth threshold value K4 and fifth threshold value K5, respectively.
  • the vehicle stop guidance determination device 61 estimates the predicted travel path p (S302). ).
  • the traveling path p is estimated based on the turning angular velocity (steering angle) s measured by the steering angle measuring device 302 and acquired through the self-position estimating device 300.
  • the vehicle stop guidance determination device 61 uses the traveling path p, the width direction shape information G stored in the vehicle stop shape storage device 53 by the second vehicle stop detection device 50, and the vehicle body shape D stored by the vehicle body shape storage device 62.
  • a distance Lb2 to the car stop 1002 is calculated (S303).
  • the distance Lb2 is set as the contact distance Lc (S305).
  • the distance Lb1 is set as the contact distance Lc (S306).
  • the fourth threshold value K4 is set as the contact distance Lc.
  • FIG. 12 is a schematic diagram for explaining a vehicle stop detection process when pitch vibration is generated in the dump truck 1.
  • FIG. 13A and FIG. 13B are diagrams illustrating measurement results performed by the first distance measuring device 201 in the state of FIG.
  • FIG. 13A is a diagram showing a case where the road surface is a plane.
  • the raw data from the first distance measuring device 201 is the distance L and the polar coordinates of the laser irradiation angle ⁇ , and these are coordinate-converted into orthogonal coordinates (x, y).
  • the inclination angle ⁇ is atan (a).
  • FIG. 13B shows a state in which the road surface is rotated by an inclination angle ⁇ around the ground directly below the first distance measuring device 201 in the vertical direction.
  • the place measured by the second distance measuring device 202 is a place rotated by ⁇ around the second distance measuring device 202 with reference to a case where there is no pitch vibration.
  • the laser irradiation angle ⁇ When the tilt angle ⁇ is generated, the laser irradiation angle ⁇ is not changed, but the distance L is short (or long).
  • FIG. 14A is a diagram showing the inclination angle ⁇ in the case of two or more linear approximations.
  • the inclination a of the first straight line that is, the straight line closer to the dump truck 1 is the inclination angle ⁇ .
  • FIG. 14B is a diagram showing the inclination angle ⁇ in the case of approximating two or more curves.
  • the road surface estimation device 41 extracts the first distance information R1i obtained by measuring the road surface using the previously estimated road surface road_old_old and estimates the road surface, the influence of the pitch vibration is alleviated even in the situation where the pitch vibration is occurring. Thus, the slope of the road surface can be estimated. Further, the vehicle stop estimation device 42 also extracts the first distance information R1i obtained by measuring the vehicle stop 1002 using the previously estimated vehicle stop line t berm_old , and estimates the vehicle stop 1002 so that the pitch vibration is generated even in a situation where pitch vibration is occurring. The position and inclination of the vehicle stop 1002 can be estimated by reducing the influence of vibration.
  • the pitch vibration correction device 51 performs correction using the vehicle body horizontal plane H and the road surface inclination angle ⁇ calculated by the road surface estimation device 41 according to the equations (1) to (3), the second distance measurement device 202 is used. It is possible to correct the depression angle caused by the pitch vibration.
  • FIG. 15 is a schematic diagram for explaining the backward detection process when the dump truck 1 is traveling on an inclined traveling road surface 1001A.
  • the distance information measured by the first distance measuring device 201 and the second distance measuring device 202 is on the traveling road surface 1001 having no inclination shown in FIG. It will be the same as that measured. Accordingly, the distance to the car stop 1002, the car stop angle, and the car stop shape 1002b can be accurately estimated even when the vehicle travels on the inclined road surface 1001A.
  • the inclination sensor determines the inclination by gravity. Therefore, when traveling on the traveling road surface 1001A having the inclination as shown in FIG. 15, the pitch vibration even when there is no pitch vibration. As a result, it is determined that there is noise, and accurate pitch vibration correction cannot be performed.
  • the pitch vibration correction device 51 uses the relative inclination angle ⁇ between the vehicle body horizontal surface H of the dump truck 1 and the traveling road surface 1001A, the pitch vibration correction device 51 can correct the pitch vibration regardless of the road surface inclination. Therefore, when traveling on a traveling road surface where the inclination changes, the pitch vibration correction device 51 can correct not only the pitch vibration but also the change in the inclination of the road surface.
  • FIG. 16 is a schematic diagram for explaining the rear detection process when the dump truck 1 is traveling on a traveling road surface 1001B having a change in inclination.
  • the slope of the traveling road surface 1001B changes from the middle.
  • the first distance measuring device 201 measures the distance in the traveling direction, the relative relationship between the current dump truck 1 and the traveling road surface 1001B is obtained. Rather than the inclination, the relative inclination between the road surface in the future and the dump truck 1 is measured.
  • the pitch vibration correcting device 51 can correct not only the pitch vibration but also the change in the inclination of the road surface.
  • the scanning surfaces of the first distance measuring device 201 and the second distance measuring device 202 are crossed and installed on the dump truck 1 so that when the pitch vibration is generated in the dump truck 1 or on the road surface Even if the vehicle has an inclination, it is possible to reduce the influence of pitch vibration and accurately measure the distance to the car stopper 1002 and the shape and direction of the car stopper 1002 (the inclination angle and the width direction shape of the car stopper 1002).
  • the dump truck 1 can be guided to the car stop 1002 by using the distance to the car stop 1002 accurately measured and the shape and direction of the car stop 1002. Thereby, it can guide
  • the work machine is not limited to a dump truck, but may be a dozer, a wheel loader, or a hydraulic excavator.
  • a scanner may be attached to the rear of these work machines to detect the shape of a rear obstacle.
  • the scanner may be installed in front, left, and right of the work machine to detect the shapes of the front obstacle, the left obstacle, and the right obstacle.
  • the display image generation device 103 and the earthing place entry determination device 105 are only examples of the output destination of the contact distance calculation device 101, and are other devices such as a so-called unmanned dump truck in which the dump truck 1 autonomously travels.
  • the vehicle is output to an autonomous traveling control device that controls autonomous traveling, and the distance from the dump truck 1 to the car stop 1002 and the direction of the body of the dump truck 1 relative to the car stop 1002 (the direction of the body horizontal plane, the body longitudinal axis,
  • the autonomous traveling control device may be configured to execute calculations necessary for stopping, such as the direction of the left and right axis of the vehicle body.
  • the imaging device 102, the display video generation device 103, the video display device 104, the earthing place entry determination device 105, and the earthing place entry notification device 106 may not be provided.
  • the dump truck 1 may be provided with a contact determination device, and this contact determination device may be used as the output destination of the contact distance calculation device 101. Then, the contact determination device may perform contact determination with the vehicle stop 1002 and perform control for avoiding contact (interference) with the vehicle stop 1002.

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Electromagnetism (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Optical Radar Systems And Details Thereof (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Traffic Control Systems (AREA)

Abstract

La présente invention concerne le guidage d'un véhicule de transport pour qu'il s'arrêter à une position appropriée de libération du sol lors d'une libération du sol. Le dispositif de support d'inversion de machine de travail de l'invention comprend un dispositif de mesure 200 qui est pourvu d'un premier dispositif de mesure de distance 201 et d'un second dispositif de mesure de distance 202, le premier dispositif de mesure de distance 201 et le second dispositif de mesure de distance 202 étant disposés de telle sorte qu'une première surface de balayage 21 du premier dispositif de mesure de distance 201 et une seconde surface de balayage 202 du second dispositif de mesure de distance 202 se croisent à angle droit, la première surface de balayage 21 étant perpendiculaire à un plan horizontal H de corps de véhicule et la seconde surface de balayage 22 présentant un angle de dépression par rapport au plan horizontal H de corps de véhicule. Sur la base d'une première distance mesurée par le premier dispositif de mesure de distance 201 et d'une seconde distance mesurée par le second dispositif de mesure de distance 202, une distance jusqu'à un arrêt de véhicule 1002 positionnée dans la direction de déplacement d'une machine de travail et la forme de l'arrêt de véhicule 1002 sont détectées, et la distance jusqu'à ce que la machine de travail entre en contact avec l'arrêt de véhicule 1002 est calculée.
PCT/JP2019/008367 2018-03-30 2019-03-04 Dispositif de support d'inversion de machine de travail WO2019188015A1 (fr)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2018068808A JP6909752B2 (ja) 2018-03-30 2018-03-30 作業機械の後退支援装置
JP2018-068808 2018-03-30

Publications (1)

Publication Number Publication Date
WO2019188015A1 true WO2019188015A1 (fr) 2019-10-03

Family

ID=68061324

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2019/008367 WO2019188015A1 (fr) 2018-03-30 2019-03-04 Dispositif de support d'inversion de machine de travail

Country Status (2)

Country Link
JP (1) JP6909752B2 (fr)
WO (1) WO2019188015A1 (fr)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114325755A (zh) * 2021-11-26 2022-04-12 江苏徐工工程机械研究院有限公司 一种适用于自动驾驶车辆的挡土墙检测方法及系统
CN114706094A (zh) * 2022-06-07 2022-07-05 青岛慧拓智能机器有限公司 卸载点位的卸载可用状态检测方法、装置及计算机设备

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2022067739A (ja) * 2020-10-21 2022-05-09 株式会社小松製作所 作業機械を制御するための方法、システム、および作業機械

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009229394A (ja) * 2008-03-25 2009-10-08 Ihi Corp 移動ロボットの走行領域判別装置及び走行領域判別方法
JP2015081877A (ja) * 2013-10-24 2015-04-27 日立建機株式会社 後退支援装置
JP2015230551A (ja) * 2014-06-04 2015-12-21 日立建機株式会社 周囲物体検出システム及び運搬車両
JP2017015409A (ja) * 2015-06-26 2017-01-19 シャープ株式会社 路面検知装置、移動体、路面検知方法、および路面検知プログラム
JP2017030688A (ja) * 2015-08-06 2017-02-09 日立建機株式会社 作業機械の周囲監視装置
JP2018049573A (ja) * 2016-09-23 2018-03-29 株式会社小松製作所 作業車両の管理システム及び作業車両の管理方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009229394A (ja) * 2008-03-25 2009-10-08 Ihi Corp 移動ロボットの走行領域判別装置及び走行領域判別方法
JP2015081877A (ja) * 2013-10-24 2015-04-27 日立建機株式会社 後退支援装置
JP2015230551A (ja) * 2014-06-04 2015-12-21 日立建機株式会社 周囲物体検出システム及び運搬車両
JP2017015409A (ja) * 2015-06-26 2017-01-19 シャープ株式会社 路面検知装置、移動体、路面検知方法、および路面検知プログラム
JP2017030688A (ja) * 2015-08-06 2017-02-09 日立建機株式会社 作業機械の周囲監視装置
JP2018049573A (ja) * 2016-09-23 2018-03-29 株式会社小松製作所 作業車両の管理システム及び作業車両の管理方法

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114325755A (zh) * 2021-11-26 2022-04-12 江苏徐工工程机械研究院有限公司 一种适用于自动驾驶车辆的挡土墙检测方法及系统
CN114706094A (zh) * 2022-06-07 2022-07-05 青岛慧拓智能机器有限公司 卸载点位的卸载可用状态检测方法、装置及计算机设备
CN114706094B (zh) * 2022-06-07 2022-08-23 青岛慧拓智能机器有限公司 卸载点位的卸载可用状态检测方法、装置及计算机设备

Also Published As

Publication number Publication date
JP6909752B2 (ja) 2021-07-28
JP2019178972A (ja) 2019-10-17

Similar Documents

Publication Publication Date Title
US11292469B2 (en) Dump truck and reversing assistance device
CN108139755B (zh) 自己位置推定装置的异常检测装置以及车辆
JP6386794B2 (ja) 運搬車両
WO2018164203A1 (fr) Scanneur, machine de travail et dispositif de détection de butée de roue
JP6284741B2 (ja) 後退支援装置
WO2019188015A1 (fr) Dispositif de support d'inversion de machine de travail
JP6718341B2 (ja) 鉱山用作業機械及びその後方監視方法
GB2552282A (en) Vehicle control system
AU2017239926B2 (en) Control system of transporter vehicle, transporter vehicle, and control method of transporter vehicle
KR20100075750A (ko) 주차 지원장치
JP2013159257A (ja) 運搬車両の周囲監視装置
WO2016121688A1 (fr) Dispositif de détection d'obstacle pour véhicule de transport
JP2013052754A (ja) 駐車支援装置
JP2012023505A (ja) 運転支援装置
JP2022045987A (ja) 作業車両の走行補助装置およびこれを備えた作業車両
WO2022190484A1 (fr) Système de mesure de récipient
JP2017058841A (ja) 車両の運転支援装置、及び運転支援方法
US20230408289A1 (en) Guidance of a transport vehicle to a loading point
JP2018178878A (ja) 産業車両
JP4006319B2 (ja) 車両の走行制御装置
JP6886929B2 (ja) 運搬車両
JP2020067702A (ja) 姿勢検出装置及び運搬システム
JPH10141954A (ja) 移動体の走行路面上の障害物検出装置
JP6761845B2 (ja) ダンプトラックの制御システム、及びダンプトラック
WO2024005680A1 (fr) Procédé, agencement et machine d'exploitation minière souterraine pour acheminement autonome jusqu'à un emplacement non cartographié

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: 19776829

Country of ref document: EP

Kind code of ref document: A1

122 Ep: pct application non-entry in european phase

Ref document number: 19776829

Country of ref document: EP

Kind code of ref document: A1