Changes to detect estop. (and simulate it for testing)

Okay, with only the small snippet I was assuming this was just the probe command not all commands.  I guess everything looks good, then.