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

Where is the code to actually stop everything when ESTOP_PIN is set.  This looks to be the check for probing, but what about normal motion?  It doesn't look like that's in this diff anywhere.