Implement proper E-Stop
The E-Stop now brings the hardware into a safe state and shut down the software.