The current sensor initialization in the estimator is naive and is susceptible to issues when a sensor gives bad measurements. Consider adding some intelligence to determine if a bad measurement was collected during init, such as a sample variance threshold. Output a warning and retry if a problem is detected.
The current sensor initialization in the estimator is naive and is susceptible to issues when a sensor gives bad measurements. Consider adding some intelligence to determine if a bad measurement was collected during init, such as a sample variance threshold. Output a warning and retry if a problem is detected.