Improved emergency stop by publishing a topic with info about why it stopped