Updated for skynav_msgs package, added object recognition (early version)