Changes to detect estop. (and simulate it for testing)
Merge pull request #7 from keyme/estop-detect

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