Safety commit. Rostopic pub with rostopic echo works, and SpeakEasySubscriber receives the msgs. But robot_interaction doesn't send the right msg.