model position std should be exp(std) (#22593)

pull/21625/head
Greg Hogan 4 years ago committed by GitHub
parent e6545a7238
commit c1c402a821
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
  1. 6
      selfdrive/modeld/models/driving.cc

@ -253,16 +253,16 @@ void fill_xyzt(cereal::ModelDataV2::XYZTData::Builder xyzt, const float *data, i
if (plan_t_arr == nullptr) { if (plan_t_arr == nullptr) {
t_arr[i] = T_IDXS[i]; t_arr[i] = T_IDXS[i];
x_arr[i] = data[i*columns + 0]; x_arr[i] = data[i*columns + 0];
x_std_arr[i] = data[columns*(TRAJECTORY_SIZE + i) + 0]; x_std_arr[i] = exp(data[columns*(TRAJECTORY_SIZE + i) + 0]);
} else { } else {
t_arr[i] = plan_t_arr[i]; t_arr[i] = plan_t_arr[i];
x_arr[i] = X_IDXS[i]; x_arr[i] = X_IDXS[i];
x_std_arr[i] = NAN; x_std_arr[i] = NAN;
} }
y_arr[i] = data[i*columns + 1]; y_arr[i] = data[i*columns + 1];
y_std_arr[i] = data[columns*(TRAJECTORY_SIZE + i) + 1]; y_std_arr[i] = exp(data[columns*(TRAJECTORY_SIZE + i) + 1]);
z_arr[i] = data[i*columns + 2]; z_arr[i] = data[i*columns + 2];
z_std_arr[i] = data[columns*(TRAJECTORY_SIZE + i) + 2]; z_std_arr[i] = exp(data[columns*(TRAJECTORY_SIZE + i) + 2]);
} }
xyzt.setX(x_arr); xyzt.setX(x_arr);
xyzt.setY(y_arr); xyzt.setY(y_arr);

Loading…
Cancel
Save