Fix speed estimation for fast controlers