По-моему у всех машин несколько (от 5) импульсов на 1 метр пути. 1 метр в секунду - это 3.6 км/ч. Так что если тебе не надо отслеживать очень низкие скорости, достаточно считать импульсы. По любому прерыванию изменения состояния ноги увеличиваешь счетчик, а 1-3 раз в секунду считываешь этот счетчик и сразу обнуляешь.
И все, будет у тебя скорость, которую только надо на константу умножить.
Если надо точнее, чем 1 кмч, и/или низкие скорости, то напиши, у меня в голове вертится алгоритм, но он посложнее.