add sonar to radar mavlink message