3D Map Aided GNSS