Real-Time Dense Surface Mapping and Tracking