System and method for fusing surrounding V2V signal and sensing signal of ego vehicle
A method of fusing a surrounding vehicle-to-vehicle (V2V) signal and a sensing signal of an ego vehicle includes calculating a position of a surrounding target vehicle and a velocity of the target vehicle based on the ego vehicle using global positioning system (GPS)/vehicle velocity information detected in the ego vehicle and GPS/vehicle velocity information included in a V2V signal detected in the target vehicle, extracting a sensor signal within a predetermined specific distance error from a position of the target vehicle relative to the ego vehicle of the V2V signal as a sensor information candidate group corresponding to the V2V signal, adaptively using a constant velocity model, a kinematic model or a dynamic model according to the extracted situation, and comparing the V2V signal with information on an object tracked using both the sensing signal and the V2V signal to estimate a position and velocity error of the V2V signal.
1. A method of fusing a surrounding vehicle-to-vehicle (V2V) signal and a sensing signal of an ego vehicle, the method comprising:
calculating a position of a surrounding target vehicle and a velocity of the target vehicle based on the ego vehicle using global positioning system (GPS)/vehicle velocity information detected in the ego vehicle and GPS/vehicle velocity information included in a V2V signal detected in the target vehicle;
extracting a sensor signal within a predetermined specific distance error from a position of the target vehicle relative to the ego vehicle of the V2V signal as a sensor information candidate group corresponding to the V2V signal;
adaptively using a constant velocity model, a kinematic model or a dynamic model according to the extracted situation; and
comparing the V2V signal with information on an object tracked using both the sensing signal and the V2V signal to estimate a position and velocity error of the V2V signal.
2. The method according to claim 1 , further comprising, after the comparing step,
detecting a sensor signal alone based on a constant velocity mode; and
compensating for an error by applying the position and velocity error of the V2V signal and the sensing signal.
3. The method according to claim 1 , wherein the extracting step includes:
determining whether information detected based on a position of the target vehicle relative to the ego vehicle is the V2V signal within a predetermined sensor detection area; and
calculating similarity with a GPS signal using a sensing signal extracted as a sensor information candidate group and a vehicle velocity, a yaw rate and a path history of the V2V signal when the V2V signal is detected within the sensor detection area and selecting the sensor signal and the V2V signal of the same target vehicle based on the calculated similarity.
4. The method according to claim 1 , wherein the adaptively using a constant velocity model step includes:
determining whether a velocity of the target vehicle is greater than a predetermined threshold velocity value, applying a kinematic model upon determining that the velocity of the target vehicle is not greater than the predetermined threshold velocity value, and applying a dynamic model upon determining that the velocity of the target vehicle is greater than the predetermined threshold velocity value; and
performing prediction based on the selected model and fusing the V2V signal and the sensing signal.
5. A computer-readable recording medium having recorded thereon a program for executing the method according to claim 1 .
6. A computer-readable recording medium having recorded thereon a program for executing the method according to claim 2 .
7. A computer-readable recording medium having recorded thereon a program for executing the method according to claim 3 .
8. A computer-readable recording medium having recorded thereon a program for executing the method according to claim 4 .
9. A system for fusing a surrounding vehicle-to-vehicle (V2V) signal and a sensing signal of an ego vehicle, the system comprising:
a sensing unit configured to detect global positioning system (GPS)/vehicle velocity information from one or more sensors mounted in the ego vehicle;
a V2V communication unit configured to transmit information on the ego vehicle detected by the sensing unit to one or more target vehicles within a predetermined area or to receive a V2V signal from a target vehicle within a predetermined area of the ego vehicle; and
a controller configured to perform control to fuse a sensing signal detected by the sensing unit and the V2V signal received and output by the V2V communication unit to estimate an error based on fused object information, to correct the sensing signal based on the estimated error, and to correct the V2V signal based on the estimated error.
10. The system according to claim 9 , wherein the controller determines whether information detected based on a position of the target vehicle relative to the ego vehicle is the V2V signal within a predetermined sensor detection area, calculates similarity with a GPS signal using a sensor signal extracted as a sensing signal candidate group and a vehicle velocity, a yaw rate and a path history of the V2V signal when the V2V signal is detected within the sensor detection area, and selects the sensor signal and the V2V signal of the same target vehicle based on the calculated similarity.
11. The system according to claim 9 , wherein the controller determines whether a velocity of the target vehicle is greater than a predetermined threshold velocity value, applies a kinematic model upon determining that the velocity of the target vehicle is not greater than the predetermined threshold velocity value, and applies a dynamic model upon determining that the velocity of the target vehicle is greater than the predetermined threshold velocity value.