JP5500149B2 - Position estimation apparatus and position estimation system - Google Patents

Description

  The present invention relates to a position estimation device position estimation system.

  In order to present highly accurate information in the navigation system or perform optimal vehicle control according to the traveling position of the vehicle, it is necessary to estimate the position of the host vehicle with high accuracy.

  Patent Document 1 discloses a moving body detection apparatus for detecting a moving body with high accuracy. Specifically, the moving body detection device includes grouping means for grouping observation points whose distances are close to a predetermined value or less on distance data as a connected body, and two time points obtained by the grouping means. Object tracking for identifying each connected body on the distance data in as a same object between two time points whose distances are close to a predetermined value or less and whose size difference is a predetermined value or less And the amount of change in the distance and azimuth between the two times of the connected body identified by the object tracking means are corrected using the distance displacement and the azimuth displacement estimated by the vehicle motion estimation device. And a moving body displacement amount calculating means for making the displacement amount of the connected body between two times.

  Patent Document 2 discloses an other vehicle position detection device that quickly detects the position of another vehicle. Specifically, the other vehicle position detection device includes a host vehicle GPS position information acquisition unit that acquires GPS position information of the host vehicle, a map data storage unit that stores map data, and GPS position information of the host vehicle. Using map matching processing means for performing map matching with the map data and correcting the position of the own vehicle, GPS position information on the own vehicle, and the position of the own vehicle corrected by the map matching processing means, Correction of GPS position information in the other vehicle acquired by the other vehicle GPS position information acquisition means using an error estimation means for estimating an error in the GPS position information and the error of the GPS position information estimated by the error estimation means And other vehicle position correcting means.

JP 2006-160116 A JP 2007-85909 A

  However, in Patent Document 1, when there is a large amount of road traffic and there are many moving objects in the vicinity, there is a problem that the stationary object information around the host vehicle cannot be sufficiently collected only by detecting the object directly by the laser sensor. is there.

  Further, in Patent Document 2, it is difficult to accurately obtain the absolute position of the host vehicle, and an estimation error is included in the map matching itself between the GPS position information and the map data. For this reason, there is a problem in that an accurate error in the GPS position information cannot be calculated, and the position of the other vehicle cannot be detected accurately.

  The present invention has been proposed in order to solve the above-described problems, and provides a position estimation device and a position estimation system that can reduce an error in GPS position information and accurately estimate the absolute position of the host vehicle. The purpose is to provide.

According to a first aspect of the present invention, there is provided a position estimation device comprising: a receiving unit that receives absolute position information of a host vehicle transmitted from a communication device; a host vehicle GPS position information detection unit that detects GPS position information of the host vehicle; Vehicle speed measuring means for measuring the GPS position information detected by the own vehicle GPS position information detecting means using the vehicle speed measured by the vehicle speed measuring means, and when the absolute position information is received by the receiving means The absolute position of the host vehicle is averaged by correcting the absolute position of the host vehicle, the absolute position information received by the receiving unit, and the GPS position information corrected by the correcting unit. and the vehicle absolute position estimating means for estimating a, and transmission means for transmitting to the communication device the absolute position information indicating the absolute position of the vehicle estimated by the averaging A e was position estimation device, said receiving means, in other vehicles, said other vehicle GPS location information of the other vehicle that said other vehicle is detected from the other vehicle is the communication device using the speed of the other vehicle The other vehicle corrects the absolute position of the other vehicle at the time when the absolute position information indicating the absolute position of the other vehicle is received, and the other vehicle receives the absolute position information received from the communication device and the corrected GPS of the other vehicle. the absolute position information indicating the absolute position of the other vehicle which is obtained by averaging the position information received from the other vehicle, and of the other vehicle which has been stored by the absolute position information received from the other vehicle The updated absolute position information is received from the communication device that updates the absolute position information, and the own vehicle absolute position estimating means is connected to the updated absolute position information received by the receiving means and the correcting means. Yo A corrected GPS position information, by averaging the estimates of the absolute position of the vehicle.

A position estimation system according to a second aspect of the present invention is a storage means for storing absolute position information, and a first communication means for transmitting absolute position information stored in the storage means and receiving information transmitted from the outside. A roadside communication device comprising: a second communication means for receiving absolute position information transmitted from the first communication means; a host vehicle GPS position information detection means for detecting GPS position information of the host vehicle; Using the vehicle speed measuring means for measuring the vehicle speed and the vehicle speed measured by the vehicle speed measuring means, the GPS position information detected by the own vehicle GPS position information detecting means is converted into the GPS position information by the second communication means. The correction means for correcting the absolute position of the host vehicle at the time of reception, the absolute position information received by the second communication means, and the GPS position information corrected by the correction means are averaged. And the second communication means further indicates an absolute position estimated by the own vehicle absolute position estimation means. A vehicle-mounted communication device that transmits position information to the roadside communication device, wherein the first communication means of the roadside communication device receives the absolute position information transmitted from the second communication means of the vehicle-mounted communication device. The storage means stores the absolute position information received by the first communication means.

According to a third aspect of the present invention, there is provided a position estimation system for storing absolute position information, first communication means for transmitting information to the outside and receiving information transmitted from the outside, and correcting GPS position information. A roadside communication device having correction means, own vehicle absolute position estimating means for estimating the absolute position of the own vehicle, own vehicle GPS position information detecting means for detecting GPS position information of the own vehicle, and vehicle speed for measuring the vehicle speed A second means for transmitting to the roadside communication device and receiving information from outside the measuring means, the GPS position information detected by the own vehicle GPS position information detecting means, and the vehicle speed measured by the vehicle speed measuring means; An in-vehicle communication device having communication means, wherein the first communication means of the roadside communication device receives GPS position information and vehicle speed transmitted from the in-vehicle communication device, and the correction means Using the vehicle speed received by the first communication means, the GPS position information received by the first communication means is used as the absolute position of the host vehicle when the first communication means receives the GPS position information. The absolute position information of the own vehicle is averaged by the absolute position information stored in the storage means and the GPS position information corrected by the correction means. The storage means stores absolute position information indicating the absolute position of the host vehicle estimated by the vehicle absolute position estimation means, and the first communication means stores the absolute position of the host vehicle in the in-vehicle communication device. Send to.

  According to the first, third and fourth aspects of the invention, the absolute position information transmitted from the communication device and the GPS position information corrected to the absolute position of the host vehicle at the time when the absolute position information is received are averaged. By doing so, it is possible to reduce the error included in the GPS position information and estimate the absolute position of the host vehicle with high accuracy.

It is a block diagram which shows the structure of the position estimation apparatus which concerns on embodiment of this invention. It is a figure explaining the state of the own vehicle and driving vehicle which are drive | working the same lane. It is a flowchart which shows the position detection routine of 1st Embodiment. It is a block diagram which shows the structure of the position estimation apparatus which concerns on 2nd Embodiment. It is a flowchart which shows the position detection routine of 2nd Embodiment. (A) And (B) is a figure which shows the observation result of the laser radar which is the stationary object data acquired with the periphery monitoring sensor. It is a block diagram which shows the structure of the position estimation apparatus which is a modification of 2nd Embodiment. It is a flowchart which shows the position detection routine in the modification of 2nd Embodiment. It is a figure explaining the communication state of the position estimation apparatus and roadside communication apparatus which concern on 3rd Embodiment. It is a block diagram which shows the structure of the position estimation apparatus which concerns on 3rd Embodiment. It is a flowchart which shows the position detection routine in 3rd Embodiment. It is a figure explaining the communication state of the position estimation apparatus and roadside communication apparatus which concern on 4th Embodiment. It is a block diagram which shows the structure of the position estimation apparatus which concerns on 4th Embodiment. It is a flowchart which shows the position detection routine in 4th Embodiment.

  Hereinafter, preferred embodiments of the present invention will be described in detail with reference to the drawings.

[First Embodiment]
FIG. 1 is a block diagram showing a configuration of a position estimation apparatus 10 according to an embodiment of the present invention. The position estimation device 10 is mounted on a GPS sensor 11 that receives a GPS (Global Positioning System) signal from a satellite and detects GPS position information of the host vehicle, and a vehicle (peripheral vehicle) that travels around the host vehicle. A receiving unit 12 that receives GPS position information respectively transmitted from the vehicle communication device 100, a vehicle lateral position estimating unit 17 that estimates an absolute position in a lateral direction with respect to the traveling direction of the host vehicle, and a vehicle control that controls the behavior of the vehicle. A unit 18 and an information presentation unit 19 for presenting information are provided.

  The vehicle communication device 100 includes a GPS sensor 101 that measures GPS position information, and a transmission unit 102 that transmits the GPS position information measured by the GPS sensor 101 to another vehicle.

  In the first embodiment, a case is considered in which GPS position information is transmitted and received between vehicles traveling in the same direction in the same lane.

  FIG. 2 is a diagram for explaining the state of the host vehicle and the preceding vehicle traveling in the same lane. The vehicle at the center of FIG. 6 will be described as the own vehicle. Here, if the optical communication is used, the vehicle that is the communication partner can be easily specified, so that it is possible to realize the communication limited to the vehicle traveling in the same lane.

  FIG. 3 is a flowchart showing the position detection routine of the first embodiment.

  The GPS sensor 101 of the vehicle communication device 100 mounted on the surrounding vehicle measures the GPS position information of the surrounding vehicle based on the signal from the satellite (step S1). The transmitting unit 102 transmits the GPS position information measured by the GPS sensor 101 to other surrounding vehicles.

  On the other hand, the receiving unit 12 of the position estimation device 10 mounted on the host vehicle receives the GPS position information transmitted from the surrounding vehicle (step S2). The GPS sensor 11 of the position estimation device 10 detects the GPS position information of the host vehicle by GPS positioning (step S3). The vehicle lateral position estimation unit 17 integrates the GPS positioning results (step S4). Specifically, the vehicle lateral position estimation unit 17 performs an averaging process on the GPS position information detected by the GPS sensor 11 and the GPS position information of the surrounding vehicles received by the reception unit 12, thereby improving accuracy. The high lateral position is calculated. Here, the lateral position refers to an absolute position in the lateral direction orthogonal to the traveling direction.

  The calculation principle of the vehicle lateral position estimation unit 17 is as follows. In FIG. 2, although the distance between vehicles is unknown, each vehicle is restrained so that it may drive | work the same lane, and it is thought that each vehicle exists on the substantially same straight line. That is, the GPS position information of each vehicle should be arranged on a straight line that matches the traveling direction. However, in actuality, the actual measurement values of the GPS position information each include an error, and thus a deviation occurs in a direction (lateral position) orthogonal to the traveling direction. Since the GPS positioning error has randomness, lateral deviation can be reduced by averaging the GPS positioning results of the preceding and following vehicles obtained by communication.

[Second Embodiment]
Next, a second embodiment of the present invention will be described. In addition, the same code | symbol is attached | subjected to the site | part similar to 1st Embodiment, and a different point is mainly demonstrated.

  FIG. 4 is a block diagram illustrating a configuration of a position estimation apparatus 10A according to the second embodiment. In addition to the configuration of the position estimation device 10 illustrated in FIG. 1, the position estimation device 10A includes a periphery monitoring sensor 13 that monitors the periphery of the vehicle, a relative position calculation unit 14 that calculates a relative position with respect to the surrounding vehicle, And a vehicle position estimation unit 15 that estimates the absolute position of the host vehicle.

  The vehicle communication device 100A mounted on another vehicle includes a GPS sensor 101, a transmission unit 102, and a surrounding monitoring sensor 103.

  The periphery monitoring sensors 13 and 103 are not particularly limited as long as they can monitor the periphery of the host vehicle, and for example, a laser radar device, an imaging device, and the like are applicable. In the second and subsequent embodiments, a laser radar device will be described as an example of the periphery monitoring sensor.

  FIG. 5 is a flowchart showing a position detection routine according to the second embodiment.

  The GPS sensor 11 of the vehicle communication device 100A detects the GPS position information of the own vehicle by GPS positioning (step S11). The periphery monitoring sensor 103 acquires obstacle data such as moving objects (vehicles, pedestrians, etc.) and stationary objects that exist in the vicinity, and the stationary data that can be used as estimated movement amount or map information in the obstacle data. Data on the object (hereinafter referred to as “stationary object data”) is extracted (step S12). The method for extracting stationary object data is not particularly limited, and a known technique can be used. The transmitting unit 102 converts the GPS position information detected by the GPS sensor 101 and the stationary object data acquired by the periphery monitoring sensor 103 into communication signals, and then sequentially transmits them to the surrounding vehicles.

  On the other hand, the receiving unit 12 of the position estimation device 10A mounted on the host vehicle receives the communication signal transmitted from the surrounding vehicle and decodes the signal (step S13), thereby acquiring the GPS position acquired in the surrounding vehicle. Obtain information and stationary data. On the other hand, the periphery monitoring sensor 13 of the position estimation apparatus 10A extracts stationary object data existing around the host vehicle.

  The relative position calculation unit 14 calculates the relative position of the surrounding vehicle (communication vehicle) with respect to the host vehicle based on the stationary object data extracted by the surrounding monitoring sensor 13 (step S14).

  The vehicle position estimation unit 15 estimates the absolute position of the host vehicle at time (t-1) (step S15). Here, it is assumed that there are n peripheral vehicles 1, 2,.

First, the vehicle position estimation unit 15 calculates the GPS position information (X ₁ , Y ₁ ) of the own vehicle based on the GPS position information of the surrounding vehicle 1 and the relative position of the surrounding vehicle 1 with respect to the own vehicle. . Next, the vehicle position estimating unit 15 calculates the GPS position information (X ₂ , Y ₂ ) of the own vehicle based on, for example, the GPS position information of the surrounding vehicle 2 and the relative position of the surrounding vehicle 2 with respect to the own vehicle. To do. Similarly, the vehicle position estimation unit 15 uses the information of the surrounding vehicles 3, 4,..., N, and uses the GPS position information (X ₃ , Y ₃ ), (X ₄ , Y ₄ ), _..., to calculate the _{(X n, Y} n).

  Then, the relative position calculation unit 14 averages the GPS position information of the n number of own vehicles and the GPS position information of the own vehicle directly measured by the GPS sensor 11, so that the own position of the own vehicle at time (t−1) is obtained. Estimate absolute position.

  Here, the GPS position information by GPS positioning and the relative position by the peripheral monitoring sensor each include an observation error. Therefore, the relative position calculation unit 14 calculates the GPS position information of the own vehicle using the GPS position information and the relative position of each surrounding vehicle as described above, and is directly measured by the GPS position information of the own vehicle and the own vehicle. Since the random noise included in the GPS positioning result can be reduced by averaging the GPS position information, the absolute position of the host vehicle can be calculated with high accuracy.

  Next, the vehicle position estimation unit 15 determines the amount of movement of the host vehicle from a predetermined sampling period, that is, from time (t−1) to time t, based on the time change of the stationary object data observed in the host vehicle and other vehicles. Is estimated (step S16).

  FIGS. 6A and 6B are diagrams illustrating laser radar observation results that are stationary object data extracted by the periphery monitoring sensor. The movement amount of the host vehicle is estimated from the difference between the observation results of the laser radar at time (t-1) and time t.

  Here, the vehicle position estimating unit 15 stops the stationary object observed by the surrounding monitoring sensor 103 of the surrounding vehicle even when the own vehicle is surrounded by many surrounding vehicles and a stationary object cannot be observed directly by the own vehicle. Since the object data can be used, the estimation accuracy of the movement amount of the host vehicle can be improved.

  In addition, the receiving part 12 may receive the data from the other vehicle in the direction of a blind spot (for example, the left rear with respect to the advancing direction) from the own vehicle. As a result, the situation in the direction of the blind spot from the host vehicle can be taken into account, and the amount of movement of the host vehicle is obtained with high accuracy.

  Finally, the vehicle position estimation unit 15 integrates the absolute position at the time (t−1) calculated in Step S15 and the movement amount at the time t from the time (t−1) estimated in Step S16. The absolute position of the host vehicle at the current time t is estimated (step S17). Here, the vehicle position estimation unit 15 can realize further error reduction by integrating the highly accurate GPS positioning result and the amount of movement of the own vehicle using, for example, a Kalman filter, a particle filter, or the like.

  Then, the absolute position information estimated by the vehicle position estimation unit 15 is sent to the vehicle control unit 18 and the information presentation unit 19, and is used to realize a driving support system such as temporary stop or navigation at an intersection.

  As described above, the position estimation device 10A calculates the GPS position information of the own vehicle using the GPS position information and the relative position of each surrounding vehicle, and the GPS position information and the GPS position directly measured by the own vehicle. Average the information. As a result, since the random noise included in the GPS positioning result can be reduced, the absolute position of the host vehicle can be calculated with high accuracy. Furthermore, the position estimation device 10A can estimate the current position with high accuracy by integrating the absolute position of the own vehicle and the movement amount of the own vehicle.

(Modification)
FIG. 7 is a block diagram illustrating a configuration of a position estimation device 10B that is a modification of the second embodiment. In addition to the configuration of the position estimation apparatus 10A shown in FIG. 4, the position estimation apparatus 10B includes a map information storage unit 14 that stores observation results acquired by the periphery monitoring sensor as map information.

  The map storage unit 16 sequentially stores the stationary object data observed by the vehicle periphery monitoring sensor 13 and the absolute position information of the host vehicle estimated by the vehicle position estimation unit 15 at the time of observation. Further, the map storage unit 16 may sequentially store information received by the receiving unit 12. Specifically, the map storage unit 16 sequentially stores stationary object data observed by the periphery monitoring sensor 103 of another vehicle and GPS position information of the other vehicle measured by the GPS sensor 101 at the time of observation. May be.

  FIG. 8 is a flowchart showing a position detection routine in a modification of the second embodiment. The same steps as those in FIG. 5 are denoted by the same reference numerals, and different steps will be mainly described.

  After step S15 ends, the vehicle position estimation unit 15 reads map data corresponding to the absolute position of the host vehicle at the time (t-1) calculated in step S15 from the map storage unit 16 (step S21).

  Next, the vehicle position estimating unit 15 collates the map data at the time (t−1) read out in step S21 with the stationary object data at the time t observed in the own vehicle and other vehicles, and from the difference, The movement amount of the vehicle is estimated (step S22).

  And the vehicle position estimation part 15 integrates the absolute position of the time (t-1) calculated by step S15, and the movement amount estimated by step S21, and calculates the absolute position of the own vehicle in the present time t. Estimate with high accuracy.

  Finally, the vehicle position estimation unit 15 creates / updates map information based on the integration result, and stores the created / updated map data and its position information in the map storage unit 16 (step S23).

  As a result, the position estimation device 10B can easily estimate the amount of movement of the host vehicle if the map data of the road once traveled is stored in the map storage unit 16, and as a result, the current host vehicle can be estimated. Can be estimated with high accuracy.

[Third Embodiment]
Next, a third embodiment of the present invention will be described. In the third and fourth embodiments, road-to-vehicle communication will be described.

  FIG. 9 is a diagram illustrating a communication state between the position estimation device 50 and the roadside communication device 200 according to the third embodiment. As shown in the figure, the roadside communication device 200 is installed on, for example, a traveling lane of a road, and communicates with a position estimation device 50 mounted on a vehicle traveling in the traveling lane.

  FIG. 10 is a block diagram illustrating a configuration of a position estimation device 50 according to the third embodiment. The position estimation device 50 includes a communication unit 51 that communicates with the roadside communication device 200, a vehicle speed measurement unit 52 that measures the vehicle speed of the host vehicle, a GPS sensor 53 that measures GPS position information of the host vehicle, and the absolute position of the host vehicle. The vehicle position estimation part 54 which estimates this, the vehicle control part 56 which controls a vehicle, and the information presentation part 57 which presents information are provided.

  The roadside communication apparatus 200 includes a communication unit 201 that communicates with a vehicle, and a sensor information storage unit 202 that stores absolute position information transmitted from each vehicle as sensor information. The absolute position information stored in the sensor information storage unit 202 represents the communication area of the roadside communication device 200.

  Each time the vehicle passes through the communication area of the roadside communication device 200, the communication unit 201 transmits the absolute position information stored in the sensor information storage unit 202 to the vehicle, and the absolute position information from the vehicle. Receive. At this time, the sensor information storage unit 202 stores the received absolute position information every time the communication unit 201 receives the absolute position information.

  FIG. 11 is a flowchart showing a position detection routine in the third embodiment.

  The vehicle speed measurement unit 52 of the position estimation device 50 measures the vehicle speed of the host vehicle (step S31). The GPS sensor 53 repeats GPS positioning at intervals of about 1 second and measures the GPS position information of the host vehicle (step S32). The communication unit 51 communicates with the roadside communication device 200 and receives absolute position information (step S33).

  Next, the vehicle position estimation unit 54 uses the vehicle speed information measured by the vehicle speed measurement unit 52 to obtain the GPS position information of the own vehicle acquired by the GPS sensor 53 at the most recent time, and the position of the own vehicle at the time of communication. It correct | amends so that it may represent (step S34). Thereby, the vehicle position estimation unit 54 calculates the position information of the communication area that has received data from the roadside communication device 200.

  And the vehicle position estimation part 54 reduces the random error contained in a GPS positioning result by integrating the calculated communication position information and the accumulation | storage data of the absolute position obtained from the roadside communication apparatus 200 (for example, average process). Thus, a highly accurate absolute position is estimated (step S35). The communication unit 51 transmits the absolute position information calculated by the vehicle position estimation unit 54 to the roadside communication device 200 (step S36).

  On the other hand, the communication unit 201 of the roadside communication device 200 receives the absolute position transmitted from the position estimation device 50 and stores it in the sensor information storage unit 202. As this is repeated, the absolute position stored in the sensor information storage unit 202 of the roadside communication device 200 is updated (step S37), and the accuracy of the absolute position gradually increases. The roadside communication device 200 does not need to include a GPS sensor, and can be realized by miniaturization and cost can be reduced.

  As described above, the position estimation device 50 calculates the absolute position of the host vehicle at the time of communication with high accuracy based on the highly accurate absolute position information transmitted from the roadside communication device 200 and the vehicle speed of the host vehicle, By averaging the absolute position and the GPS position information of the host vehicle, it is possible to estimate a highly accurate absolute position without a GPS error.

  Further, the roadside communication device 200 only communicates with the position estimation device 50 to store sensor information, and does not need to perform complicated arithmetic processing. Therefore, it is possible to estimate the absolute position with high accuracy without cost.

  In the third embodiment, an example in which the vehicle position estimation unit 54 is provided in the position estimation device 50 has been described. However, the vehicle position estimation unit 54 may be provided in the roadside communication device 200. At this time, in the roadside communication device 200, the communication unit 201 receives the vehicle speed and the GPS position information of the host vehicle from the position estimation device 50, and the vehicle position estimation unit 54 receives the information and estimates the absolute position of the host vehicle using the information. The absolute position of the host vehicle estimated by the communication unit 201 may be transmitted to the position estimation device 50.

[Fourth Embodiment]
Next, a fourth embodiment of the present invention will be described. In addition, the same code | symbol is attached | subjected to the site | part same as embodiment mentioned above, and the overlapping description is abbreviate | omitted.

  FIG. 12 is a diagram illustrating a communication state between the position estimation device 50A and the roadside communication device 200A according to the fourth embodiment. As shown in the figure, the roadside communication device 200A is installed, for example, in a roadside belt. Then, the roadside communication device 200A detects a vehicle traveling in the traveling lane, generates relative position information with respect to the detected vehicle, and transmits the relative position information to the traveling vehicle. The position estimation device 50A mounted on the vehicle traveling in the traveling lane estimates the absolute position of the host vehicle based on the GPS position information GPS-measured by the host vehicle and the relative position information from the roadside communication device 200A. .

  FIG. 13 is a block diagram illustrating a configuration of a position estimation device 50A according to the fourth embodiment. The position estimation device 50A includes a GPS sensor 53 that measures GPS position information of the host vehicle, a vehicle position estimation unit 54 that estimates the absolute position of the host vehicle, a vehicle control unit 56 that controls the vehicle, and information that provides information. And a communication unit 58 that performs communication between the presenting unit 57 and the roadside communication device 200A.

  The roadside communication device 200A is calculated by the peripheral observation sensor 203 that observes each vehicle traveling in the traveling lane, the relative position calculation unit 204 that calculates the relative position of each vehicle, and the relative position calculation unit 204. And a communication unit 205 that transmits information and communicates with the position estimation device 50. The peripheral observation sensor 203 is not particularly limited as long as it can detect a vehicle traveling in the traveling lane, and may be a laser radar device, an imaging device, or the like. In the present embodiment, the peripheral observation sensor 203 is described as a laser radar device.

  FIG. 14 is a flowchart showing a position detection routine in the fourth embodiment.

  The periphery observation sensor 203 of the roadside communication device 200A measures the vehicle from the observation result of the laser radar (step S41). Based on the observation result of the peripheral observation sensor 203, the relative position calculation unit 204 is a relative position (distance and azimuth with respect to the detected vehicle with respect to the roadside communication device 200A, or a position in a coordinate system centered on the roadside communication device 200A). However, it is acceptable) (step S42). The communication unit 205 encodes the information calculated by the relative position calculation unit 204 and transmits a communication signal to the detected vehicle (step S43).

  On the other hand, the communication unit 58 of the position estimation device 50A receives and decodes the transmission signal from the roadside communication device 200A to acquire relative position information (step S44). On the other hand, the GPS sensor 53 mounted on the host vehicle measures the GPS position information of the host vehicle (step S45).

  The vehicle position estimation unit 54 estimates the movement amount of the own vehicle amount based on the time difference of the relative position information transmitted from the roadside communication device 200A (step S46). Then, the vehicle position estimation unit 54 estimates the absolute position of the host vehicle with high accuracy by integrating the movement amount estimated in step S46 and the GPS position information (step S47).

  At this time, the absolute position of the roadside communication device 200A is not required. Of course, the peripheral observation sensor 203 is not a laser radar, but may be any measuring device that can calculate the relative position with respect to the vehicle.

  Note that the present invention is not limited to the above-described embodiment, and it is needless to say that the present invention can also be applied to a design modified within the scope of the claims.

  For example, the receiving units 12, 58 and 102, the transmitting units 102 and 205, and the communication units 51 and 201 may use optical communication (for example, a laser light emitting diode (LED), a camera, a photodiode, etc.). In particular, in the case of optical communication using a camera as a light receiving device, it is easy to grasp from which vehicle the data is sent. When combined with a distance measuring sensor such as a laser radar, the calculation of the relative position can be realized by a simple process.

  In the fourth embodiment, the vehicle position estimation unit 54 is provided in the position estimation device 50A. However, the vehicle position estimation unit 54 may be provided in the roadside communication device 200A. At this time, in the roadside communication device 200A, the communication unit 205 receives the GPS position information of the host vehicle from the position estimation device 50A. Further, the vehicle position estimation unit 54 estimates the movement amount of the own vehicle amount based on the time difference of the relative position information, and estimates the absolute position of the own vehicle by integrating the movement amount and the received GPS position information. . And the communication part 205 should just transmit the absolute position of the own vehicle to the position estimation apparatus 50A.

10, 10A, 10B, 50, 50A Position estimation device 11, 53 GPS sensor 12 Reception unit 13 Perimeter monitoring sensor 14 Relative position calculation unit 15, 54 Vehicle position estimation unit 16 Map storage unit 17 Vehicle lateral position estimation unit 18, 56 Vehicle Control unit 19, 57 Information presentation unit 51, 58, 205 Communication unit 52 Vehicle speed measurement unit 100, 100A Vehicle communication device 200, 200A Roadside communication device

Claims (3)

Receiving means for receiving the absolute position information of the host vehicle transmitted from the communication device;
Own vehicle GPS position information detecting means for detecting the GPS position information of the own vehicle;
Vehicle speed measuring means for measuring the vehicle speed;
Using the vehicle speed measured by the vehicle speed measuring means, the GPS position information detected by the own vehicle GPS position information detecting means is changed to the absolute position of the own vehicle when the absolute position information is received by the receiving means. Correction means for correcting;
Own vehicle absolute position estimating means for estimating the absolute position of the own vehicle by averaging the absolute position information received by the receiving means and the GPS position information corrected by the correcting means;
Transmitting means for transmitting absolute position information indicating the absolute position of the host vehicle estimated by averaging to the communication device;
A position estimation device comprising:
In the other vehicle, the receiving means uses the GPS position information of the other vehicle detected by the other vehicle and the vehicle speed of the other vehicle to indicate the absolute position information of the other vehicle from the communication device. The other vehicle corrects the absolute position of the other vehicle at the time of receiving the signal, and averages the absolute position information received by the other vehicle from the communication device and the corrected GPS position information of the other vehicle. receiving the absolute position information indicating the absolute position of the other vehicle obtained from the other vehicle by, and updating the absolute position information of the other vehicle which has been stored by the absolute position information received from the other vehicles the communication Receiving the updated absolute position information from the device;
The own vehicle absolute position estimating means averages the updated absolute position information received by the receiving means and the GPS position information corrected by the correcting means, thereby calculating the absolute position of the own vehicle. A position estimation device for estimation. A roadside communication device comprising: storage means for storing absolute position information; and first communication means for transmitting the absolute position information stored in the storage means and receiving information transmitted from outside.
Second communication means for receiving absolute position information transmitted from the first communication means, own vehicle GPS position information detection means for detecting GPS position information of the own vehicle, vehicle speed measurement means for measuring vehicle speed, Using the vehicle speed measured by the vehicle speed measuring means, the GPS position information detected by the own vehicle GPS position information detecting means is used as the absolute position of the own vehicle at the time when the GPS position information is received by the second communication means. The absolute position of the host vehicle is estimated by averaging the correction means for correcting the position, the absolute position information received by the second communication means, and the GPS position information corrected by the correction means. Own vehicle absolute position estimating means, and the second communication means further sends absolute position information indicating the absolute position estimated by the own vehicle absolute position estimating means to the roadside communication device. And a vehicle communication device that signals to,
The first communication means of the roadside communication device receives the absolute position information transmitted from the second communication means of the in-vehicle communication device, and the storage means is the absolute position received by the first communication means. A position estimation system characterized by storing information. Storage means for storing absolute position information, first communication means for transmitting information to the outside and receiving information transmitted from the outside, correction means for correcting GPS position information, and estimating the absolute position of the host vehicle A roadside communication device having own vehicle absolute position estimating means;
The own vehicle GPS position information detecting means for detecting the GPS position information of the own vehicle, the vehicle speed measuring means for measuring the vehicle speed, the GPS position information detected by the own vehicle GPS position information detecting means, and measured by the vehicle speed measuring means An in-vehicle communication device having a vehicle speed, and a second communication means for transmitting information to the roadside communication device and receiving information from the outside,
The first communication means of the roadside communication device receives GPS position information and vehicle speed transmitted from the in-vehicle communication device, and the correction means uses the vehicle speed received by the first communication means, The GPS position information received by the first communication means is corrected to the absolute position of the host vehicle at the time when the first communication means received the GPS position information, and the host vehicle absolute position estimation means is the storage means. The absolute position information stored in the vehicle and the GPS position information corrected by the correction means are averaged to estimate the absolute position of the host vehicle, and the storage means is estimated by the vehicle absolute position estimation means. The absolute position information which shows the absolute position of the said own vehicle was memorize | stored, and the said 1st communication means transmits the absolute position of the said own vehicle to the said vehicle-mounted communication apparatus. The position estimation system characterized by the above-mentioned.

Images