|
@@ -197,6 +197,8 @@ static int obstacle_avoid_flag=0;
|
|
|
|
|
|
//日常展示
|
|
|
|
|
|
+#include <QDateTime>
|
|
|
+
|
|
|
iv::decition::Decition iv::decition::DecideGps00::getDecideFromGPS(GPS_INS now_gps_ins,
|
|
|
const std::vector<GPSData> gpsMapLine,
|
|
|
iv::LidarGridPtr lidarGridPtr,
|
|
@@ -209,7 +211,16 @@ iv::decition::Decition iv::decition::DecideGps00::getDecideFromGPS(GPS_INS now_g
|
|
|
Decition gps_decition(new DecitionBasic);
|
|
|
// vector<iv::Point2D> fpTraceTmp;
|
|
|
|
|
|
-
|
|
|
+ bool bgroupgrpc = false;
|
|
|
+ qint64 ngrpcvalid = 3000;
|
|
|
+ iv::group::groupinfo xgroupgrpcinfo;
|
|
|
+ if((QDateTime::currentMSecsSinceEpoch() - ServiceCarStatus.mgroupgrpcupdatetime ) < ngrpcvalid)
|
|
|
+ {
|
|
|
+ ServiceCarStatus.mMutexgroupgrpc.lock();
|
|
|
+ xgroupgrpcinfo.CopyFrom(ServiceCarStatus.mgroupgrpcinfo);
|
|
|
+ ServiceCarStatus.mMutexgroupgrpc.unlock();
|
|
|
+ bgroupgrpc = true;
|
|
|
+ }
|
|
|
|
|
|
|
|
|
//如果useFrenet、useOldAvoid两者不互为相异,则采用原来的方法。“^”为异或运算符。
|