Fixed fatal error with limit switch. Minor debug improvments.
Speedup for limit switch reaction in debug mode
Field test fixes