added commands to send roll pitch yaw and emergency STOP