Study on 2.5D Map Building and RGB-D Vision based Localization for Cooperative System with Multiple UAVs and UGV