This work is a collaboration with the Urban Robotics Lab (URL) at KAIST in South Korea (advisor: Prof. Hyun Myung) and 

the IPB group at the University of Bonn in Germany (advisor: Prof. Cyrill Stachniss)