|
@@ -2788,9 +2788,9 @@ void iv::decition::DecideGps00::computeObsOnRoad(iv::LidarGridPtr lidarGridPtr,
|
|
obsDisVector[roadNum]=obs;
|
|
obsDisVector[roadNum]=obs;
|
|
}
|
|
}
|
|
|
|
|
|
- givlog->debug("obs_distance","obs: %f, lidar_obs: %f, Radar_obs: %f",
|
|
|
|
|
|
+ givlog->debug("obs_distance","obs: %f, lidar_obs: %f, Radar_obs: %f, lidar_obs_x: %f, lidar_obs_y: %f",
|
|
ServiceCarStatus.mObs, ServiceCarStatus.mLidarObs,
|
|
ServiceCarStatus.mObs, ServiceCarStatus.mLidarObs,
|
|
- ServiceCarStatus.mRadarObs);
|
|
|
|
|
|
+ ServiceCarStatus.mRadarObs,obsPoint.x,lidarDistance);
|
|
|
|
|
|
// qDebug("time 3 is %d ",xTime.elapsed());
|
|
// qDebug("time 3 is %d ",xTime.elapsed());
|
|
|
|
|