now using teensy libraries, stall detection fixed