Modified emergency stop to use the service instead of publishing.
Modified walk and speech states to use the blocking or non blocking calls in SMACH.