Vehicle position estimation device and vehicle position estimation program
By using information from both the vehicle ahead and behind, along with white line recognition and millimeter wave radar, the system ensures accurate vehicle positioning for effective platooning.
Patent Information
- Application Number
- JP2020081398
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2020-05-01
- Publication Date
- 2024-11-13
- Estimated Expiration
- 2040-05-01
AI Technical Summary
Existing vehicle position estimation systems rely solely on information from the vehicle ahead, leading to inaccurate positioning when that information is delayed or missing, hindering effective platooning.
The system estimates the vehicle's position by acquiring and utilizing information from both the vehicle ahead and the vehicle behind, incorporating white line recognition, camera images, and millimeter wave radar to calculate relative positions and deviations.
Accurate vehicle positioning is maintained even when information from the vehicle ahead is delayed or missing, enabling reliable platooning by integrating data from multiple sources.
Smart Images

Figure 0007582791000011 
Figure 0007582791000012 
Figure 0007582791000013
Abstract
Description
[Technical field]
[0001] The present invention relates to a vehicle position estimation device and a vehicle position estimation program. [Background technology]
[0002] An automatic platooning system has been developed that drives vehicles in a formation with a short distance between vehicles. By driving in a formation, it is possible to shorten the distance between vehicles and increase traffic volume, and to suppress air resistance acting on the vehicles and improve fuel efficiency. This automatic platooning system detects the lateral position of the vehicle in the lane based on the recognized white lines.
[0003] For example, Patent Document 1 describes a white line recognition device that detects the lateral position of the vehicle relative to the lane by expanding the range in which the white line can be detected. When detecting the lateral position from an image captured in front of the vehicle, this white line recognition device detects the lateral position by combining an image captured in front of the vehicle ahead. In addition, when the vehicle itself is unable to recognize the white line, this white line recognition device receives a white line recognition result from the vehicle ahead and recognizes the white line from the received white line recognition result from the vehicle ahead. [Prior art documents] [Patent documents]
[0004] [Patent Document 1] JP 2009-251671 A Summary of the Invention [Problem to be solved by the invention]
[0005] In the technology described in Patent Document 1, when estimating the position of the vehicle, only information obtained from the vehicle ahead is used, so if the information from the vehicle ahead is delayed or missing, the position of the vehicle cannot be estimated with high accuracy, which makes it difficult for multiple vehicles to travel in a convoy.
[0006] The present invention has been made to solve the above-mentioned problems, and aims to provide a vehicle position estimation device and a vehicle position estimation program that can accurately estimate the position of a vehicle when multiple vehicles are traveling in a convoy. [Means for solving the problem]
[0007] In order to achieve the above-mentioned object, the vehicle position estimation device of the first embodiment includes an acquisition unit that acquires forward vehicle information and rear vehicle information, which are information necessary to estimate the relative position of the vehicle, from each of the vehicles in front and behind the vehicle while a plurality of vehicles are traveling in a convoy, and an estimation unit that estimates the relative position of the vehicle using the forward vehicle information and rear vehicle information acquired by the acquisition unit.
[0008] In addition, the vehicle position estimation device of the second aspect is the vehicle position estimation device of the first aspect, further comprising a white line recognition unit that recognizes white lines based on at least one of a front image and a rear image of the vehicle, and when the white line recognition unit cannot recognize a white line, the acquisition unit acquires the front vehicle information and the rear vehicle information from each of the front vehicle and the rear vehicle.
[0009] In addition, a vehicle position estimation device according to a third aspect is the vehicle position estimation device according to the first or second aspect, wherein the forward vehicle information includes a first curvature, a first yaw angle deviation, and a first lateral position deviation at the position of the forward vehicle, and a first relative angle between the forward vehicle and the vehicle when viewed from the forward vehicle, and the rearward vehicle information includes a second curvature, a second yaw angle deviation, and a second lateral position deviation at the position of the rearward vehicle, and a second relative angle between the rearward vehicle and the vehicle when viewed from the rearward vehicle.
[0010] Further, in a vehicle position estimation device according to a fourth aspect, in the vehicle position estimation device according to the third aspect, the estimation unit uses the first curvature, the first yaw angle deviation, and the first lateral position deviation, as well as the second curvature, the second yaw angle deviation, and the second lateral position deviation, to calculate a yaw angle and coordinates of the rear vehicle at a reference position of the rear vehicle without a yaw angle deviation and a lateral position deviation, the ... the vehicle is moved relative to the front vehicle at a reference position where there is no position deviation; and the vehicle is moved relative to the front vehicle at a reference position where there is no position deviation, and the vehicle is moved relative to the front vehicle at a reference position where there is no position deviation. The vehicle is moved relative to the front vehicle at a reference position where there is no position deviation, and the vehicle is moved relative to the front vehicle at a reference position where there is no position deviation. The vehicle is moved relative to the front vehicle at a reference position where there is no position deviation, and the vehicle is moved relative to the front vehicle at a reference position where there is no position deviation. The vehicle is moved relative to the front vehicle at a reference position where there is no position deviation, and the vehicle is moved relative to the front vehicle at a reference position where there is no position deviation.
[0011] In addition, a vehicle position estimation device according to a fifth aspect is the vehicle position estimation device according to the fourth aspect, further comprising a front camera that images the front vehicle, a rear camera that images the rear vehicle, and a radar that detects each of the front vehicle and the rear vehicle, and the estimation unit calculates the third relative angle from a front image obtained by photographing the front vehicle with the front camera, calculates the fourth relative angle from a rear image obtained by photographing the rear vehicle with the rear camera, and calculates the first distance and the second distance from the detection result of the radar.
[0012] In addition, a vehicle position estimation device according to a sixth aspect is a vehicle position estimation device according to any one of the first to fifth aspects, in which, when the acquisition unit acquires either the forward vehicle information or the rearward vehicle information, the estimation unit estimates the relative position of the vehicle using either the forward vehicle information or the rearward vehicle information acquired.
[0013] Furthermore, in order to achieve the above-mentioned object, the vehicle position estimation program of the seventh aspect causes a computer to acquire, while a plurality of vehicles are traveling in a convoy, front vehicle information and rear vehicle information, which are information necessary for estimating the relative position of the vehicle, from each of the vehicles in front and behind the vehicle, and to estimate the relative position of the vehicle using the acquired front vehicle information and rear vehicle information. Effect of the Invention
[0014] According to the present invention, when a plurality of vehicles are traveling in a platoon, the position of the vehicle can be estimated with high accuracy.
[0015] In addition, by receiving information not only from the vehicle ahead but also from the vehicle behind, the position of the vehicle can be estimated without any loss of accuracy unless information from both the vehicle ahead and the vehicle behind are simultaneously lost. [Brief description of the drawings]
[0016] [Figure 1] FIG. 2 is a plan view showing a state in which a plurality of vehicles travel in a formation according to the first embodiment. [Diagram 2] 1 is a block diagram showing an example of an electrical configuration of a vehicle position estimation device according to a first embodiment. [Diagram 3] 1 is a block diagram showing an example of a functional configuration of a vehicle position estimation device according to a first embodiment. [Figure 4] 3A to 3C are diagrams showing an example of forward vehicle information, rear vehicle information, reference information, and relative relationship information according to the first embodiment. [Diagram 5] 5 is a flowchart showing an example of a process flow of a vehicle position estimation program according to the first embodiment. [Figure 6] FIG. 2 is a diagram showing an example of a clothoid curve according to the first embodiment. [Figure 7] FIG. 2 is a plan view showing an example of vehicle platooning on a curved road according to the first embodiment. [Figure 8] 4 is a diagram illustrating a relative relationship information calculation method according to the first embodiment; FIG. [Figure 9] 2 is a diagram illustrating a method for estimating a lateral position deviation of a host vehicle according to the first embodiment; FIG. [Figure 10] FIG. 11 is a plan view showing an example of vehicle platooning on a straight road according to the second embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0017] Hereinafter, an example of an embodiment of the present invention will be described in detail with reference to the drawings.
[0018] [First embodiment] FIG. 1 is a plan view showing a state in which a plurality of vehicles 30, 40, 50 according to the first embodiment travel in a formation.
[0019] As shown in Fig. 1, a plurality of vehicles 30, 40, 50 are traveling in a formation within a lane 90 defined by white lines L1 and L2. The vehicle 30 is equipped with a vehicle position estimation device 10 according to this embodiment. Each of the vehicles 40 and 50 is also equipped with a vehicle position estimation device 10 (not shown). In this embodiment, the vehicle 30 will be described as the host vehicle 30, the vehicle 40 as the leading vehicle 40 traveling in front of the host vehicle 30, and the vehicle 50 as the trailing vehicle 50 traveling behind the host vehicle 30.
[0020] A curved road having a curvature is applied to the lane 90 according to the present embodiment. Note that, although the present embodiment shows a case where there are three vehicles, the number of vehicles is not particularly limited as long as it is three or more.
[0021] FIG. 2 is a block diagram showing an example of the electrical configuration of the vehicle position estimation device 10 according to the first embodiment.
[0022] As shown in FIG. 2, the vehicle position estimation device 10 according to this embodiment includes a CPU (Central Processing Unit) 11, a ROM (Read Only Memory) 12, a RAM (Random Access Memory) 13, an input / output interface (I / O) 14, a memory unit 15, a front camera 16, a rear camera 17, a millimeter wave radar 18, a wheel speed sensor 19, and a communication unit 20.
[0023] The vehicle position estimation device 10 according to this embodiment may be realized as a part of an ECU (Electronic Control Unit) that is a vehicle control computer, or may be realized as an on-board computer separate from the ECU.
[0024] The CPU 11, ROM 12, RAM 13, and I / O 14 are connected to each other via a bus. Functional units including a storage unit 15, a front camera 16, a rear camera 17, a millimeter wave radar 18, a wheel speed sensor 19, and a communication unit 20 are connected to the I / O 14. These functional units can communicate with the CPU 11 via the I / O 14. The CPU 11, ROM 12, RAM 13, and I / O 14 form a control unit.
[0025] The control unit may be configured as a sub-control unit that controls part of the operation of the vehicle position estimation device 10, or may be configured as part of a main control unit that controls the overall operation of the vehicle position estimation device 10. For example, an integrated circuit such as an LSI (Large Scale Integration) or an IC (Integrated Circuit) chip set is used for part or all of the blocks of the control unit. An individual circuit may be used for each of the above blocks, or a circuit in which some or all of the blocks are integrated may be used. The above blocks may be provided integrally, or some of the blocks may be provided separately. Also, a part of each of the above blocks may be provided separately. The integration of the control unit is not limited to an LSI, and a dedicated circuit or a general-purpose processor may be used.
[0026] For example, a hard disk drive (HDD), a solid state drive (SSD), a flash memory, etc. are used as the storage unit 15. A vehicle position estimation program 15A for performing vehicle position estimation according to this embodiment is stored in the storage unit 15. Note that this vehicle position estimation program 15A may be stored in the ROM 12.
[0027] The vehicle position estimation program 15A may be pre-installed in the vehicle position estimation device 10, for example. The vehicle position estimation program 15A may be realized by storing it in a non-volatile storage medium or distributing it via a network and appropriately installing it in the vehicle position estimation device 10. Note that examples of the non-volatile storage medium include a CD-ROM (Compact Disc Read Only Memory), a magneto-optical disk, a HDD, a DVD-ROM (Digital Versatile Disc Read Only Memory), a flash memory, a memory card, and the like.
[0028] The front camera 16 is disposed, for example, at the center of the front of the vehicle interior of the vehicle 30, and captures a front image by capturing an image of a front area including the vehicle 40 ahead. The vehicle 40 ahead is included in this front image.
[0029] The rear camera 17 is disposed, for example, at the rear center of the vehicle interior of the host vehicle 30, and captures a rear image by photographing a rear area including the rear vehicle 50. The rear vehicle 50 is included in this rear image.
[0030] The millimeter wave radar 18 is provided on each of the front and rear surfaces of the host vehicle 30. The millimeter wave radar 18 uses millimeter waves to detect a leading vehicle 40 traveling in front of the host vehicle 30, and detects a trailing vehicle 50 traveling behind the host vehicle 30. The millimeter wave radar 18 is an example of a radar.
[0031] The wheel speed sensor 19 is provided on each of the four wheels of the host vehicle 30. The wheel speed sensor 19 detects the rotation speed of the wheels of the host vehicle 30 (the number of pulses corresponding to the rotation of the wheels).
[0032] The communication unit 20 communicates with each of the leading vehicle 40 and the trailing vehicle 50 via an antenna for inter-vehicle communication (not shown).
[0033] However, as described above, if only information obtained from the vehicle ahead 40 is used when estimating the position of the vehicle 30, the position of the vehicle 30 cannot be estimated with high accuracy if the information from the vehicle ahead 40 is delayed or missing. This makes it difficult for multiple vehicles to travel in a convoy.
[0034] The CPU 11 of the vehicle position estimation device 10 according to this embodiment writes a vehicle position estimation program 15A stored in the storage unit 15 into the RAM 13 and executes the program, thereby functioning as each unit shown in FIG.
[0035] FIG. 3 is a block diagram showing an example of a functional configuration of the vehicle position estimation device 10 according to the first embodiment.
[0036] As shown in FIG. 3, the CPU 11 of the vehicle position estimation device 10 according to this embodiment functions as a white line recognition unit 11A, an acquisition unit 11B, and an estimation unit 11C.
[0037] The white line recognition unit 11A according to this embodiment recognizes the white lines L1 and L2 based on at least one of a forward image captured by the forward camera 16 and a rearward image captured by the rearward camera 17. Note that a conventionally known method, for example, is used as a technique for recognizing the white lines from the captured image. The "white lines" referred to here include white lines, yellow lines, and road dividing lines such as blocks arranged on the road, etc.
[0038] In this embodiment, for example, when the white line recognition unit 11A does not recognize a white line, the acquisition unit 11B acquires information from each of the forward vehicle 40 and the rear vehicle 50. However, it is assumed that the forward vehicle 40 recognizes a white line in front, and the rear vehicle 50 recognizes a white line in the rear. Note that even when a white line is recognized by the white line recognition unit 11A, information may be acquired from each of the forward vehicle 40 and the rear vehicle 50 by the acquisition unit 11B.
[0039] The acquisition unit 11B according to this embodiment acquires information necessary for estimating the relative position of the host vehicle 30 from each of the front vehicle 40 and the rear vehicle 50 while the host vehicle 30, the front vehicle 40, and the rear vehicle 50 are traveling in a platoon. Hereinafter, the necessary information acquired from the front vehicle 40 will be referred to as front vehicle information, and the necessary information acquired from the rear vehicle 50 will be referred to as rear vehicle information.
[0040] The estimation unit 11C according to this embodiment estimates the relative position of the host vehicle 30 by using the front vehicle information and the rear vehicle information acquired by the acquisition unit 11B.
[0041] In addition, when either the forward vehicle information or the rearward vehicle information is acquired by the acquisition unit 11B, the estimation unit 11C may estimate the relative position of the vehicle using either the acquired forward vehicle information or the rearward vehicle information.
[0042] Next, the forward vehicle information, the rear vehicle information, the reference information, and the relative relationship information required to estimate the relative position of the host vehicle 30 will be described with reference to FIG.
[0043] FIG. 4 is a diagram showing an example of the front vehicle information, the rear vehicle information, the reference information, and the relative relationship information according to the first embodiment.
[0044] 4, the forward vehicle information includes [1] a first curvature, a first yaw angle deviation, and a first lateral position deviation at the position of the forward vehicle 40, and [3] a first relative angle between the forward vehicle 40 and the host vehicle 30 when viewed from the forward vehicle 40. The first curvature, the first yaw angle deviation, the first lateral position deviation, and the first relative angle are calculated from an image captured by a camera mounted on the forward vehicle 40.
[0045] The rear vehicle information also includes [1] a second curvature, a second yaw angle deviation, and a second lateral position deviation at the position of the rear vehicle 50, and [3] a second relative angle between the rear vehicle 50 and the host vehicle when viewed from the rear vehicle 50. The second curvature, the second yaw angle deviation, the second lateral position deviation, and the second relative angle are calculated from an image captured by a camera mounted on the rear vehicle 50.
[0046] The estimation unit 11C calculates [2] reference information using the first curvature, the first yaw angle deviation, and the first lateral position deviation, as well as the second curvature, the second yaw angle deviation, and the second lateral position deviation. This reference information includes the yaw angle and coordinates of the rear vehicle 50 at a reference position based on the rear vehicle 50, the yaw angle and coordinates of the host vehicle 30 at a reference position of the host vehicle 30 based on the rear vehicle 50, and the yaw angle and coordinates of the front vehicle 40 at a reference position of the front vehicle 40 based on the rear vehicle 50. The reference position represents an ideal position without yaw angle deviation and lateral position deviation.
[0047] Furthermore, the estimation unit 11C calculates [3] relative relationship information. This relative relationship information includes a third relative angle between the forward vehicle 40 and the host vehicle 30, a first distance between the forward vehicle 40 and the host vehicle 30, a fourth relative angle between the host vehicle 30 and the rear vehicle 50, and a second distance between the host vehicle 30 and the rear vehicle 50. The third relative angle is calculated from a front image obtained by photographing the forward vehicle 40 with the forward camera 16, and the fourth relative angle is calculated from a rear image obtained by photographing the rear vehicle 50 with the rear camera 17. The first distance and the second distance are calculated from the detection result of the millimeter wave radar 18 provided on the host vehicle 30.
[0048] Furthermore, the estimation unit 11C estimates the curvature, yaw angle deviation, and lateral position deviation of the host vehicle 30 based on the first relative angle, the second relative angle, the reference information, and the relative relationship information obtained above.
[0049] The curvature of the host vehicle 30 is calculated as an average value of a first curvature at the position of the leading vehicle 40 and a second curvature at the position of the trailing vehicle 50, for example.
[0050] The yaw angle deviation of the host vehicle 30 is calculated as an average value of the third yaw angle deviation and the fourth yaw angle deviation, for example. The third yaw angle deviation is calculated from the yaw angle of the host vehicle 30 at the reference position and the relative positional relationship between the host vehicle 30 and the rear vehicle 50 obtained from the captured image. The fourth yaw angle deviation is calculated from the yaw angle of the forward vehicle 40 at the reference position and the relative positional relationship between the host vehicle 30 and the forward vehicle 40 obtained from the captured image. When only one of the third yaw angle deviation and the fourth yaw angle deviation can be calculated, the calculated yaw angle deviation is regarded as the yaw angle deviation of the host vehicle 30.
[0051] The lateral position deviation of the host vehicle 30 is calculated as an average value of the third lateral position deviation and the fourth lateral position deviation, for example. The third lateral position deviation is calculated from the coordinates of the host vehicle 30 at the reference position and the relative positional relationship between the host vehicle 30 and the rear vehicle 50 obtained from the captured image. The fourth lateral position deviation is calculated from the coordinates of the forward vehicle 40 at the reference position and the relative positional relationship between the host vehicle 30 and the forward vehicle 40. When only one of the third lateral position deviation and the fourth lateral position deviation can be calculated, the calculated lateral position deviation is regarded as the lateral position deviation of the host vehicle 30.
[0052] Next, the operation of the vehicle position estimation device 10 according to the first embodiment will be described with reference to FIG.
[0053] FIG. 5 is a flowchart showing an example of a process flow of the vehicle position estimation program 15A according to the first embodiment.
[0054] First, when the vehicle position estimation device 10 receives an instruction to start the vehicle position estimation process, the CPU 11 reads and executes the vehicle position estimation program 15A.
[0055] In step 100 of FIG. 5, the CPU 11 acquires a front image captured by the front camera 16 and a rear image captured by the rear camera 17.
[0056] In step 101, the CPU 11 judges whether or not a white line has been recognized based on the forward image and the rearward image acquired in step 100. If it is judged that a white line has not been recognized (in the case of a negative judgment), the process proceeds to step 102, and if it is judged that a white line has been recognized (in the case of a positive judgment), the process proceeds to step 107.
[0057] In step 102, the CPU 11 acquires the forward vehicle information from the forward vehicle 40 and the rearward vehicle information from the rearward vehicle 50, as shown in FIG.
[0058] In step 103, the CPU 11 calculates the reference information shown in Fig. 4 described above using the front vehicle information and rear vehicle information acquired in step 102. Here, a method for calculating the reference information, that is, the yaw angle and coordinates at an ideal reference position on the target trajectory for each vehicle, will be specifically described with reference to Fig. 6 and Fig. 7.
[0059] FIG. 6 is a diagram showing an example of a clothoid curve according to the first embodiment.
[0060] A clothoid curve represents the path that a vehicle takes when the steering wheel is turned slowly at a constant rate (angular velocity) while the vehicle is traveling at a constant speed. If the radius of curvature is R and the length of the curve from the start point of the clothoid is L, the product of the two is constant. In other words, for a clothoid curve, R×L=A 2 (A is a constant).
[0061] Assuming that the target trajectory of each vehicle is a clothoid curve as shown in Fig. 6, the following formulas (1) to (3) are derived, where R represents the radius of curvature, ρ represents a constant, and δl represents the length of the curve.
[0062] JPEG0007582791000001.jpg537
[0063] JPEG0007582791000002.jpg841
[0064] JPEG0007582791000003.jpg551
[0065] FIG. 7 is a plan view showing an example of vehicle platooning on a curved road according to the first embodiment.
[0066] The curve connecting reference positions 1 to 3 shown in Fig. 7 constitutes the clothoid curve shown in Fig. 6. Reference position 1 indicates the reference position of the rear vehicle 50, reference position 2 indicates the reference position of the host vehicle 30, and reference position 3 indicates the reference position of the front vehicle 40. Vehicle position 1' indicates the actual position of the rear vehicle 50, vehicle position 2' indicates the actual position of the host vehicle 30, and vehicle position 3' indicates the actual position of the front vehicle 40.
[0067] In addition, the angle α 1 indicates the yaw angle change from the reference axis (xy axis) to reference position 2, and the angle α 2 indicates the yaw angle change from the reference axis to the reference position 3. The angle φ 1 indicates the yaw angle change from the reference axis to the vehicle position 1', and the angle φ 2 indicates the yaw angle change from the reference axis to the vehicle position 2', and the angle φ 3 indicates the yaw angle change from the reference axis to the vehicle position 3'.
[0068] In addition, the angle θ 1 indicates the yaw angle deviation between the reference position 1 and the vehicle position 1', and the angle θ 2indicates the yaw angle deviation between the reference position 2 and the vehicle position 2', and the angle θ 3 indicates the yaw angle deviation between the reference position 3 and the vehicle position 3'.
[0069] In addition, the angle β 1 indicates a second relative angle to the host vehicle 30 when viewed from the rear vehicle 50, and angle β 2a indicates a fourth relative angle to the rear vehicle 50 as viewed from the host vehicle 30, and angle β 2b indicates a third relative angle to the forward vehicle 40 as viewed from the host vehicle 30, and angle β 3 indicates a first relative angle to the host vehicle 30 when viewed from the leading vehicle 40.
[0070] Based on the above equations (1) to (3), the yaw angle α 1 is derived by the following formula (4), where L is the curve length.
[0071] JPEG0007582791000004.jpg10105
[0072] Based on the above equations (1) to (3), the yaw angle α 2 is derived by the following formula (5), where L is the curve length.
[0073] JPEG0007582791000005.jpg10114
[0074] Moreover, the coordinates (x, y) representing the reference positions of the host vehicle 30 and the forward vehicle 40 on the clothoid curve are defined by the following equations.
[0075] JPEG0007582791000006.jpg19105
[0076] That is, the amount of change is calculated by numerical integration when the vehicle turns at a radius of curvature R=1 / ρ from a certain point {coordinates (x, y), speed (vx, vy)} and travels a distance dL, and then these values are added together. The speed (vx, vy) is obtained by the wheel speed sensor 19.
[0077] In step 104, the CPU 11 calculates the relative relationship information shown in Fig. 4 described above, that is, the third relative angle, the first distance, the fourth relative angle, and the second distance. Here, a method of calculating the relative relationship information will be specifically described with reference to Fig. 8.
[0078] FIG. 8 is a diagram illustrating the relative relationship information calculation method according to the first embodiment.
[0079] In (S1), a fourth relative angle (=β) between the host vehicle 30 and the rear vehicle 50 as viewed from the host vehicle 30 is calculated from an image obtained by photographing the rear vehicle 50 from the host vehicle 30. 2a ) is calculated.
[0080] In (S2), a second relative angle (=β 1 ) is calculated.
[0081] In (S3), a first relative angle (=β) between the vehicle 30 and the forward vehicle 40 as viewed from the forward vehicle 40 is calculated from an image of the vehicle 30 captured from the forward vehicle 40. 3 ) is calculated.
[0082] In (S4), a third relative angle (=β) between the host vehicle 30 and the forward vehicle 40 as viewed from the host vehicle 30 is calculated from an image obtained by photographing the forward vehicle 40 from the host vehicle 30. 2b ) is calculated.
[0083] Moreover, the first distance and the second distance, which are the distances between the vehicles, are calculated from the detection results of the millimeter wave radar 18 provided on the host vehicle 30, as described above.
[0084] In step 105, the CPU 11 estimates the curvature, yaw angle deviation, and lateral position deviation of the host vehicle 30 based on the above-mentioned first relative angle, second relative angle, reference information, and relative relationship information.
[0085] As an example, the curvature of the host vehicle 30 is calculated as the average value of the first curvature at the position of the leading vehicle 40 and the second curvature at the position of the trailing vehicle 50, as described above.
[0086] The CPU 11 calculates the third yaw angle deviation and the fourth yaw angle deviation of the host vehicle 30. First, the yaw angle α of the host vehicle 30 at the reference position 2 calculated by the above-mentioned formula (4) is 1 Based on the relative positional relationship between the host vehicle 30 and the rear vehicle 50, the third yaw angle deviation θ 2 Specifically, it is calculated by the following formula (6).
[0087] JPEG0007582791000007.jpg544
[0088] JPEG0007582791000008.jpg1785
[0089] Next, the yaw angle α of the forward vehicle 40 at the reference position 3 calculated by the above equation (5) is calculated. 2 and the fourth yaw angle deviation θ′ of the host vehicle 30 based on the relative positional relationship between the host vehicle 30 and the forward vehicle 40. 2 Specifically, it is calculated by the following formula (7).
[0090] JPEG0007582791000009.jpg3170
[0091] JPEG0007582791000010.jpg3493
[0092] In this case, as an example, the third yaw angle deviation θ 2 and the fourth yaw angle deviation θ' calculated using the above formula (7). 2The average value of these is set as the yaw angle deviation of the host vehicle 30.
[0093] The CPU 11 calculates a third lateral position deviation and a fourth lateral position deviation of the host vehicle 30. The third lateral position deviation is calculated from the coordinates of the host vehicle 30 at the reference position 2 and the relative positional relationship between the host vehicle 30 and the rear vehicle 50. The fourth lateral position deviation is calculated from the coordinates of the front vehicle 40 at the reference position 3 and the relative positional relationship between the host vehicle 30 and the front vehicle 40.
[0094] FIG. 9 is a diagram illustrating a method for estimating a lateral position deviation of the host vehicle 30 according to the first embodiment.
[0095] From the reference position 1 and the reference position 3, the coordinates of the vehicle position 1' of the rear vehicle 50 and the coordinates of the vehicle position 3' of the front vehicle 40 shown in Fig. 9 are calculated. That is, since the relative positional relationship between the front vehicle 40 and the host vehicle 30 and the relative positional relationship between the host vehicle 30 and the rear vehicle 50 are known, the vehicle position 2' of the host vehicle 30 can be calculated. Then, by comparing the vehicle position 2' of the host vehicle 30 with the reference position 2, the coordinates of the vehicle position 1' of the rear vehicle 50 and the coordinates of the vehicle position 3' of the front vehicle 40 can be calculated.
[0096] In step 106, the CPU 11 judges whether or not the end timing of the vehicle position estimation process has arrived. If it is judged that the end timing has not arrived (if the judgment is negative), the process returns to step 100 and is repeated. If it is judged that the end timing has arrived (if the judgment is positive), the process by the vehicle position estimation program 15A is terminated.
[0097] On the other hand, in step 107, the CPU 11 estimates the relative position of the host vehicle 30 from the white line recognition result recognized in step 101, and the process proceeds to step .
[0098] According to this embodiment, on a curved road, by receiving information not only from the vehicle ahead but also from the vehicle behind, the position of the vehicle can be estimated without any loss of accuracy, unless information from both the vehicle ahead and the vehicle behind are simultaneously lost.
[0099] [Second embodiment] In the above first embodiment, a configuration in which vehicles platoon on a curved road has been described. In this embodiment, a configuration in which vehicles platoon on a straight road will be described.
[0100] FIG. 10 is a plan view showing an example of vehicle platooning on a straight road according to the second embodiment.
[0101] In the case of a straight road as shown in Fig. 10, the yaw angle deviation and lateral position deviation of the front vehicle 40 and the yaw angle deviation and lateral position deviation of the rear vehicle 50 are acquired by sensing of each vehicle. Also, since it is a straight road, unlike the case of a curved road, the reference position is located on a straight line. As in the case of a curved road, the yaw angle deviation and lateral position deviation of the host vehicle 30 can be obtained by using a camera and a radar.
[0102] According to this embodiment, even on a straight road, by receiving information not only from the vehicle ahead but also from the vehicle behind, the position of the vehicle can be estimated without any deterioration in accuracy, unless the information from both the vehicle ahead and the vehicle behind are simultaneously lost.
[0103] In each of the above embodiments, the term "processor" refers to a processor in a broad sense, including general-purpose processors (e.g., CPU: Central Processing Unit, etc.) and dedicated processors (e.g., GPU: Graphics Processing Unit, ASIC: Application Specific Integrated Circuit, FPGA: Field Programmable Gate Array, programmable logic device, etc.).
[0104] In addition, the operations of the processor in each of the above embodiments may be performed not only by one processor, but also by multiple processors located at physically separate locations working together. The order of the operations of the processor is not limited to the order described in each of the above embodiments, and may be changed as appropriate.
[0105] The vehicle position estimation device has been described as an example of the embodiment. The embodiment may be in the form of a program for causing a computer to function as each unit of the vehicle position estimation device. The embodiment may be in the form of a computer-readable storage medium that stores the program.
[0106] Furthermore, the configuration of the vehicle position estimation device described in the above embodiment is merely an example, and may be modified according to circumstances without departing from the spirit of the invention.
[0107] Furthermore, the processing flow of the program described in the above embodiment is also one example, and unnecessary steps may be deleted, new steps may be added, or the processing order may be rearranged, without departing from the spirit of the invention.
[0108] In the above embodiment, the processing according to the embodiment is realized by a software configuration using a computer by executing a program, but the present invention is not limited to this. The embodiment may be realized by, for example, a hardware configuration or a combination of a hardware configuration and a software configuration. [Explanation of symbols]
[0109] 10 Vehicle position estimation device 11 CPU 11A White line recognition section 11B Acquisition Department 11C Estimation part 12 ROM 13 RAM 14 I / O 15 Storage section 15A Vehicle position estimation program 16 Front Camera 17 Rear Camera 18 Millimeter wave radar 19 Wheel speed sensor 20 Communications Department 30 Vehicle 40 Front vehicle 50 Rear vehicle 90 lanes
Claims
1. an acquisition unit that acquires leading vehicle information and trailing vehicle information from each of a leading vehicle and a trailing vehicle of the host vehicle while the plurality of vehicles are traveling in a platoon; an estimation unit that estimates a relative position of a host vehicle by using the front vehicle information and the rear vehicle information acquired by the acquisition unit; Equipped with the forward vehicle information includes a first curvature, a first yaw angle deviation, and a first lateral position deviation at a position of the forward vehicle, the first curvature, the first yaw angle deviation, and a first relative angle between the forward vehicle and the host vehicle as viewed from the forward vehicle; and the rear vehicle information includes a second curvature, a second yaw angle deviation, and a second lateral position deviation at a position of the rear vehicle, the second curvature, and a second relative angle between the rear vehicle and the host vehicle as viewed from the rear vehicle; the second curvature, a second yaw angle deviation, and a second lateral position deviation at a position of the rear vehicle, the second curvature ... relative angle between the rear vehicle and the host vehicle as viewed from the rear vehicle; The estimation unit is using the first curvature, the first yaw angle deviation, and the first lateral position deviation, as well as the second curvature, the second yaw angle deviation, and the second lateral position deviation, calculate reference information including: a yaw angle and coordinates of the rear vehicle at a reference position which is based on the rear vehicle and is an ideal position free of yaw angle deviation and lateral position deviation; a yaw angle and coordinates of the host vehicle at a reference position of the host vehicle which is based on the rear vehicle and is an ideal position free of yaw angle deviation and lateral position deviation; and a yaw angle and coordinates of the front vehicle at a reference position of the front vehicle which is based on the rear vehicle and is an ideal position free of yaw angle deviation and lateral position deviation; a third relative angle between the host vehicle and the preceding vehicle as seen from the host vehicle and a first distance between the host vehicle and the preceding vehicle; a fourth relative angle between the host vehicle and the preceding vehicle as seen from the host vehicle; Calculating relative relationship information including a second distance between the host vehicle and the rear vehicle; Estimating a curvature, a yaw angle deviation, and a lateral position deviation of the host vehicle based on the first relative angle, the second relative angle, the reference information, and the relative relationship information; The curvature of the host vehicle is set to an average value of the first curvature and the second curvature, The yaw angle deviation of the host vehicle is set to an average value of a third yaw angle deviation and a fourth yaw angle deviation, or to one of the third yaw angle deviation and the fourth yaw angle deviation, the third yaw angle deviation is calculated from a yaw angle of the host vehicle at a reference position of the host vehicle, a yaw angle deviation between the reference position of the rear vehicle and an actual position of the rear vehicle, the second relative angle, the second distance, and the fourth relative angle; the fourth yaw angle deviation is calculated from a yaw angle of the forward vehicle at a reference position of the forward vehicle, a yaw angle deviation between the reference position of the forward vehicle and an actual position of the forward vehicle, the first relative angle, the first distance, and the third relative angle; the lateral position deviation of the host vehicle is set to an average value of a third lateral position deviation and a fourth lateral position deviation, or to one of the third lateral position deviation and the fourth lateral position deviation, the third lateral position deviation is calculated from a coordinate of the host vehicle at a reference position of the host vehicle, a yaw angle deviation between the reference position of the rear vehicle and an actual position of the rear vehicle, the second relative angle, the second distance, and the fourth relative angle; the fourth lateral position deviation is calculated from a coordinate of the forward vehicle at a reference position of the forward vehicle, a yaw angle deviation between the reference position of the forward vehicle and an actual position of the forward vehicle, the first relative angle, the first distance, and the third relative angle; the actual position of the rear vehicle and the actual position of the front vehicle are calculated from a reference position of the rear vehicle and a reference position of the front vehicle; an actual position of the host vehicle is calculated from a relative positional relationship between the host vehicle and the forward vehicle and a relative positional relationship between the host vehicle and the rear vehicle; The actual position of the rear vehicle and the actual position of the front vehicle are calculated by comparing the actual position of the host vehicle with a reference position of the host vehicle. Vehicle position estimation device.
2. The vehicle further includes a white line recognition unit that recognizes white lines based on at least one of a front image and a rear image of the vehicle. The acquisition unit acquires the front vehicle information and the rear vehicle information from the front vehicle and the rear vehicle, respectively, when the white line recognition unit cannot recognize a white line. The vehicle position estimation device according to claim 1 .
3. A front camera that captures an image of the vehicle ahead; A rear camera that photographs the rear vehicle; a radar for detecting each of the front vehicle and the rear vehicle; Further comprising: The estimation unit calculates the third relative angle from a front image obtained by photographing the front vehicle with the front camera, calculates the fourth relative angle from a rear image obtained by photographing the rear vehicle with the rear camera, and calculates the first distance and the second distance from a detection result of the radar. The vehicle position estimation device according to claim 1 or 2.
4. When the acquisition unit acquires either the front vehicle information or the rear vehicle information, the estimation unit estimates a relative position of the host vehicle using either the acquired front vehicle information or the rear vehicle information. The vehicle position estimation device according to any one of claims 1 to 3.
5. While a plurality of vehicles are traveling in a platoon, front vehicle information and rear vehicle information, which are information necessary for estimating a relative position of the host vehicle, are acquired from each of a front vehicle and a rear vehicle of the host vehicle, Estimating a relative position of the host vehicle using the acquired front vehicle information and rear vehicle information; the forward vehicle information includes a first curvature, a first yaw angle deviation, and a first lateral position deviation at a position of the forward vehicle, the first curvature, the first yaw angle deviation, and a first relative angle between the forward vehicle and the host vehicle as viewed from the forward vehicle; and the rear vehicle information includes a second curvature, a second yaw angle deviation, and a second lateral position deviation at a position of the rear vehicle, the second curvature, and a second relative angle between the rear vehicle and the host vehicle as viewed from the rear vehicle; the second curvature, a second yaw angle deviation, and a second lateral position deviation at a position of the rear vehicle, the second curvature ... relative angle between the rear vehicle and the host vehicle as viewed from the rear vehicle; When estimating the relative position of the host vehicle, using the first curvature, the first yaw angle deviation, and the first lateral position deviation, as well as the second curvature, the second yaw angle deviation, and the second lateral position deviation, calculate reference information including: a yaw angle and coordinates of the rear vehicle at a reference position which is based on the rear vehicle and is an ideal position free of yaw angle deviation and lateral position deviation; a yaw angle and coordinates of the host vehicle at a reference position of the host vehicle which is based on the rear vehicle and is an ideal position free of yaw angle deviation and lateral position deviation; and a yaw angle and coordinates of the front vehicle at a reference position of the front vehicle which is based on the rear vehicle and is an ideal position free of yaw angle deviation and lateral position deviation; calculating relative relationship information including a third relative angle between the host vehicle and the leading vehicle as seen from the host vehicle and a first distance between the host vehicle and the leading vehicle, a fourth relative angle between the host vehicle and the trailing vehicle as seen from the host vehicle and a second distance between the host vehicle and the trailing vehicle; Estimating a curvature, a yaw angle deviation, and a lateral position deviation of the host vehicle based on the first relative angle, the second relative angle, the reference information, and the relative relationship information; The curvature of the host vehicle is set to an average value of the first curvature and the second curvature, The yaw angle deviation of the host vehicle is set to an average value of a third yaw angle deviation and a fourth yaw angle deviation, or to one of the third yaw angle deviation and the fourth yaw angle deviation, the third yaw angle deviation is calculated from a yaw angle of the host vehicle at a reference position of the host vehicle, a yaw angle deviation between the reference position of the rear vehicle and an actual position of the rear vehicle, the second relative angle, the second distance, and the fourth relative angle; the fourth yaw angle deviation is calculated from a yaw angle of the forward vehicle at a reference position of the forward vehicle, a yaw angle deviation between the reference position of the forward vehicle and an actual position of the forward vehicle, the first relative angle, the first distance, and the third relative angle; the lateral position deviation of the host vehicle is set to an average value of a third lateral position deviation and a fourth lateral position deviation, or to one of the third lateral position deviation and the fourth lateral position deviation, the third lateral position deviation is calculated from a coordinate of the host vehicle at a reference position of the host vehicle, a yaw angle deviation between the reference position of the rear vehicle and an actual position of the rear vehicle, the second relative angle, the second distance, and the fourth relative angle; the fourth lateral position deviation is calculated from a coordinate of the forward vehicle at a reference position of the forward vehicle, a yaw angle deviation between the reference position of the forward vehicle and an actual position of the forward vehicle, the first relative angle, the first distance, and the third relative angle; the actual position of the rear vehicle and the actual position of the front vehicle are calculated from a reference position of the rear vehicle and a reference position of the front vehicle; an actual position of the host vehicle is calculated from a relative positional relationship between the host vehicle and the forward vehicle and a relative positional relationship between the host vehicle and the rear vehicle; The actual position of the rear vehicle and the actual position of the front vehicle are calculated by comparing the actual position of the host vehicle with a reference position of the host vehicle. A vehicle position estimation program to be executed by a computer.
Citation Information
Patent Citations
Traveling lane recognition device and traveling lane recognition method
JP2008276642A
White line recognition device
JP2009251671A
Driving support device, driving support system, and driving support method
JP2020042323A
Vehicle relative position estimation apparatus and vehicle relative position estimation method
WO2010097943A1
