|
@@ -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;
|