Improved sensor and speed reads

Now using hardware counters instead of high overhead queues. This is way faster and less likely to skip edges/pulses.

Discovered bug: When reversing, odometer misses most of the steps. Meanwhile tie sensor is doing perfectly well.