Real-Time Mapping Using Stereoscopic Vision Optimization