Building an indoor routing system in 3D