Novel geolocation technology for geophysical sensors for detection and discrimination of unexploded ordnance Dorota A. Grejner-Brzezinska1, Charles Toth1,2, Hongxing Sun1 and Xiankun Wang1 Satellite Positioning and Inertial Navigation (SPIN) Laboratory1 Center for Mapping2 The Ohio State University 470 Hitchcock Hall, Neil Av., Columbus OH, 43221 [email protected] Tel. 614-292-8787, Fax: 614-292-2957 Chris Rizos School of Surveying & Spatial Information Systems The University of New South Wales, Sydney, Australia [email protected] Tel: +61-2-93854205, Fax: +61-2-93137493 BIOGRAPHY Dr. Dorota Brzezinska is a Professor and leader of the Satellite Positioning and Inertial Navigation (SPIN) Laboratory at The Ohio State University. She received her MS and PhD in Geodetic Science from The Ohio State University. Her research interests cover kinematic positioning with GPS, precision orbit determination of GPS/LEO, INS/GPS/image/LiDAR integration, mobile mapping technology, and robust estimation techniques. Since 2003, she has served at the ION Council at various capacities, and is currently Eastern Region VicePresident; she is Vice-President of the International Association of Geodesy (IAG) Commission 4, Positioning and Applications and chair of IAG SubCommission 4.1, Multi-sensor Systems. She is the 2005 recipient of the US Geospatial Intelligence Foundation (USGIF) Academic Research Award and the 2005 ION Thurlow Award. She is a Fellow of the International Association of Geodesy. Dr. Charles Toth is a Senior Research Scientist at The Ohio State University Center for Mapping. He received an MS in Electrical Engineering and a PhD in Electrical Engineering and Geo-Information Sciences from the Technical University of Budapest, Hungary. His research expertise covers broad areas of 2D/3D signal processing, spatial information systems, high-resolution imaging, surface extraction, modeling, integrating and calibrating of multi-sensor systems, multi-sensor geospatial data acquisition systems, and mobile mapping technology. He is chair of ISPRS WG I/2 on LiDAR and InSAR Systems and serves as the Director for the Photogrammetric Application Division of ASPRS. Dr. Hongxing Sun is a post-doctoral researcher in the Satellite Positioning and Inertial Navigation (SPIN) Laboratory, The Ohio State University. He received a Bachelors degree in Geodesy, and MS and PhD degrees in Photogrammetry, from Wuhan University, P.R. China. His research interests include precise kinematic positioning with GPS, GPS/INS integration for direct platform orientation, and integrated multi-sensory geospatial data acquisition systems. Mr. Xiankun Wang is a PhD student and a Graduate Research Associate in the Satellite Positioning and Inertial Navigation (SPIN) Laboratory, The Ohio State University. He received a Bachelor’s degree in Geodesy from Wuhan University, P.R. China, and and MS degree in Geoinformatics from the International Institute for Geo-Information Science and Earth Observation (ITC), The Netherlands. His research interests include GPS/INS integration and terrestrial laser scanning applications. Prof. Chris Rizos is a graduate of The University of New South Wales (UNSW), Sydney, Australia; obtaining a PhD in Satellite Geodesy in 1980. Chris is currently the Head of the School of Surveying & Spatial Information Systems at UNSW. Chris has been researching the technology and applications of GPS since 1985, and established over a decade ago the Satellite Navigation and Positioning group at UNSW, today the largest and best known academic GPS and wireless location technology R&D laboratory in Australia. Chris is the Vice President of the International Association of Geodesy (IAG), a member of the Governing Board of the International GNSS Service, and a member of the IAG's Global Geodetic Observing System Steering Committee. Chris is a Fellow of the IAG and of the Australian Institute of Navigation. ABSTRACT Reliable and precise navigation technology is essential for robust detection and discrimination of unexploded ordnance (UXO) in a wide range of field conditions. The detection and remediation of munitions and explosives-ofconcern (MEC) on ranges, munitions burning and open detonation areas, and burial pits is one of the US Department of Defense’s (DoD) most pressing environmental problems. The MEC characterization and remediation activities using currently available technologies often yield unsatisfactory results, and are extremely expensive, due mainly to the inability of current technology to detect all MEC present at a site, and the inability to discriminate between MEC and nonhazardous items due mainly to insufficient accuracy of georeferencing of the geophysical images. As a result, most of the costs (90%) of MEC site remediation are currently spent on excavating targets that pose no threat. Thus, the goal of the research presented here, supported by a DoD’s Strategic Environmental Research and Development Program (SERDP) grant, is to design and demonstrate a high-accuracy hybrid navigation and georeferencing device based on multi-sensor integration, which can meet the stringent requirements of a manportable geophysical mapping system in open and impeded environments, and hence to lower the cost of remediation by improving the geolocation accuracy of MEC discrimination. This paper describes a hybrid system based on quadruple integration of GPS, inertial technology (IMU), pseudolites (PL) and terrestrial laser scanning (TLS) technology to improve the current geolocation capabilities at MEC sites. The concept design of the system, the algorithmic approach to sensor integration, with a special emphasis on TLS integration with GSP/IMU/PL, and the preliminary performance assessment based on simulations are presented. 1. INTRODUCTION: MOTIVATION BACKGROUND INFORMATION AND Many Formerly Used Defense Sites (FUDS), such as munitions burning and open detonation areas, and burial pits, thousands of acres in size, are still contaminated with unexploded ordnance (UXO). The detection and remediation of MEC sites is one of the Department of Defense’s (DoD) most pressing environmental problems. Assessment tools that can efficiently survey large tracts of land are required, and traditional ground-based survey procedures are often too inefficient and costly. There are aerial systems available, such as the Multi-sensor Towed Array Detection System (MTADS) for large-scale UXO geophysical surveys, which is an airborne version of a similar land-based system (http://www.nrl.navy.mil/pao/pressRelease.php?Y=2005 &R=17-05r). However, depending on the type and the scope of the terrain, the types and amounts of buried metal objects, airborne or land-based detection technologies must be applied. The focus here is on landbased man-portable UXO detection system. Geophysical mapping is the standard initial approach to investigating MEC sites and identifying potential MEC objects. In the standard practice, the first phase of geophysics work is “mag and flag”, with the objective of screening the entire site, and identifying some portions for further investigation (local interrogation). “Mag and flag” refers to the traditional way of finding UXO, where technicians walk survey lanes (transects) laid out in a field (see Figure 1), swinging a metal detector in front of them. The most commonly used detector for UXO is a magnetometer, hence the “mag”. However, this normally can result in thousands of points being flagged as potential MEC targets. Thus another step of local interrogation is needed to determine the type of buried object before the removal by excavation can be carried out. Since excavation is the most expensive part of the MES remediation process, it is naturally desirable to limit the excavation to only those objects that pose a thread to the public and the environment (compare an example illustrated in Figure 2, which shows the difference between the anomalies detected and identified as UXO). The second phase normally involves an electromagnetic (EM) survey of the site, to provide improved geophysical data, usually along transects with increased density, over the suspected target area. It is crucial that the images acquired by the EM survey provide sufficient information to detect all MEC present at a site and to discriminate between MEC and non-hazardous items, as well to identify a type of MEC/UXO. A complete process of remediation of MEC/UXO sites is accomplished through the following remedial activities: • MEC location and avoidance • MEC identification • MEC hazard assessment • Surface and subsurface MEC removal • MEC decontamination and destruction • Thermal and bioremediation of explosive contaminated soil = detected anomaly Suspected target area Site boundary Hiking trail Proposed school location Suspected firing point area = Non-MEC anomaly = MEC anomalies (rockets and fragments) = Practice Round (60mm mortar w/ spotting charge) Figure 1. Define boundaries of the target area and geophysical transect spacing based on historical data, such as, for example, Archive Search Report conducted by the Army Corps of Engineers as part of the historical records review process (http://www.epa.gov/fedfac/documents/brief_dod_091205 .ppt) MEC location, identification and hazard assessment are crucial steps before the actual removal, and the process of removal depends on several factors, and the type of MEC/UXO is one of them. Thus, it is clear that MEC/UXO identification, performed based on the geophysical information, is central to the entire remediation process, and the quality of EM imagery is the key factor here. The MEC hazard assessment determines the type of remediation activity. Numerous factors or functional relationships are considered in this assessment (http://www.epa.gov/fedfac/documents/brief_dod_091205 .ppt): • Severity: the potential severity of the result should an MEC item function. • Accessibility: the likelihood that a receptor will be able to interact with an MEC item. • Sensitivity: the likelihood that an MEC item will function should a receptor interact with it. Suspected target area Site boundary Hiking trail Proposed school location Suspected firing point area Figure 2. Detected anomalies after “mag and flag” step (top) and anomalies identified after refined geophysical mapping (bottom) (http://www.epa.gov/fedfac/documents/brief_do d_091205.ppt). The following are considered the major severity factors: filler type, distance to additional potential human receptors, proximity to critical infrastructure, proximity to cultural resources, and proximity to ecological resources. The input factors defining the accessibility are: site accessibility, potential contact hours, amount of MEC, and MEC depth relative to intrusive depth, migration potential. The input factors that determine the level of severity are: MEC category, and MEC size. All these factors have a specified numerical score ranging from 115 to 1000, and are summed up to arrive at the final MEC hazard assessment score (see, http://www.epa.gov/fedfac/documents/brief_dod_091205. ppt for details). Clearly, the entire process requires detailed information from historical sources and from precise and accurate geophysical surveys, where navigation, or EM sensor georegistration, are crucial, as the information about the amount, location and type of MEC/UXO is derived from the EM imagery. 1.1. Problem definition As reported by SERDP (2005), based on actual field experience, over 90 per cent of objects excavated during MEC site remediation are found to be non-hazardous items. In order to address this problem the Strategic Environmental Research and Development Program (SERDP)1 of DoD coordinates numerous efforts aimed at developing new and improved technologies to discriminate MEC from non-hazardous buried items. According to SERDP, “using current sensor technologies, the best hope for such discrimination lies in detailed spatial mapping of magnetic or electromagnetic signatures. Such investigation requires geolocation technologies that function at two levels. First, anomalous signals must be coarsely located so that they can be reacquired with a required absolute accuracy of tens of centimetres. Second, detailed mapping of signatures requires the measurement of the locations of individual sensor readings to a relative accuracy on the order of roughly 1 cm. By virtue of topography or vegetation, many sites are not amenable to Differential Global Positioning System (DGPS)” (SERDP, 2005). No navigation system currently available can meet the stringent navigation/positioning requirements as stated above. One possible solution, as presented in this paper, is to design a hybrid system based on several navigation and imaging technologies that offer either good absolute navigation accuracy or can support reliable relative navigation in a local frame. The level of integration and the capability of adapting the sensor and software configuration to specific deployment scenarios are the key characteristics of this approach. The range of navigation techniques applicable to this task includes satellite and terrestrial RF ranging systems, inertial navigation systems (INS) based on inertial measurement units (IMU), laser scanning systems, and 1 SERDP is the DoD’s environmental science and technology program, planned and executed in full partnership with the Department of Energy and the Environmental Protection Agency, with participation by numerous other federal and nonfederal organizations. To address the highest priority issues confronting the Army, Navy, Air Force, and Marines, SERDP focuses on cross-service requirements and pursues highrisk/high-payoff solutions to the Department’s most intractable environmental problems. The development and application of innovative environmental technologies support the long-term sustainability of DoD’s training and testing ranges as well as significantly reduce current and future environmental liabilities (http://www.serdp.org/) even electro-optical devices such as total stations. Each technology has its own limitations, which are expected to be balanced within the integrated system design, where complementary and often redundant characteristics of these sensor technologies become advantageous. Thus, the goal of the project described in this paper is to design, implement and test a high-accuracy hybrid navigation device that can address the stringent requirements of a man-portable geophysical mapping system, and is capable of maintaining high relative positioning accuracy in GPSchallenged environments. 2. SYSTEM DESIGN AND ARCHITECTURE The system design, as illustrated in Figures 3 and 4, is based on quadruple-integration of GPS (or more correctly Differential GPS, or DGPS), inertial technology, terrestrial RF system – pseudolite (PL), and terrestrial laser scanning (TLS) that collectively can support highaccuracy geolocation of geophysical sensors in a range of operating environments. The proposed design integrates PL and GPS range signals together with the INS and TLS measurements to deliver an optimal hybrid positioning solution in a tight integration mode using the Extended Kalman Filter (EKF) algorithms. Multi-sensor integration is mandatory to assure accuracy, continuity and integrity of the navigation solution. To facilitate high relative positioning accuracy in a local frame, in GPS-challenged environments, a novel integration approach is proposed that incorporates TLS technology. To achieve an environment-invariant performance of the TLS-based positioning subsystem, easily deployable spherical ground targets will be used. System GPS PL Advantage Absolute location Accurate position/velocity Absolute location Works well in confined environment (function of geometric configuration) Self-contained system INS TLS Accurate position Accurate attitude Disadvantage Line-of-sight system Line-of-sight system Relative position Position drifts with time Relative position Table 1. Rationale for sensor integration, based on complementary characteristics of the technologies. Base GPS Receiver PL Transmitter GPS Receiver Rover GPS Receiver that will be suitable for specific deployment scenarios taking into account constraints on weight and power, operational time lines, and economic factors. Base GPS Rover GPS PL antenna Rover PL Receiver IMU Sensors Tightly Coupled GPS/INS/PL/TLS Extended Kalman Filter Rover PL Delta V Delta Position, Velocity, Attitude Estimates Strapdown Navigation Solution GPS antenna Top view of an UXO sensor pushcart Laser scanner GPS/INS/PL laptop Mounting pole Laser scanner laptop UXO/MEC detection sensor control console INS sensor TLS System Distance measured Relative orientation Figure 3. GPS/INS/PL/TLS integration: system design. The three-tier positioning concept is hierarchical, with several levels of positioning or sensor geolocation (see also Figure 5): 1. Absolute positioning in a global reference system (WGS-84), applicable to open-sky areas, achieved primarily using DGPS/INS integration. 2. Relative medium-range positioning (with the connection to global reference system preserved) under canopies or other obstructions. The connection to WGS-84 (or another selected mapping frame) is accomplished be means of PL/INS technology, i.e., PL will substitute for GPS signals for medium to long transmitter/receiver distances. 3. Relative short-range positioning in a local frame (with the connection to global reference system preserved). This mode supports the detailed mapping of geophysical signatures, where GPS is not available, and where extremely high relative positioning accuracy is required, which can be facilitated by TLS technology supported by ground-based deployable targets. Since the laser scanner reference frame is connected to the GPS/INS/PL reference system via lever arm and boresight angles, estimated by the system calibration process, the absolute positioning capability will be maintained. The accuracy of the absolute coordinates may vary, and is a function of the quality of the last acceptable GPS or PL-based solution, while the relative positioning accuracy in the local frame is expected to be at the few cm-level. Currently a full-blown hardware and software prototype configuration is being implemented, as shown in Figures 3 and 4. The future field tests and the expected software and hardware tuning and optimization process will render (or help define) the sub-categories of the implementation Laptop (2) Console Cargo area to store laser targets Geophysical sensor system Side view of an UXO/MEC sensor pushcart Figure 4. Sensor configuration for geophysical mapping of MEC sites. GPS satellites Tethered balloon with GPS receiver and PL transmitter PL transmitter UXO sensor pushcart Laser target Relative medium-range positioning Relative short-range positioning Absolute positioning Figure 5. Three-tier MEC site survey concept. 2.1. Navigation and imaging technologies used With the maturity of processing algorithms and availability of commercial GPS/INS integrated systems, their use in civilian mapping applications as georeferencing tools for imaging sensors is steadily growing, and extensive literature on this subject exists (e.g., Abdullah, 1997; El-Sheimy and Schwarz, 1999; Grejner-Brzezinska and Toth, 1998; Grejner-Brzezinska, 1999; Grejner-Brzezinska, 2001a and b; GrejnerBrzezinska et al., 2005; Mostafa et al., 2000; Skaloud, 2002; Toth, 2002; Toth and Grejner-Brzezinska, 1998; Yi et al., 2005). However, the navigation solution accuracy provided by GPS/INS strongly depends on the quality and geometry of GPS observations, as well as the type of IMU used and the integration model applied. Generally, under no or limited GPS availability, the navigation accuracy that satisfies the requirements of sensor geolocation can only be maintained for a few minutes if a navigationgrade IMU is used. Longer GPS gaps lead to a loss of reliable geolocation information. Thus, alternative sensors, such as PLs (e.g., LeMaster and Rock, 1999; Dai et al., 2001; Grejner-Brzezinska and Yi, 2003; Barnes et al., 2003a, b, 2005 and 2006), or imaging – optical or laserbased – systems (e.g., Veth and Raquet, 2006) must be deployed to assure continuity of navigation solution. • cm to dm-level positioning accuracy in static or kinematic modes • Single- and dual-frequency systems available • Self-contained time-synchronized constellations (such as Locata system used here) or asynchronous PL networks. The example commercial systems currently available are the Terralite XPS technology from Novariant Inc. (http://www.novariant.com/resources/technologies/positio ning_infrastructure.cfm) and the LocataNet system from Locata Inc. (http://www.locatacorp.com/). 2.1.1. Pseudolite technology Pseudolites are ground-based radio navigation devices, which are designed to support positioning and navigation in situations where the GNSS (Global Satellite Navigation System) constellation may be insufficient or unavailable (e.g., indoor, urban or confined environments). PLs can be configured to emit GPS-like signals for enhancing the GPS by providing increased accuracy, integrity, and availability, or to serve as independent navigation system using non-GPS frequency signals. Accuracy improvement due to PL signals, if combined with GPS, can occur because of better local geometry, as measured by a lower vertical dilution of precision (VDOP). Since the 1970s, when the PLs were first used for testing the concept design of the GPS system, their field of applications has expanded considerably, even though their use is still limited. The application markets that pseudolites are able to serve range from construction monitoring, machine control and open pit mining, and indoor and urban navigation, through Location Based Services (LBS), enhancement of the Space Based Augmentation System (SBAS) supporting, for example, aircraft landing or harbour entry and operations, to future applications in Mars navigation (see, for example, Klein and Parkinson, 1986; Raquet et al., 1996; Elrod et al., 1996; LeMaster et al., 2003; Montefusco et al., 2005; Progri et al., 2006; Barnes et al., 2007). The primary characteristics of the currently available PL technology are: • Line-of-sight (subject to signal blockage) • Used as augmentation to GPS or an autonomous constellation at o GPS frequency, or o Non-GPS frequency • Typical signal range 3-5 km (depending on transmitter power) • mm to cm-level ranging accuracy achievable Transmitting antennae Solar panels Figure 6. Typical mount of a Locata transmitting antennae with solar panels, Locata Test Facility, Numarella, NSW. The PL technology, used in this project, is based on LocataNet (e.g., Barnes et al., 2003a and b, and 2005), a network of dual-frequency self-synchronized groundbased transmitters (LocataLites) designed to cover a survey area with ranging signals of continuous coverage (Figures 6-7). These ranging signals transmit in the license-free 2.4GHz Industry Scientific and Medical (ISM) band. The LocataLite hardware design uses stateof-the-art field programmable gate array (FPGA) devices. They provide configurable logic, on-chip memory and digital signal processing (DSP) capabilities. For signal spatial diversity, one LocataLite can be connected to two transmit antennas, allowing for transmission of two signals with different PRN codes at the same frequency. A Locata receiver uses four or more ranging signals to different LocataLites to compute a high-accuracy position entirely independent of GPS. The Locata positioning technology has been designed with four key objectives: availability in most nvironments, high-reliability, highaccuracy, and cost effectiveness. Essentially, Locata allows complete control over a ground-based PL constellation, leading to an optimal positioning geometry and consistent cm-level positioning accuracy. An important feature of the Locata positioning signals is that they are time-synchronized, which allows single-point positioning similar to pseudorange-based GPS. However, unlike GPS, the sub-cm level of synchronization between LocataLites allows single-point positioning with GPSRTK (real time kinematic) level of accuracy without the use of a reference station and data link. In addition, Locata signal strength of up to 1 Watt is significantly higher than the GPS signals, and thus offers better foliage penetration within the range of a few to tens of kilometers. (It should be noted that in stand-alone mode, Locata may suffer from poor height accuracy if there is little variation in elevation angle between the terrestrial transmitters and receivers.) It should be mentioned that in operational environements the coordinates of the LocataLite antennae are normally surveyed using GPS and total station equipment to provide WGS-84 Earth Centered Earth Fixed (ECEF) coordinates. Transmitting antennae Figure 7. Locata transmitting antennas mounted on 15 m mast to provide sufficient vertical geometry for a 3D solution within a few tens of meters of the mast (e.g., at ~30 from the mast, VDOP is ~4), Locata Test Facility, Numarella, NSW. The following are the operational steps required for Locata and GPS systems to work together in real time (Barnes et al., 2006): • GPS initialization – GPS RTK ambiguity resolution; typically takes less than 1 minute with good satellite geometry and tracking on at least 5 satellites. • Locata initialization – the GPS position and lever arm offsets with respect to Locata receiving antenna are input to the corresponding Locata receiver. The Locata receiver applies the lever correction to convert the input GPS position to the Locata receiver phase center. This derived position is used to initialize the Locata direct carrier range (DCR) positioning algorithm. • GPS/Locata solution – once both GPS and Locata solutions have been initialized, a cm-level position solution is provided. Time synchronization between Locata and GPS time systems is required for a combined solution. • Locata-only solution – if at any time the GPS solution fails to meet the accuracy specification due to poor satellite geometry, satellite availability, failure to resolve ambiguities or wireless data link failure, the Locata receivers continue to deliver cmlevel positioning solution. Note that once the Locata receiver position has been initialized, it operates independently of GPS, and requires re-initialization only if the number of LocataLite signals drops below four (for 3D positioning). However, with dual transmit LocataLites, providing signal spatial diversity (see Figure 7), and careful LocataNet design, the need for re-initialization is minimized. 2.1.2. Terrestrial laser scanning (TLS) The ability of terrestrial laser scanner technology to capture large amounts of spatial data quickly, accurately and automatically makes it an important tool for spatial data and surface geometry acquisition, even for complex surfaces and environments often inaccessible by classical survey techniques. TLS consists of an instrument for measuring distance (laser) and a scanner. The focused laser beam is directly reflected off the surveyed surface, obviating the need to use prism reflectors. Generally 3D environments are captured faster with TLS, as compared to alternative techniques, with the accuracy ranging from sub-millimeter on small object scans to 25 mm on objects at distances up to 250 m (http://www.ceg.ncl.ac.uk/heritage3d/downloads/TSALaser-Scan.pdf). The output from a TLS system is a 3D point cloud (X, Y, Z coordinates in a local TLS frame that can be converted to a selected mapping frame, in which the TLS location coordinates and orientation are defined). TLS is normally placed at a site with known coordinates, or GPS/INS can be used for direct geolocation if the system is located on a moving platform. However, an inverse problem can be defined, that is, if the TLS’s location is unknown, it can be resected from the scanned objects with known locations, or, if the absolute coordinates of the scanned objects are not identified, the objects’ coordinates defined in some local frame (or TLS frame) can be used to determine a change in the TLS location coordinates. This is possible by matching the multi-site scans so as to determine the coordinate transformation parameters between the sites. Thus, TLS can be used as a navigation device to navigate either in a global (absolute) reference frame or in a local frame, in a relative mode. This application mode of TLS is utilized in the hybrid navigation system discussed here. An added benefit of using laser technology is that it is an active sensor, and therefore there is no dependency on ambient lighting conditions that may vary significantly in vegetated areas. The primary characteristics of the TLS technology are: • Rapidly advancing surface measurement technology • Existing implementations o Pulsed scanner (Time-of-Flight, TOF) o Continuous waveform scanner (Phase) o Flash LADAR2 or 3D camera • Primary specifications o Large number of range measurements (5-200K points/s) o mm-level ranging accuracy o Dense spatial sampling (0.01° angular sampling rate) o Excellent point cloud relative accuracy (3D) o Sensitive to moving objects (scanning) • Large variety of analytical surface modeling techniques (scan data analysis software) • Surface/patch matching technique can be used to detect change in TLS location that can be used to support navigation o Similarity transformation (7-parameter) between two surfaces at locations T1 and T2 in Figure 7 o Feedback to navigation system Examples of the currently available TLS technology are Cyrax 2500 from Cyra Technologies/Leica Geosystems, Optech's ILRIS Intelligent Laser Ranging and Imaging Systems, and Trimble GX terrestrial laser scanner used in the system described here. A broad list of TLS technology references can be found at http://www.itc.nl/isprswgiii3/resources_links.html#TerrestrialScanners. Cyrax 2500, considered one of the most commonly used terrestrial scanning systems, offers a single-point range accuracy of ± 4 mm, angular accuracies of ± 60 μrad, and a beam spot size of only 6 mm over a 0-50 m range. Its 360° by 195° pan and tilt mount and dual internal rotating mirrors enable it to be deployed in virtually any 2 Laser Distance Array (LADAR) orientation (http://www.meabmx.se/tidning/cyrax2500.htm). The point density is dependent on the object distance, with a 100 pts/m2 density typical at about 20 m ranges. Optech’s ILRIS includes an on-board high resolution digital camera. It offers scanning ranges from 3 m to <1,500 m with the range accuracy of 3 mm and spot spacing of 2.6 mm at 100 m range distance, and data sampling rate of 2,000 points/s (http://www.optech.ca/i3dhome.htm). Trimble’s GX terrestrial laser scanner offers a standard range of up to 200 m and in the ‘overscan’ mode, up to 350 m. The field of view is limited by 360° × 60°, with an asymmetrical vertical part of about 40° above the horizon. The scanning speed is up to 5,000 points per second. The scanner uses an auto focus technique, which guarantees a constant small laser spot even at different distances within a scan. The size varies from 0.3 mm at 5 m, up to 1.5 mm at a distance of 25 m. xL T1 xL xL T2 yL yL yL zL zL zL E A D B C Figure 7. TLS-based navigation concept based on spherical target surface matching at two locations of the TLS, T1 and T2. Targets are denoted as A-E, the reference system XLYLZL is centered at the TLS system and changes its location and orientation between consecutive locations of TLS. 2.2. System design and implementation The system architecture, illustrated in Figure 11, represents an extension and re-design of the original OSU GPS/IMU integrated system, AIMS™ (e.g., GrejnerBrzezinska and Toth, 1998; Grejner-Brzezinska, 1999). The novel quadruple integration of GPS (GNSS), PL and inertial technologies, augmented by TLS, replace the tight GPS/IMU integration module of AIMS™. The following are the primary characteristics of the new AIMS-PRO™ system and software design: • • • • • • • • Handles various IMU classes, from navigationthrough tactical to consumer-grade sensors Loose and tight integration modes (tight mode illustrated in Figure 11) o Ultra-tight considered (currently, optional) Implements feedback from imaging module to implement terrain-referenced navigation in GPSchallenged environments o TLS with specialized targets for highest navigation accuracy o Airborne laser scanning (ALS) o Multiple image overlap based relative orientation from optical imagery, DEM/GIS, etc. Multiple approaches to GPS solution (in loose integration mode) o Single baseline differential kinematic solution o Network-based differential kinematic solution o Precise point positioning technique (PPP) Post-processed and real-time capable Improved portability (less platform-dependence) Flexible design Improved error diagnostics capabilities Figure 8. Screenshot of AIMS-PRO™ interface: data input. Figure 9. Snapshot of AIMS-PRO interface: KF parameter setting. Figures 8-10 are examples of the AIMS-PRO™ interface design. The input interface is designed for handling a variety of input data types, including initial location and orientation parameters (Figure 8). The data processing interface handles all configuration and control parameters defining the data processing modes. For example, the initial parameter settings for EKF allow for selection of the sensor models suitable for a particular class of sensors or a specific IMU (Figure 9). GNSS processing parameters, error tolerances, ambiguity resolution parameters, etc., are also defined through this interface (Figure 10). Figure 10. Screenshot of AIMS-PRO™ interface: configuration and control parameters. GPS raw measurement Locata carrier phase pseudorange IMU angular rate and specific force Ambiguity resolution Initial carrier phase bias resolution INS navigation GPS double-differenced carrier phase and/or pseudorange Carrier phase range Position, velocity, and attitude Kalman filtering INS error estimates ALS/TLS measurements Imaging system Feedback from observed position and attitude data Spherical target/DEM extraction Feature extraction Spherical target parameters Spherical target/DEM matching Feature parameters Feature matching Combining TLS and image info Figure 11. AIMS-PRO™ design architecture. 2.3. TLS-based navigation: the concept In the concept of a multi-sensor geolocation system presented here, TLS is used to support navigation in wooded areas, where GPS may not be available, and the PL network may be subject to increased multipath and partial signal blockage. High-accuracy reference surfaces measured by TLS can be matched to sub-cm accuracy to detect relative motion of the platform carrying the MEC/UXO (or EM) sensor assembly. Using a rigorous least squares 3D surface matching, complex surfaces can be matched at the level of the ranging accuracy (see, for example, Gruen and Akca, 2005). The accuracy of matching is measured in terms of the accuracy of the relative orientation parameter estimates, including position and attitude data (3+3). To assure good quality matching results, multiple spherical targets are used within the survey area. The targets are portable, easily deployable on vertical poles or placed on the ground, and provide surface control to connect the scans performed at different platform positions. The range determined between the center of the target and TLS is used to find the coordinates of TLS by resection or partial resection (in 2D), as shown in Figure 3. The spherical targets can be described with four parameters: three coordinates of the center of the sphere and its radius (known); thus, in theory, a sphere can be determined from three laser points reflected from its surface. Considering the random ranging errors, more points are needed to assure both the robustness of the estimation and the accuracy of surface matching, and estimation of the centers of the spheres by the least squares adjustment method. 2.3.1. Determination of the spherical target coordinates Determination of the spherical target centers from TLS point cloud includes the following three steps. 1. Look up table (LUT) indexing: indexing TLS point cloud with a Look Up Table (LUT) is a simple, yet efficient method for TLS data processing. The basic idea of LUT indexing is establishing a link between laser points and a two-dimensional array through azimuth and vertical angles of the points. Thus, a point can be directly accessed through the memory address stored in LUT without having to search the whole dataset. More importantly, LUT arranges the randomly distributed data into order by indexing points in space with the neighboring cells in the table; clearly, it benefits the sphere point classification algorithm. 2. Sphere point classification: two algorithms have been developed for sphere point classification, (1) shortest-range algorithm, and (2) region growing algorithm. The shortest-range algorithm is based on finding the shortest range (distance) from the scanner to the surface of the spherical target within a search window, and selecting points with ranges within the threshold defining the shortest range ( Δs ≤ s − 2rs − s , where s is the range and r is the sphere’s radius). Next, the least squares fitting algorithm is applied to determine the approximate center candidate from the selected points on the sphere, as described in the next section. The region growing algorithm is based on segmentation of the points within the search window into different groups (objects), and subsequently performing the fitting of the points from each group onto the sphere. Based on the simulations performed to date, the region growing algorithm was found to perform slightly better, particularly in case of occlusions and noisy data. See Grejner-Brzezinska et al. (2008) for the results of using shortest-range algorithm for spherical target center determination. 2 Both sphere point classification algorithms are followed by a sphere center refinement procedure to assure inclusion of the maximum number of genuine sphere points into the sphere center estimation process. Since there is a certain overlap between search windows, two neighboring windows which cover the same sphere region will generate two approximate sphere centers. During the refinement step, the distances between the sphere center candidates are checked against a predefined threshold (0.05m in tests presented here); if the condition is met, the coordinates from these candidate solutions are averaged. Moreover, after finding the shortest range, s, by means of the averaged sphere center coordinates, the search window width, D, can be D= 2r s 2 + 2rs s+r determined as , to search the entire range of sphere points, to assure that the maximum number of sphere points is properly discriminated. the approximate sphere center coordinates can be computed. Generally, the fitting process converges within a few iterations with data having range noise of up to 2 cm. 2.3.2. TLS-based resection problem In the actual application, if a geophysical signal is detected during the traversing of an MEC site, the highresolution/accuracy local survey may be needed for cued interrogation. In this case 6-10 spherical targets are placed around the border of a local area of about 10-20 m by 1020 m (Figure 12). A near uniform distribution of the targets is desirable, but for operational purposes, depending on the terrain structure and the surrounding environment, some flexibility of the target distribution is allowed (the geometric configuration as well as the vertical distribution of these targets is currently the subject of ongoing simulation studies). It is important to note that there is no need to position the targets, and the only requirement is that they should not be moved during the local survey. x p = xC + s ⋅ cos β sin α y p = yC + s ⋅ cos β cos α (2) z p = z C + s ⋅ sin β The TLS range measurements are best described in a polar coordinate system centered at TLS, and the coordinates of a measured point in the mapping frame can be calculated using Eq. (2), where x p , y p , z p and ( ) ( xC , yC , zC ) are the vectors of coordinates of a measured point and the laser scanner, respectively, in the mapping frame, s is the distance from the laser scanner to the target, α is the azimuth, and β denotes the vertical angle. D 3. E Least squares fitting: assume that the approximate sphere center is ( x0, y0 , z0 ) the ith measured sphere point is ( xi , yi , zi ) , r is the sphere radius (known and 3 C constant). Then: 2 ( x 0 − x i )2 + ( y 0 − y i )2 + ( z 0 − z i )2 = r 2 r x2,1 F (1) After linearization, the residual of the ith “observed” radius can be denoted as: 1 B r x A,2 r xA,1 Spherical targets Scanning Sites Scanning lines Vri = (x0 − xi ) ri δx + ( y0 − yi ) ri δy + (z 0 − z i ) ri δz + r − ri (2) where (δx, δy, δz ) denote coordinate corrections to the approximated sphere center coordinates, and ri denotes the radius to the approximate sphere center. By employing the least squares adjustment, the corrections to A Track System’s path Figure 12. The spatial (3D) or partial resection (2D) concept using TLS ranges and spherical targets (Grejner-Brzezinska et al., 2008). As explained above, the coordinates of the centers of the spherical targets (points A-F in Figure 12), relative to the TLS coordinate system, can be calculated from the coordinates of the point cloud on the target’s surface. To simplify the computations, a local coordinate system is introduced, with the origin at site 1 (Figure 12). The spatial relationship between the two consecutive TLS locations, 1 and 2, with respect to target A, can be described by a rigid body transformation, including three offsets and three rotation angles (Eq. (3): r r b1 r x Ab1,1 = x2,1 + Rbb21 x Ab ,22 (3) rb2 where x A,2 is the translation vector from site 2 to point A r b1 in the local TLS coordinate system of site 2, x2,1 is the translation vector from site 1 to site 2 in the local TLS r b1 coordinate system of site 1, x A,1 is the coordinate vector from point 1 to site A in the local TLS coordinate system of site 1, Rbb21 is the rotation matrix from the local TLS coordinate system of site 2 to that of site 1. For multiple points, Eq. (3) can be expressed in a matrix form: b1 X Pb1,1 = X 2,1 + Rbb21 X Pb 2,2 (4) where P denotes all common targets measured at sites 1 and 2. In Eq. (4) there are six unknown parameters: the b1 three translation parameters in X 2,1 , and three Euler angle parameters in Rbb21 . To derive a more convenient expression, Eq. (4) is multiplied by the rotation matrix, Rbn1 , from TLS coordinate system of site 1 to the navigation coordinate system; then, the coordinate transformation, expressed in the navigation coordinate system, is given by: n Rbn1 X Pb1,1 = X 2,1 + Rbn2 X Pb 2,2 (5) Adding the coordinates of site 1 in the navigation frame to n , both sides of Eq. (5), considering that X 2n = X 1n + X 2,1 gives: X 1n + Rbn1 X Pb1,1 = X 2n + Rbn2 X Pb 2,2 (6) Eq. (6) can be linearized assuming small angular differences in the rotation matrix: X 1n + Rbn1 X Pb1,1 = X 2n 0 − δ X 2n + ( I − E ) Rbn2 0 X Pb 2,2 (7) where I is the identity matrix, E is the skew-symmetric matrix of the attitude angle error, and δ X 2n is the coordinate error vector. Rearranging Eq. (7) provides the final positioning and attitude determination equation that is fed directly to the Kalman filter (Eq. 8). Note that it contains information that can be used to calibrate IMU errors. X 1n + Rbn1 X Pb1,1 − X 2n 0 − Rbn2 0 X Pb 2,2 = −δ X 2n + X Pn ,2 0ε where ε is the attitude angle error vector, and X (8) n 0 P ,2 is the skew-symmetric matrix of the coordinate vector. Note that the relative accuracy provided by Eq. (8) might be high, but the resulting navigation accuracy depends on the accuracy of the position and attitude of site 1, which is assumed to be determined by the integrated DGPS/PL/INS. 3. TLS-BASED NAVIGATION: SIMULATIONS TLS point cloud data was simulated and a simple algorithm for the determination of the center of a spherical target was developed. The point cloud data set was generated based on the actual scanning pattern of a terrestrial laser scanner. One of the simulated scenarios is a flat ground with an area of 4 m × 4 m, with one side surrounded by a 3-meter high wall, and two spherical targets, with radii of 0.20 m, placed on the ground with center coordinates of (1.0, 3.5, 0.2) and (3.0, 3.0, 0.2), as shown in Figure 13. The effect of two columns, located 0.15 m and 0.20 m, in front of the spheres were also simulated in this scenario, so that most of sphere 1 centered at (1.0, 3.5, 0.2) is occluded, and sphere 2 centered at (3.0, 3.0, 0.2) is partially occluded by both columns (Figure 13). The laser scanner was located at (0.5, 0.5, 2.0); the assumed vertical angle for scanning ranges was within ±75° and scan angle resolution of 0.5° was assumed in both vertical and horizontal directions. There were 33 data points simulated on sphere 1, and 42 data points on sphere 2. A random noise of 1 cm has been added to each coordinate component. The region growing algorithm, using a 16×16 (that is 16 times the scanning angle resolution) search window and 9 cm distance threshold for the neighboring cells, was used, followed by the least squares fitting, to determine the coordinates of the sphere centers from the distorted point cloud data. The results are discussed below. The coarse (approximated) and the final center coordinates of the spheres were estimated, as shown in Table 2. For the coarse result, the center coordinates of sphere 1 were determined twice due to the 50% overlap between the neighboring search windows. In the case of sphere 2, only points on the right side of the sphere contributed to the estimation of its center, since the left side was segmented to different point groups, with a fitting error of 0.011 (that is 10% higher than the selected tolerance level for the fitting algorithm, which was equal to 1 cm), and thus, it was not selected as the center candidate. Apart from the correct candidates, there are four false sphere centers fitted from the segmented points. It was found that all the false sphere centers were generated from points at locations with extreme vertical angles. After the refinement procedure, these false center candidates were removed and the accuracy of sphere 2 was improved, but the position accuracy of sphere 1 remained unchanged. Note that the success rate is defined as percent of points properly identified on the sphere, based on the comparison of the known reference coordinates of each simulated target and the coordinates determined by the algorithm described here. Occluding columns Points on partially occluded spherical targets implemented in the tightly-coupled mode under the EKF architecture, PL module under design and implementation, and the TLS module implemented and undergoing extensive simulation testing. The preliminary results of the estimation of the coordinates of the spherical target center, crucial to the concept of TLS-based navigation, proved to be of good accuracy, even for a relatively high noise of 2 cm in the simulated point cloud coordinates, and under partial target occlusions. Obviously, the success rate of identifying the sphere points decreases with the growing data noise and percentage of occlusions. More tests and simulations are currently under way. Acknowledgement: This research is supported at OSU by the 2007 SERDP grant. The research into Locata technology at UNSW is supported by an Australian Research Council Discovery grant. REFERENCES 1. TLS location Figure 13. Simulated TLS data set with occlusions and 1cm noise within the region covered by one search window. Another data set was simulated with eight spherical targets each with radius 0.20 m, distributed on flat ground over an area of 30×30 m2, and distances to the laser scanner ranging from 2.7 m to 28.3 m. The estimated position coordinates of the target spheres and the laser scanner are listed in Table 3. With the 16×16 search window and the distance threshold of 12 cm, and the minimum point number for the least squares fitting set at six, all spheres were extracted with the region growing algorithm, as shown in Table 4. It was determined that all spheres could be uniquely determined with the distance threshold ranging from 9 cm to 20 cm. Similar results were found using the shortest-range algorithm. Next, 2 cm noise was added to all target center coordinates, and the process was repeated, with the distance threshold of 12 cm and the minimum point number for the least squares fitting of 14. The results are listed in Table 5. Notice that sphere 2 is missing in this case. When the minimum point number for sphere fitting was lowered to seven or less, sphere 2 could be extracted, but some false sphere centers were also derived from the ground points. 2. 3. 4. 5. 6. 4. CONCLUSIONS This paper describes a concept design of quadruple integration of GPS/INS/PL and TLS, used here as a navigation-supporting sensor. The system is currently under implementation, with GPS/INS modules already 7. Abdullah, Q., (1997). Evaluation of GPS-Inertial Navigation System for airborne photogrammetry, presented at 1997 ACSM/ASPRS Annual Convention and Exposition, 7-10 April, Seattle, WA. Barnes, J., Rizos, C., Wang, J., Small, D., Voigt, G., & Gambale, N. (2003a). Locata: A new positioning technology for high precision indoor and outdoor positioning, 16th Int. Tech. Meeting of the Sat Div of the U.S. Inst. of Navigation, Portland, OR, 9-12 September, 1119-1128. Barnes, J., Rizos, C., Wang, J., Small, D., Voigt, G., & Gambale, N. (2003b). High precision indoor and outdoor positioning using LocataNet, 2003 Int. Symp. on GPS/GNSS, Tokyo, Japan, 15-18 November, 9-18, CD ROM. Barnes, J., Rizos, C., Kanli, M., Pahwa, A., Small, D., Voigt, G., Gambale, N., & Lamance, J., (2005). High accuracy positioning using Locata’s next generation technology, 18th Int. Tech. Meeting of the Sat. Div. of the Institute of Navigation, Long Beach, CA, 1316 Sept, 2049-2056. Barnes, J., Rizos, C., Kanli, M., Pahwa, A. (2006). A solution to tough GNSS land applications using terrestrial-based transceivers (LocataLites), Symposium on GPS/GNSS (IGNSS2006), Surfers Paradise, Australia, 17-21 July, CD-ROM. Barnes, J., Lamance, J., Lilly, B., Rogers, I., Nix, M., Balls, A. (2007). An integrated Locata & Leica Geosystems positioning system for open-cut mining applications, Proceedings, 20th Int. Tech. Meeting of the Sat. Div. of the Institute of Navigation, September 25-28, Fort Worth, TX, 1661-1668. Dai, L., Rizos, C., Wang, J. (2001). The role of pseudo-satellite signals in precise GPS-based positioning, Journal of Geospatial Eng., HK Inst. of Engineering Surveyors, 3(1), 33-44. 8. 9. 10. 11. 12. 13. 14. 15. 16. 17. 18. 19. 20. 21. Elrod, B., Barltrop, K., Stafford, J., Brown, D. (1996). Test results of local area augmentation with an inband pseudolite, Proceedings, ION NTM, Santa Monica, CA, 22-24 January, 145-154. El-Sheimy, N., Schwarz, K.P., (1999). Navigating urban areas by VISAT – A Mobile Mapping System integrating GPS/INS/Digital Cameras for GIS application, Navigation, 45(4), 275-286. Grejner-Brzezinska, D.A., Da, R., Toth C., (1998). GPS error modeling and OTF ambiguity resolution for high-accuracy GPS/INS integrated system, J. of Geodesy, 72(11), 628-638. Grejner-Brzezinska, D.A. (1999). Direct exterior orientation of airborne imagery with GPS/INS system: Performance analysis, Navigation, 46(4), 261-270. Grejner-Brzezinska, D.A. (2001a). Mobile Mapping Technology: Ten years later, Part I, Surveying and Land Information Systems, 61(2), 79-94. Grejner-Brzezinska, D.A. (2001b). Mobile Mapping Technology: Ten years later, Part II, Surveying and Land Information Systems, 61(3), 83-100. Grejner-Brzezinska, D.A., Yi, Y. (2003). Experimental GPS/INS/Pseudolite system for kinematic positioning, Survey Review, 37(288), 113126. Grejner-Brzezinska, D.A., Toth, C., Yi, Y. (2005). On improving navigation accuracy of GPS/INS systems, Photogrammetirc Engineering & Remote Sensing, April 2005, 71(4), 377-389. Grejner-Brzezinska, D.A., Toth, C., Sun, H., Wang, X., Rizos, C. (2008). GPS/INS/PL/TLS integration supporting navigation of geophysical sensors for unexploded ordnance detection and discrimination, 13th FIG International Symposium on Deformation Measurements and Analysis, 4th IAG Symposium on Geodesy for Geotechnical and Structural Engineering, 12-15 May, Lisbon, Portugal, CD ROM. Gruen, A., Akca, D. (2005). Least squares 3D surface matching, ASPRS 2005 Annual Conference, Baltimore, MD, 7-11 March, CD ROM. Klein, D., Parkinson, B.W. (1986). The use of pseudo-satellites for improving GPS performance, Global Positioning System, Vol. III, Institute of Navigation, Washington, DC. LeMaster, E.A., Matsuoka, M.,. Rock, S.M. (2003). Mars navigation system utilizes GPS, IEEE Aerospace and Electronics Systems Magazine, 18(4), April 2003, 3-8. LeMaster, E.A., Rock, S.M. (1999). Mars exploration using self-calibrating pseudolite arrays. ION GPS1999, Nashville, TN, 14-17 September, 1549-1558. Montefusco, C., Ventura-Traveset, J., LucasRodriguez, R., Toran, F., Jofre, M. (2005). Enhancing SBAS performance: the EGNOS pseudolite concept (http://www.egnospro.esa.int/Publications/EGNOS%20pseudolite%20E 22. 23. 24. 25. 26. 27. 28. 29. 30. NC%202005_final.pdf, last accessed on April 3, 2008). Mostafa, M., Hutton, J., Lithopoulos, E. (2000). Ground accuracy from directly georeferenced imagery, GIM International, 14(12), 38-41. SERDP, Strategic Environmental Research and Development Program (2005). SON NUMBER: MMSON-07-01, 10 November 2005. Progri, I.F., Maynard, J., Michalson, W.R., Wang, J. (2006). The performance and simulation of a CCDMA pseudolite indoor geolocation system, 19th Int. Tech. Meeting of the Sat. Div. of the Institute of Navigation, Fort Worth, TX, 26-29 September, 24652477. Raquet, J., Lachapelle, G., Qiu,, W., Pelletier, C., Nash, T., Fenton, P., Holden, T. (1995). Development and testing of a mobile pseudolite concept for precise positioning, 8th Int. Tech. Meeting of the Sat. Div. of the Institute of Navigation, Palm Springs, CA, 12-15 September, 817-826. Skaloud, J., (2002). Direct georeferencing in aerial photogrammetric mapping, Photogrammetric Engineering & Remote Sensing, March 2002, 207210. Toth, C., Grejner-Brzezinska, D.A. (1998). Performance analysis of the Airborne Integrated Mapping System (AIMS™), ISPRS Commission II Symposium on Data Integration: Systems and Techniques, International Archives of Photogrammetry and Remote Sensing, Vol. XXXII, Part 2, 320-326. Toth, C. (2002). Sensor integration in airborne mapping, IEEE Transactions on Instrumentation and Measurement, 51(6), 1367-1373. Veth, M., Raquet, J. (2006). Fusion of low-cost imaging and inertial sensors for navigation, 19th Int. Tech. Meeting of the Sat. Div. of the Institute of Navigation, Fort Worth, TX, 26-29 September, 10931103. Yi, Y., Grejner-Brzezinska, D.A., Toth, C. (2005). Performance analysis of a low cost MEMS IMU and GPS integration, ION Annual Meeting, 26-29 June, 1026-1036. Coarse Result Final result True value x (m) y (m) z (m) Pos. Err (mm) σ̂ 0 0.999 0.997 3.003 2.695 1.345 0.031 0.042 0.997 3.003 1.0 3.0 3.501 3.503 3.000 2.732 0.050 0.034 0.962 3.503 3.000 3.5 3.0 0.195 0.193 0.201 2.682 -0.194 0.198 0.198 0.193 0.199 0.2 0.2 4.9 8.0 3.4 0.009 0.009 0.004 0.008 0.010 0.008 0.009 0.009 0.008 8.0 3.5 Estimated points Sphere 1 Sphere 2 21 22 0 0 0 0 0 22 0 33 Other 0 0 16 0 0 0 0 0 33 0 0 0 15 41 33 45 0 0 Success Rate 63.6% 66.7% 38.1% false false false false 66.7% 71.4% 42 Table 2. Comparison between the estimated sphere centers and the reference sphere center coordinates; simulated data with 1 cm noise. Laser Scanner Sphere 1 Sphere 2 Sphere 3 Sphere 4 Sphere 5 Sphere 6 Sphere 7 Sphere 8 x (m) y (m) z (m) Distance to laser scanner (m) Points 8.0 8.0 28.0 26.0 26.0 10.0 10.0 2.0 2.0 8.0 25.0 28.0 12.0 4.0 10.0 8.0 2.0 16.0 2.0 0.2 0.2 0.2 0.2 0.2 0.2 0.2 0.2 -17.1 28.3 18.5 18.5 3.4 2.7 8.7 10.2 -44 8 38 33 1365 2438 179 135 Table 3. The simulated data characteristics. Sphere x (m) y (m) z (m) Pos. Err (mm) σ̂ 0 1 2 3 4 5 6 7 8 8.000 28.000 26.000 26.000 10.000 10.000 2.000 2.000 25.000 28.000 12.000 4.000 10.000 8.000 2.000 16.000 0.2000 0.200 0.200 0. 200 0. 200 0. 200 0. 200 0. 200 0.03 0.05 0.01 0.01 0.00 0.00 0.01 0.00 0.00003 0.00003 0.00003 0.00003 0.00003 0.00003 0.00003 0.00003 Estimated points Success Sphere Other Rate 44 0 100% 8 0 100% 38 0 100% 33 0 100% 1328 0 97.3% 2181 0 89.5% 179 0 100% 135 0 100% Table 4. Derived sphere centers, simulated data with no noise. Sphere x (m) y (m) z (m) Pos. Err (mm) 1 3 4 5 6 7 8 7.981 26.002 25.999 10.004 9.975 1.998 2.000 24.993 11.991 4.012 9.978 8.002 2.009 16.001 0.191 0.200 0.210 0.199 0.204 0.205 0.201 21.9 8.9 16.3 21.8 25.5 10.1 1.7 Estimated points σ̂ 0 Points in LUT Sphere Other Success Rate 0.017 0.017 0.017 0.015 0.013 0.017 0.015 34 30 27 914 1677 130 95 28 30 27 644 719 121 91 0 0 0 0 0 0 0 63.6% 79.0% 81.8% 47.2% 29.5% 67.6% 67.4% Table 5. Derived sphere centers, simulated data with 2 cm noise
© Copyright 2026 Paperzz