First set of fixes: speed can be negative in the motorSpeed array, setting the runtime should not disturb the encoder
Reset the lastEncoder on resetEncoder(); clear some bits on stop()
M: cleanup