Browse Source

AP_WheelEncoder: Fix integer division limiting wheel encoder accuracy

CID: 318646
master
Michael du Breuil 6 years ago committed by Randy Mackay
parent
commit
b38200a960
  1. 2
      libraries/AP_WheelEncoder/AP_WheelEncoder.cpp

2
libraries/AP_WheelEncoder/AP_WheelEncoder.cpp

@ -269,7 +269,7 @@ float AP_WheelEncoder::get_rate(uint8_t instance) const @@ -269,7 +269,7 @@ float AP_WheelEncoder::get_rate(uint8_t instance) const
}
// calculate delta_angle (in radians) per second
return M_2PI * (state[instance].dist_count_change / _counts_per_revolution[instance]) / (state[instance].dt_ms / 1000.0f);
return M_2PI * (state[instance].dist_count_change / ((float)_counts_per_revolution[instance])) / (state[instance].dt_ms * 1e-3f);
}
// get the total number of sensor reading from the encoder

Loading…
Cancel
Save