Added OSC reply, added safety features, added estop