speed estimation added