Updated for skynav_msgs package