Browse Source

small fix on cov passing loop

sbg
TSC21 7 years ago committed by Lorenz Meier
parent
commit
6329f1a38a
  1. 2
      src/modules/simulator/simulator_mavlink.cpp

2
src/modules/simulator/simulator_mavlink.cpp

@ -1178,7 +1178,7 @@ int Simulator::publish_odometry_topic(mavlink_message_t *odom_mavlink) @@ -1178,7 +1178,7 @@ int Simulator::publish_odometry_topic(mavlink_message_t *odom_mavlink)
"Odometry Velocity Covariance matrix URT array size mismatch");
/* The velocity covariance URT */
for (size_t i = 0; i < (sizeof(odom.velocity_covariance) / sizeof(odom.velocity_covariance[0])); i++) {
for (size_t i = 0; i < VEL_URT_SIZE; i++) {
odom.velocity_covariance[i] = odom_msg.twist_covariance[i];
}

Loading…
Cancel
Save