A Novel Method for Target Navigation and Mapping Based on Laser Ranging and MEMS/GPS Navigation

Figure 2

Transform between two orthogonal coordinate systems.