Tracking building floors from 3D Model