amcl reset

[kymadogg]

Create a node that listens for big spikes in covariance and resets the pose to the last known valid location below a certain average covariance threshold.