SkiMap++: Real-Time Mapping and Object Recognition for Robotics