|
@@ -322,7 +322,7 @@ void iv::perception::GPSSensor::UpdateGPSIMU(iv::gps::gpsimu xgpsimu)
|
|
data->ins_pitch_angle = xgpsimu.pitch();
|
|
data->ins_pitch_angle = xgpsimu.pitch();
|
|
data->ins_roll_angle = xgpsimu.roll();
|
|
data->ins_roll_angle = xgpsimu.roll();
|
|
|
|
|
|
- data->speed = sqrt(pow(xgpsimu.ve(),2)+pow(xgpsimu.vn(),2)) * 3.6;
|
|
|
|
|
|
+ data->speed = xgpsimu.speed(); //sqrt(pow(xgpsimu.ve(),2)+pow(xgpsimu.vn(),2)) * 3.6;
|
|
|
|
|
|
GaussProjCal(data->gps_lng, data->gps_lat, &data->gps_x, &data->gps_y);
|
|
GaussProjCal(data->gps_lng, data->gps_lat, &data->gps_x, &data->gps_y);
|
|
|
|
|
|
@@ -331,6 +331,7 @@ void iv::perception::GPSSensor::UpdateGPSIMU(iv::gps::gpsimu xgpsimu)
|
|
ServiceCarStatus.mfGPSAcc = xgpsimu.acc_calc();
|
|
ServiceCarStatus.mfGPSAcc = xgpsimu.acc_calc();
|
|
|
|
|
|
ServiceCarStatus.speed = data->speed;
|
|
ServiceCarStatus.speed = data->speed;
|
|
|
|
+ if(ServiceCarStatus.speed < 0.015)ServiceCarStatus.speed = 0.0;
|
|
// qDebug("speed x is %g",ServiceCarStatus.speed);
|
|
// qDebug("speed x is %g",ServiceCarStatus.speed);
|
|
if(data->ins_status == 4)
|
|
if(data->ins_status == 4)
|
|
signal_gps_data->operator()(data); //传输数据
|
|
signal_gps_data->operator()(data); //传输数据
|