Browse Source

add obs bounary log

zhangjia 4 years ago
parent
commit
b64706a86a

+ 4 - 2
src/decition/decition_brain/decition/brain.cpp

@@ -632,12 +632,14 @@ void iv::decition::BrainDecition::run() {
             }
             iv::modulecomm::ModuleSendMsg(mpaPlanTrace,(char *)decitionGps00->planTrace.data(),decitionGps00->planTrace.size()*sizeof(iv::TracePoint));
 
-            iv::modulecomm::ModuleSendMsg(mpaObsTraceLeft,(char *)ServiceCarStatus.obsTraceLeft.data(),ServiceCarStatus.obsTraceLeft.size()*sizeof(iv::TracePoint));
-            iv::modulecomm::ModuleSendMsg(mpaObsTraceRight,(char *)ServiceCarStatus.obsTraceRight.data(),ServiceCarStatus.obsTraceRight.size()*sizeof(iv::TracePoint));
+            iv::modulecomm::ModuleSendMsg(mpaObsTraceLeft,(char *)(ServiceCarStatus.obsTraceLeft.data()),ServiceCarStatus.obsTraceLeft.size()*sizeof(iv::TracePoint));
+            iv::modulecomm::ModuleSendMsg(mpaObsTraceRight,(char *)(ServiceCarStatus.obsTraceRight.data()),ServiceCarStatus.obsTraceRight.size()*sizeof(iv::TracePoint));
             //      decition_gps = decitionLine00->getDecideFromGPS(*gps_data_, navigation_data, obs_lidar_grid_);
             //ODS("\n决策:%f\t%f\t\t", decition_gps->speed, decition_gps->wheel_angle);
             //ODS("\n接收到的实时GPS数据:%f\t%f\t%f\n", gps_data_->gps_x, gps_data_->gps_y,gps_data_->ins_heading_angle);
 
+
+
             //carcall->is_arrived = decitionGps00->is_arrivaled;
             //double end = GetTickCount();
             decision_period = start - last;

+ 6 - 0
src/decition/decition_brain/decition/decide_gps_00.cpp

@@ -1956,6 +1956,12 @@ iv::decition::Decition iv::decition::DecideGps00::getDecideFromGPS(GPS_INS now_g
 
     //   qDebug("decide1 time is %d",xTime.elapsed());
 
+    for(int i=0;i<ServiceCarStatus.obsTraceLeft.size();i++){
+        givlog->debug("obs_distance","obsTraceLeftX: %f, obsTraceLeftY: %f",
+                      ServiceCarStatus.obsTraceLeft.at(i).x, ServiceCarStatus.obsTraceLeft.at(i).y);
+    }
+
+
     return gps_decition;
 }