Added speed estimation