Position and orientation of indoor mobile robots must be obtained real timely during operation in structured industrial environment, so as to ensure the security and efficiency of cargo transportation and assembly precision. But for such a large-scale space, only 2-D coordinates and heading angle of