Fix to allow filter correction with vision position estimate