
VectorNav Technologies, a provider of inertial navigation solutions, has received accreditation for the AS9100 Rev. D international aerospace standard for its Dallas headquarters.


VectorNav Technologies, a provider of inertial navigation solutions, has received accreditation for the AS9100 Rev. D international aerospace standard for its Dallas headquarters.
Based on ISO 9001 standards, the AS9100 standard is a set of quality requirements established by the aerospace industry to satisfy DOD, NASA and Federal Aviation Administration quality requirements.
Founded in 2008, VectorNav is an innovator of miniature, high-performance micro-electro-mechanical systems and GPS/GNSS-based inertial navigation systems.
Recent releases include VectorNav’s surface mount VN-100 IMU/AHRS, VN-200 GPS/INS and VN-300 dual-antenna GNSS/INS, in a new tactical-grade line of inertial navigation systems.
The AS9100 accreditation marks VectorNav’s achievement in demonstrating the highest level of manufacturing, quality and customer service standards. The certification represents the company’s ability and commitment to deliver to its customers worldwide the highest quality miniature inertial navigation systems, from rapid procurement during testing and development to high-volume capacity for integration and production, the company said.
“Earning the AS9100 designation for our Dallas facility demonstrates that we are a highly capable supplier to the global aerospace industry,” said Scott MacDonald, process and quality engineer at VectorNav. “Operating to the highest standards of quality has always been a core principle for us, and this certification reflects our continued commitment to ensure our processes and systems deliver products and services that exceed our customers’ quality, cost, and speed expectations.”
By Omar Garcia Crespillo, Daniel Medina, Anja Grosch, Jan Skaloud and Michael Meurer / Presented at the European Navigation Conference, Lausanne, Switzerland, May 2017

We designed a tightly-coupled integration between GNSS and inertial navigation systems (INS) where we modify the update step of a classical Extended Kalman Filter (EKF) to consider different robust estimators (such as M-estimators). We consider different faulty scenarios where the pseudoranges contain one or several non-modeled biases. The tightly-coupled GNSS/INS robust Kalman filter performance in the presence of biases is compared with the classical EKF and with a loosely-coupled Robust-GNSS/INS approach. The robust tightly-coupled version is able to minimize more efficiently the biases effect thanks to the direct redundancy of the inertial sensor within the robust estimator.
We set a simulated scenario based on a realistic trajectory and generate both GNSS and inertial measurements following state-of-the-art error models. We analyze the filter behavior under the presence of pseudorange measurement faults. For that purpose, we have run 100 Monte Carlo simulations over the given trajectory, and we have generated synthetic pseudorange biases of 40 meters in satellites PRN 18 and PRN 24 every 20 seconds. The filter error performance in the position domain is shown for the classical EKF and for a robust EKF based on Huber estimation criteria, the mean simulation error as well as the 95 error confidence interval. The classical EKF is highly affected by the sudden biases, and their effect influences for some seconds the estimation, while the robust Huber EKF is less sensitive to the presence of these biases because it is able to better adjust the estimation to minimize their effect in the final position estimation error.
Polynesian Exploration Inc. has launched its high-accuracy navigation system for demanding applications such as autonomous driving and unmanned aerial vehicles (UAVs).
Polynesian Exploration is a navigation startup founded by a group of navigation-industry veterans in Silicon Valley in October 2016.
The navigation system is designed to fully utilize the advantages of both GNSS and inertial navigation systems (INS) to provide centimeter-level position and velocity accuracy with dual frequency real-time kinematic, together with accurate attitude information (roll, pitch and heading).
The system provides superior short-term stability against satellite signal outages and highly accurate heading whether the system is static or moving, Polynesian Exploration said.
The rugged and waterproof system will be ready for shipment starting July 1.
Polynesian Exploration described the demand for high-accuracy GNSS/INS solutions this way:
By the year 2020, four GNSS are expected to be fully operational, which are GPS, GLONASS, Galileo and BeiDou. The abundance of measurements from multiple constellations around the world will enable unprecedented improvements in the accuracy, continuity and integrity of GNSS navigation systems.
Although GNSS signals have grown to become ubiquitous, all radio-navigation systems are subject to radio frequency interference, short signal blockages and severe multipath errors in certain environments (such as urban canyons).
INS can potentially mitigate integrity and continuity risks caused by those issues to a certain degree. Additionally, INS is able to compute and output user’s position, velocity and attitude at high frequencies. Reporting information to users at a high-frequency is essential for many vehicle control applications, such as self-driving cars, UAV flight stability or autonomous landing.
We design our navigation systems with various performances depending on user demands, which include, but are not limited to, up to 400-Hz position, velocity, attitude outputs and meters to center-meter level position accuracy.
They can also be operational in all weather conditions and will be available globally.
Additionally, we are able to integrate special sensors for each unique application as requested by our customers. We are driven by customer satisfaction and strive to offer the best experience for our customers.

Exploring IMU specifications and correlating them to performance of a final product can be daunting, as differences between MEMS sensors are not always apparent. This article presents achievable performances in fusion technology across a range of IMUs among the best in their respective performance categories.
The number of available options in inertial navigation systems (INS) has grown substantially over the last several years. Major advances have been made not only in inertial measurement unit (IMU) technology, but also in the ability to exploit sensor information to its fullest extent. In both cases, the largest impact can be seen in the micro-electrical-mechanical systems (MEMS) sensors. MEMS sensors are typically much smaller, lower power and less expensive than traditional IMUs. The net result of these improvements is a proliferation of INS systems at much lower cost than were previously available and, therefore, greatly increased accessibility to technology that has historically seen limited deployment. Selecting the appropriate sensor and fusion solution for a particular application can be very challenging due to the large and confusing spectrum of solutions.
The IMUs will be examined in the context of new enhancements to sensor fusion algorithms such as the use of INS profiles. The concept of INS profiles applies environment specific constraints to improve performance in certain types of vehicles, or motion profiles. External sensors such as odometers and dual antenna operation can also aid the solution considerably, but will be unused in this analysis except for occasional comparisons. These external aiding sensors are extremely helpful in many cases and are available to use with a proprietary tightly coupled GNSS+INS solution called SPAN, but this paper seeks to evaluate what performance can be achieved without such aids.
Real-world test results will be examined using a selection of IMUs with the latest SPAN algorithms to illustrate what kind of performance can be achieved with different sensors in difficult conditions. Despite their major advances over the past few years, there are many challenges involved with utilizing MEMS technology to provide a robust navigation solution, particularly during limited GNSS availability or low dynamics. The measurement error characteristics of these devices have improved dramatically, but are still much larger and more difficult to estimate than traditional sensors. Advancements in SPAN sensor fusion algorithms have enabled these smaller sensors to achieve remarkable performance, especially in applications where environmental conditions allow for additional constraints to be applied.
This testing focuses on the land profile, meaning the constraints applied to a fixed-axle vehicle. The test scenarios were selected in such a way as to provide results for ideal, poor and completely denied GNSS coverage.
GNSS and IMU sensors are only one part of the overall INS system performance. The sensor fusion algorithms used to exploit the available sensor data to its utmost capability are equally as important. In this regard, several improvements have been made to the SPAN INS algorithms to enhance performance under a variety of scenarios.
The largest addition to the SPAN product line is the introduction of INS profiles. That is, environment- and vehicle-specific modeling constraints can be utilized to enhance the filter performance. For example, the land profile, which will be examined in depth in this article, is intended for use with ground vehicles that cannot move laterally. The assumptions introduced for land vehicles, however, are not necessarily valid for different forms of movement, such as those experienced by a helicopter. Therefore, profiles have been implemented via command, and controlled as required by the user, allowing for maximum performance depending on the application at hand.
The land profile is analogous to what has historically been identified as dead reckoning. It is a method that uses a priori knowledge of typical land vehicle motion to help constrain the INS error growth. In other words, it makes assumptions on how land vehicles move to simplify inertial navigation from a six-degree-of-freedom system to something closer to a distance/bearing calculation. The land profile takes the concept of dead reckoning, models it as an update type into the inertial filter and adds a few additional enhancements.
Velocity Constraints / Dead Reckoning. Amongst other optimizations, the land profile enables velocity constraints based on the assumption of acceptable vehicle dynamics. This includes limiting the cross track and vertical velocities of the vehicle. Of all the enhancements, this is the one most colloquially referred to as dead reckoning.
In its simplest form, dead reckoning is the propagation of a position without any external input. In this forum, external input generally refers to GNSS satellites. Without external input, dead reckoning is inherently dependent on assumptions of velocity and heading to propagate the position. These solutions have evolved by integrating inertial and directional sensors to provide more local input and improve the solution propagation. This also is not a perfect method, however, as inertial sensors have their own errors that grow exponentially over time. The land profile velocity constraints explain the bulk of optimizations SPAN has made to enable dead-reckoning performance in extended GNSS outage conditions.
Explaining the velocity updates involves using the current INS attitude (
); the vehicle attitude (
) is estimated by applying the measured or estimated IMU body to vehicle direction cosine (
). From this, the pitch and azimuth for the vehicle is estimated.Using the magnitude of the measured INS velocity in conjunction with the derived vehicle orientation, the vehicle velocity is computed, allowing the expected vertical velocity and cross-track to be constrained.
A velocity vector update is then applied to the inertial filter to constrain error growth. The effects of this method are expected to be most apparent in extended GNSS outage conditions when the INS solution must propagate with no external update information.
Phase Windup Attitude Updates. Some applications are inherently difficult for inertial sensors due to the fact that these systems are reliant on measuring accelerations and rotations in order to observe IMU errors. When traveling at a constant bearing and speed, separating IMU errors from measurements becomes challenging, so any application that does not provide meaningful dynamics is more demanding on inertial navigation algorithms. This type of condition commonly appears in applications such as machine control, agriculture and mining.
Gravity is a strong and fairly well known acceleration signal, so the real difficulty in this type of environment is managing the attitude, and especially azimuth, errors. Attitude parameters become difficult to observe when the system experiences insignificant rotation rates about its vertical axis.
External inputs can be used for providing input during low dynamic conditions when rotational observations are weaker. These are particularly helpful in constraining angular errors and include the same types used to assist in initial alignment: dual antenna GNSS heading, magnetometers, etc. However, as the goal of this testing is to demonstrate the achievable performance from a single antenna GNSS system, this type of external aid was specifically omitted.
Utilizing a patented technique for determining relative yaw from phase windup, the system is able to distinguish between true system rotation and unmodeled IMU errors during times of limited motion. This is a novel way to extract additional information out of existing sensors rather than adding more equipment and complexity.
The phase windup update is used to constrain azimuth error growth during low dynamic conditions that are typically not favorable to inertial navigation. However, it does require uninterrupted GNSS tracking and is therefore applicable only in GNSS benign environments. This approach is expected to show the greatest benefit in low dynamic conditions and be directly attributable to azimuth accuracy, but only in conditions where GNSS availability is relatively secure.
We paired OEM-grade GNSS receiver cards with a selection of IMUs in different performance categories. Since the OEM GNSS platform is capable of tracking all GNSS constellations and frequencies, we configured each receiver to use triple frequency, quad-constellation RTK positioning. The receivers were coupled with a wideband antenna capable of tracking GPS L1/L2/L5, GLONASS L1/L2, BeiDou B1/B2 and Galileo E1/E5b signals.
Three IMUs were tested: an entry-level MEMS IMU (UUT1), a tactical-grade MEMS IMU (UUT2) and a high-performance fiber-optic gyro-based IMU (UUT3).
All GNSS receivers and IMUs were set up in a single test vehicle and collected simultaneously for all scenarios. IMUs were mounted together on a rigid frame, and all receivers ran the same firmware build that were connected to the same antenna.
The tests were conducted using a single GNSS antenna with no additional augmentation sources, such as distance measurement instrument (DMI) or wheel sensor. These are extremely helpful in aiding the solution, but as previously mentioned, this testing seeks to demonstrate the possible performance without the benefit of additional aiding sources. Dependence on aiding sources is a very important distinction when comparing such systems.
The GNSS positioning mode used was RTK via an NTRIP feed from a single base station with baselines between 5–30 kilometers. This was done to try to minimize GNSS positioning differences between the three systems. L-band correction signals were not tracked, and PPP positioning modes were not enabled.
A basic setup diagram of each system under test can be seen in Figure 1.

Four test scenarios will be examined using all the equipment and algorithms described above. They are: urban canyon, low dynamics, parking garage and extended GNSS outage.
The urban canyon test is designed to show the performance of the system in restricted GNSS conditions. The challenge to this scenario is to maintain a high-accuracy solution when GNSS positioning becomes intermittent or even unavailable.
The low dynamics test is intended to illustrate the benefits of the land profile, and specifically the phase windup azimuth updates in maintaining the azimuth accuracy.
The parking garage test will show the efficacy of the velocity constraint models over the different IMU classes as the extended outage provides no external information to the INS filter whatsoever. Again, no other aiding sources were used.
Urban Canyon Test. The urban canyon environment has been and remains one of the strongest arguments in favor of using GNSS/INS fusion in a navigation solution. Because urban canyons are common, densely populated and, of course, a demanding GNSS environment, they represent both an important and challenging location to provide a reliable navigation solution. Typically, they contain major signal obstructions, strong reflectors and complete blockages (depending on the city). For this reason, they provide an excellent use case for INS bridging to maintain stability of the solution.
During most urban canyon environments, it is typically rare to incur total GNSS outages of more than 30 seconds. Therefore, this scenario examines the stability of the solution in continuously degraded, but not generally absent, GNSS. In this case, the coupling technique of the inertial algorithms rather than quality of the IMU dominates achievable position accuracy.
The receiver platform is capable of tracking all GNSS constellations and frequencies. This provides a significant benefit to test scenarios, such as the urban canyon, where the amount of visible sky is significantly restricted. In this case, the more satellites that are observable, the more the tightly coupled architecture can exploit the partial GNSS information.
Though position accuracy between IMUs is less apparent in this condition, attitude results remain separated by IMU quality, which is a major consideration for some mapping applications such as those using lidar or other sensors where a distance/bearing calculation must be done for distant targets.
Test data for this scenario was collected in downtown Calgary, Canada. The trajectory (Figure 2) includes several overhead bridges for brief total outages and some very dense urban conditions.

Table 1 shows the RMS error results of the three systems running both the default and land profiles. The first thing to notice is that the errors are differentiated by IMU category, though the differences are fairly small in the position domain thanks to the tightly coupled architecture. However, because GNSS information is partially available, the differences seen in activating the land profile are fairly modest, especially as the IMU performance rises.

As the clearest benefits of the land profile are seen on the entry-level MEMS IMU (UUT1), these will be explored graphically in Figures 3 and 4. Figure 3 shows the position domain, and the RMS differences can be seen in a few cases where the default mode errors increased faster than the land profile. An example of this divergence is most obvious around the 1500-second mark of the test during periods GNSS is most heavily blocked.
Low Dynamics Test. The low dynamics test is designed to emulate conditions experienced by machine control, agriculture and mining applications. In this situation, GNSS availability is generally not the limiting factor and can be used to control the low frequency position and velocity errors of the INS system. The difficulty is managing the attitude, especially azimuth, errors because attitude parameters are very hard to observe without significant rotations or accelerations (Figures 5 and 6).
The low dynamics test was collected in an open-sky environment and consisted of traveling in a straight line on a rural road for roughly 2 km at an average speed of 10–15 km/h.
As this type of scenario provides little physical impetus, the azimuth and gyroscope biases are not observable. The reason for this is due to the use of the first-order differential equations to estimate the navigation system errors. Essentially, the differential equations define how the position, velocity and attitude errors change (grow) over time based on each other and the IMU errors. The observability of a particular update is tied to additional states through the off-diagonal elements of the derived transition matrix with the accelerations and rotations experienced by the system.
The overall RMS solution errors for RTK are provided in Table 2. As evident by the results presented, the position and velocity errors are clearly constrained by the continuous RTK-level GNSS position regardless of whether the land profile is enabled or not. The real differentiator in the land profile is the attitude performance due to the use of phase windup as a constraint. Moreover, the attitude improvements are certainly tied to IMU quality.


UUT1 exhibited a noticeable improvement in the attitude performance, while the higher performance IMUs did not. This is not entirely unexpected as the precision of the phase windup is lower than that of the higher grade IMUs.
Looking at the data graphically, Figure 7 shows the effect of land profile on positioning performance in this scenario. The two solutions are indistinguishable on the plot, and are all within standard RTK-level error bounds as was indicated in the RMS table.
Figure 7 shows the attitude accuracy with and without the land profile enabled. Again, the largest gains are seen on the entry-level UUT1, so this is the graphic shown below. This shows how the error peaks of the azimuth estimates are constrained. All the sharp corrections in each plot correspond to the vehicle turning around at the end of each 2-Km line and illustrates how much more powerful a rotation observation can be in azimuth accuracy overall.

Parking Garage Test. This test was carried out at the Calgary International Airport and was selected to show the INS solution degradation during extended complete GNSS outages. The test consisted of an initialization period in open sky conditions to allow the SPAN filter time to properly converge, followed by a 500-second period within the parking garage. During the interval within the parking garage there were no GNSS measurements available.
Figure 8 provides a trajectory of the test environment. The time spent inside the parking structure is evident on the center bottom of the image.

Unlike urban canyon environments that contain partial GNSS information, this exhibits an extended period of complete GNSS outage. During this type of scenario, the IMU specifications become much more significant. IMU errors directly translate to the duration the solution can propagate before the accumulated low-frequency errors of the IMU grow to unacceptable levels. System performance during the outage degrades according to the system errors at the time of the outage and the system noise. The velocity errors increase linearly as a function of attitude and accelerometer bias errors. The attitude errors will increase linearly as a function of the unmodeled gyro bias error. The position error is a quadratic function of accelerometer bias and attitude errors.
Position results from each IMU are shown for UUT 1 in Figure 9. This plot shows the error with the land profile on and off. Without the land profile, the second-order position degradation in an unconstrained system is clearly visible.

By enabling the land profile, the filter constrains IMU errors by utilizing a velocity model for wheeled vehicles. With the constraints, the position errors are startlingly reduced for UUT1 and then progressively less impactful as the IMU quality increases in UUT2 and UUT3, respectively. This makes sense as the IMU error growth is progressively smaller in those IMUs, so the effect of mitigating them is also reduced.
Extended GNSS Outage Test. An extension of the parking garage test is to evaluate the performance in a much longer outage. Instead of 10 minutes, an outage of one hour was tested. Also, due to the extremely long GNSS outage bridging, the effects of adding a DMI sensor (odometer) will also be explored as they are able to be used as a major additional aiding source.

The most common measure of dead-reckoning performance is error over distance traveled (EDT). Due to the very long duration outages in this test, the errors will be reported in error over distance traveled to conform to the typical reporting method. This test was conducted in a mixture of highways and suburban streets with an average speed of 65 Km/h, incorporating a moderate amount of dynamics.
This effect can be seen over the duration of the entire outage as well in Figure 9. In this case, the points are the RMS error over several tests. and the light background shroud represents the one-sigma confidence as time progresses. The confidence increases over time as the overall distance traveled also increases.

In testing a range of IMUs in some challenging scenarios, this paper has sought to illustrate what kind of performance is achievable using each kind of system. An added complexity is looking at what effect certain inertial constraint algorithms have on this solution.
Although low-cost MEMs IMUs are continuing to greatly improve in quality and stability, the end application is still highly correlated to the overall performance of a selected INS system. For a great many applications, the MEMS devices in combination with a robust inertial filter can meet requirements and provide excellent value. However, some applications continue to require higher end sensors, and possibly post-processing to meet their needs.
The ability of SPAN to utilize partial GNSS measurements such as pseudorange, delta phase and vehicle constraints means even low-cost MEMs are capable of providing a robust solution in challenging GNSS conditions. However, this tightly coupled integration is limited in cases where GNSS is completely denied or when in low dynamic conditions.
INS profiles using velocity constraints, phase windup and robust alignment routines have been shown to provide substantial aid to the INS solution in tough conditions, such as GNSS denied or low dynamics. These improvements were shown to exhibit greater impact as the IMU sensor precision decreases. These abilities, in conjunction with the existing tightly coupled architecture of SPAN and the ever-increasing accuracy of MEMS, IMUs indicate that robust GNSS/INS solutions will continue to proliferate at lower cost targets. However, very precise applications such as mapping will continue to rely on higher quality sensors to meet strict accuracy requirements.
The authors thank Trevor Condon and Patrick Casiano of NovAtel for collecting and helping to process the data presented in this article, and to Sheena Dixon for her tireless editing.
NovAtel SPAN technology on the NovAtel OEM7 receiver is the testing and development platform for this research. NovAtel OEM7700 GNSS receiver cards and a NovAtel wideband Pinwheel antenna were employed. The inertial units under test were an Epson G320 (low-power, small-size MEMS IMU); Litef μIMU-IC (larger tactical-grade performance IMU still based on MEMS sensors); and a Litef ISA-100C (near navigation-grade IMU using fiber-optic gyros (FOG). Although all are excellent performers in their class and capable of providing a navigation-quality solution, the intent is to show the potential limitations that might arise due to the intended application.
RYAN DIXON is the chief engineer of the SPAN product line at NovAtel Inc., leading a highly skilled team in the development of GNSS augmentation technology. He holds a BSc. in geomatics engineering from the University of Calgary.
MICHAEL BOBYE is a principal geomatics engineer at NovAtel and has participated in a variety of research projects since joining in 1999. Bobye holds a BSC. in geomatics engineering from the University of Calgary.

Tersus GNSS Inc. is now offering the INS-T-306, a GNSS-aided inertial navigation system. The INS-T-306 is the advanced module that combines GPS L1/L2, GLONASS, BDS navigation and a high-performance strap-down system. It is capable of determining position, velocity and absolute orientation (heading, pitch and roll) for any device on which it is mounted.
The launch of the INS-T-306 aims at facilitating motionless and dynamic applications that need high accuracy, such as vessels, ships, helicopters, unmanned aerial vehicles (UAVs) and unmanned ground vehicles (UGVs).
The INS-T-306 utilizes an advanced GNSS receiver, barometer, magnetometers, micro-electro-mechanical (MEMS) accelerometers and gyroscopes to provide accurate position, velocity, heading, pitch and roll of the device under measure.
Besides GPS L1/L2, GLONASS and BDS, the unit supports differential GPS and real-time kinematic (RTK). It is able to integrate into lidar (Velodyne, Riegl and Faro brands). The on-board sensor fusion filter, navigation and guidance algorithms, and calibration software inside all make INS-T-306 a commercially exportable GNSS-aided inertial navigation system.

Inertial Sense will be releasing a high-quality, low-cost navigation system — the μINS — later this summer, the company said. The company made the announcement at AUVSI’s Xponential 2017.
Inertial Sense is a privately owned U.S. company that specializes in designing and manufacturing GPS inertial navigation technology for commercial and consumer products.
Historically, quality GPS inertial navigation has been expensive and was only designed into a small number of systems. As the commercial and consumer drone industries grow, the need for an accurate, low-cost navigation system has become more apparent, Inertial Sense said.
Acccording to Inertial Sense, the company’s engineers have invented a design that enables the technology to be smaller and less expensive.
The μINS is a tiny sensor module that is designed to provide high-quality direction, position and velocity data for drones and robotic applications. It provides this data by fusing sensor data from GPS (GNSS), gyros, accelerometers, magnetometers and a barometric pressure sensor.
Sensor role reversal: Lidar with its superior performance can replace GNSS in the integration solution by providing fixes for the drifting inertial measurement unit (IMU). Tests show its potential for terrain-referenced navigation due to its high accuracy, resolution, update rate and anti-jamming abilities. A novel algorithm uses scanning lidar ranging data and a reference database to calculate the navigation solution of the platform and then further fuse with the inertial navigation system (INS) output data.
Recent rapid advances in laser-based remote sensing technologies, including pulsed linear, array and flash lidar systems, have fostered the development of integrated navigation algorithms for lidar and inertial sensors. In particular, trajectory recovery based on lidar point-cloud matching can provide valuable input to the navigation filter. Lidar/INS integrated navigation systems may provide continuous and fairly accurate navigation solutions in GNSS-challenged environments, on a variety of platforms, such as unmanned ground vehicles, mobile robot navigation and autonomous driving.
In the case of airborne lidar/INS applications, the free inertial navigation solution is used to create the point clouds, which are subsequently matched to a digital terrain elevation model (DEM). The results are fed back to the platform navigation filter, providing corrections to the free navigation solution. This solution may be used to recreate the point cloud to obtain better surface data.
However, depending on the lidar data acquisition parameters, INS drift during the time between the two epochs when point clouds are acquired could be significant. Besides the shift in platform position, the drift in attitude angles could more severely impact point-cloud generation, producing a less accurate point cloud and subsequently poor matching performance.
This article describes a new lidar positioning approach, where the scale-invariant feature transform (SIFT)-based lidar positioning algorithm is used to match between the lidar measured point cloud and the reference DEM. The matching process is aided with fuzzy control: SIFT-based lidar positioning algorithm with Fuzzy logic (SLPF), where the threshold for SIFT is adaptively controlled by the fuzzy logic system.
Based on the geometric distribution and the range difference variance of the matched point clouds, fuzzy logic is applied to calculate the threshold for the SIFT algorithm to extract feature points; thus the optimal matched point cloud is extracted in several iterations. When there are enough matched points in the final output of the SLPF, the platform position is calculated by using the least squares method (LSM). Next, for trajectory estimation, when applying the SLPF algorithm, frequent lidar updates can be used to correct small cumulative errors from the INS sensor measurements. A Kalman filter fuses the results of the SLPF algorithm with the INS system.
This integrated algorithm can handle situations when there are less than three matched feature points being extracted by the SLPF algorithm, and yet they could still contribute to obtain a better navigation solution. Simulation results show that, compared to the existing algorithms, the proposed lidar/INS integrated navigation algorithm not only improves the position, speed and attitude-determination accuracy, it also makes the lidar less dependent on INS, which makes the navigation system work longer without exceeding a particular drift threshold.
To eliminate the influence of INS error on the lidar positioning system, instead of creating a measured DEM based on INS ortho-rectification, we directly map the range data measured by lidar to the local stored DEM data. If a successfully matched feature point can be obtained, it means that we can get a point with absolute position and relative range towards the platform, which is similar to the satellite in GNSS positioning. After scanning of one area by lidar, when three or more such matched feature points, if not on a line, can be obtained, then we are able to form a full rank equation with the unknown variables of the platform position x, y and z.
However, due to the effect of affine transformation, the standardized range dataset collected by lidar is significantly different from the elevation dataset belonging to the same area. Figure 1 shows an example of the large difference between the two datasets from the same area when the pitch angle of the platform is equal to 5° and the flying height is 2,000 m. In this situation, the traditional flooding algorithm or constellation feature point matching algorithm is incapable of extracting matched feature points from such different datasets.

In response, we introduce the SIFT algorithm to the elevation map-matching procedure. Designed for image matching, the SIFT algorithm is invariant to scale, rotation and translation, and it is robust to affine transformation and three-dimensional projection transformation to a certain extent. Although SIFT is often used in image matching, each pixel from the image is a numerical point, which, in fact, has no difference with elevation data point. Before applying the SIFT, some processing on the lidar measured range data must be done.
The scanning information of the lidar measured points are (α, β, r), where α is the angle between the laser beam and the negative Z-axis of the platform body frame, β is the angle from the laser beam to the plane of axis and Z-axis in body frame, r is the range between the laser head and the measured target, as shown in the opening figure.
Due to the terrain relief, the lidar range data are irregularly spaced. Therefore, it is necessary to interpolate the collected data. Here we apply the Natural Neighbor Interpolation method.
SIFT Algorithm, Fuzzy Control. For the lidar positioning algorithm, which is based on the absolute position and relative range of the ground-matched feature points, a point cloud with sufficient number of points of good geometric distribution is needed. In practice, however, the terrain undulation and the attitude of the airplane will affect the quality of the point cloud and the accuracy in the matching process. In addition, the selected threshold in the SIFT algorithm plays an important role on the quality of the matched point cloud.
A Monte Carlo simulation, shown in FIGURE 2, illustrates the impact of the threshold on the number of successful matched points (normalized) and mismatched rate. For obtaining better matched point clouds, we have introduced a SIFT terrain matching algorithm assisted by fuzzy control, as shown in FIGURE 3.


The algorithm mainly consists of two fuzzy logic controllers. Controller 1 calculates the initial threshold for the SIFT algorithm according to the gridded SR data terrain undulation degree λ, and the angle Θ between Z-axis in body-frame and Z-axis in navigation frame.
Controller 2, which is responsible to adaptively changing the threshold at each epoch, has two inputs. The first one is the Normalized Points Area (NPA), which represent the geometric condition of the matched point cloud. The other one is the Relative Range Difference Variance, which indicates if a mismatch has happened. When the final matched feature point cloud is obtained, and the number of points is greater than or equal to 3, then the LSM is used to calculate the position of the platform.
Loosely and tightly coupled integration are the most common methods in navigation systems. Given the characteristics of the proposed positioning algorithm, the classical integrated navigation algorithm needs to be modified. In the loosely coupled approach, the lidar is unable to aid INS when flying through a flat region and/or flying with a large tilt angle, because the proposed lidar positioning method may have difficulty in extracting enough matched points to calculate a position.
In the tightly coupled method, as the output frequency of matched point cloud is low and the geometry of the matched feature points is relatively poor, the integrated system may be extremely unstable. Here we propose a combined loosely and tightly (CLT) integrated navigation algorithm that when the lidar positioning algorithm can extract enough matched points for a navigation solution, the lidar-calculated navigation solution is used as the main observation.
However, when the matched points are not sufficient to obtain a navigation solution, the baseline vector of the matched point that is closer to the projection of the platform center to the surface will be utilized as the observation. In this solution, lidar can still provide a certain degree of aid to the INS, once extracting matched feature points, even if less than 3.
In the simulation experiment, the 3D DEM data of 0.5-meter resolution is obtained from an open source named EOWEB. Then the DEM data is resampled to a higher resolution of 0.1 meter, which is used to generate the simulated, irregularly spaced, measured range data. On the basis of the original DEM (0.5 meter resolution), the proposed lidar positioning algorithm and lidar/INS integrated navigation algorithm are verified and compared with the traditional methods.
Simulation of Lidar Algorithm. As shown above, the successfully matched points rate is very important for positioning, as once a mismatched point occurs, it may lead to a faulty navigation solution. In the simulation, the proposed SLPF is simulated under the condition of different aircraft tilt angle ϴ, from 0° to 10° with a step of 1° , at 5,000 different positions, which is the same simulation condition as in Figure 2. Comparison is made with the traditional constellation feature matching based lidar positioning algorithm (CLP) and the SIFT based lidar positioning algorithm without fuzzy control (SLP). The successfully matched points rate and the NPA value are shown in Figure 4.

As can be seen from the figure, along with the increasing platform attitude angle, the successfully matched points rate of all the three algorithms has declined. However, compared to the CLP, both SIFT-based algorithms have a higher success matching rate due to the more stringent feature-point extraction approach. And due to the adjustable threshold mechanism, the SLPF could remove some of the mismatched points by raising the threshold; thus it is superior to the common SIFT algorithm in performance. The NPA values of the extracted point cloud from the three algorithms are shown in Figure 4(b). With the increased attitude angle, the NPA value of the matching feature point cloud decreases in all three algorithms. The CLP algorithm, however, is more sensitive to the projected range data, which makes the number of successful matching points drop sharply, and further affect geometric distribution of the point cloud. The gap between the SLPF and SLP shows that the fuzzy control module can help improve the geometric structure of the feature point cloud.
Figure 5 shows the positioning error when applying the three different matching algorithms at 5,000 different areas. The SLPF algorithm is better than the other two algorithms in all directions. When the platform’s attitude angle reaches about 10 degrees, the north and east positioning accuracy of SLPF algorithm is still about 8 meters, and the height positioning accuracy is about 0.2 meters. The reason that the height positioning error is far less than the north and east positioning error is because of the matching point cloud distribution. Due to the airborne lidar scanning mechanism, the matched point cloud is all located in a relative small area at the bottom of the platform, resulting in the great component value in the height direction of each matched feature point baseline vector in the G matrix, and then affect the final positioning accuracy.

Table 1 shows some detailed information as average number of matched points (ANMP) and matched points position error (MPPE) using the three methods. The MPPE is calculated in 3D space. It can be seen that when the tilt attitude is small, comparing to the CLP method, although the number of matched points extracted by SLPF is less, the matched points position accuracy is still much better, leading to a better localization result. Moreover, with the increasing platform tilt attitude, CLP and SLP have more difficulty in maintaining the number and accuracy of the matched points.
Lidar/INS Algorithm. To validate the feasibility of the proposed integrated navigation algorithm, firstly, the motion trajectory of the platform must be simulated. As shown in Figure 6, the red line is the simulated platform true trajectory, which lasts for 1,400 seconds. During the trajectory, the platform undertakes the different motion states as acceleration, deceleration, climbing, turning and descent. Then the INS output data based on the true trajectory with the frequency of 100 Hz is generated. To verify the calibration performance on the INS in the integrated navigation algorithm, accelerometer and gyroscope drift noise is added to the INS output data. The green line shown in Figure 6 is the INS output data trajectory solution. At the end of simulation, the error to the east direction reaches 500 meters, and the north direction error reaches to more than 2,200 meters.

At the same time of the INS outputting navigation solution, lidar also scans and calculates the position of the platform with 1-Hz frequency. Note that the speed of the aircraft is from 70 m/s to 100 m/s, and the maximum lidar scanning angle αmax is 20°. Figure 7 and Figure 8 show the number of matched points and the positioning error for each scanned terrain using SLFP. When the platform maintains smooth flying, the number of matched points can reach an average of 10, and the positioning accuracy is relatively high, less than 3 meters. Note, during the period, only in a few epochs are the number of matched points less than five. However, when the platform is climbing or changing flight direction, the number of matched points is obviously decreased due to the large tilt angle of the platform, and so does the number of successful positioning times. In this case, the position error is also increased dramatically, reaching about 10 meters error in east and north, and 0.2 meters error in height. Especially in the course of changing the direction of the flight, shown in Figure 7, during the periods of 720s–800s and 920s–1,000s, due to the larger roll angle, the SLPF could hardly be able to calculate the position through the LSM. During this period the lidar would occasionally output 1 or 2 matched feature points.
During the simulation, the CLT and LC methods are used for data fusion and trajectory estimation comparisons. TC method is not added to the comparison because of slow convergence. The data fusion results are shown in Figure 9. It illustrates that the LC method and the CLT method have close positioning accuracy in the case of sufficient matched feature points. As can be seen in conjunction with Figure 8, when lacking matched points, the CLT method is superior to LC on positioning accuracy, especially in the height direction. In addition, the CLT integrated algorithm shows some improvement on the accuracy of estimating speed and attitude.
Figure 10 shows the position error distribution when using four different lidar/INS integrated navigation methods for data fusion under the condition of different simulation trajectories. In the simulation, 50 1,400-second-long different trajectories, with flat areas, are generated with different platform attitude, velocity or acceleration. As can be seen from the figure, compared to other integrated navigation methods, the CLT method greatly improves the accuracy of navigation.

During 84.26% of the simulation period, CLT could maintain the position error less than 3 meters; the rate with error that is larger than 15 meters is 1.2%. For the TC method, due to the frequent divergence of the data fusion filter, most of the position estimates are not available. In addition, after flying above a flat area, the voting-based constellation integrated method has poor matched point accuracy and successfully matched rate due to large INS drift error, which makes lidar unable to calibrate the INS. When using the constellation-based method, during only 32.35% of the simulation period, the error is maintained in 3 meters and most of the period, 54.9%, the position error is between 3 to 15 meters.
We propose a new lidar matching algorithm based on SIFT, which does not rely on the INS output data to generate measured DEM data, and can adaptively change the threshold of the SIFT algorithm to generate optimal matching between the point cloud and the DEM. Through verification of simulation, the algorithm is compared with traditional lidar/INS integrated navigation methods based on comparing achieved accuracies in estimating position, speed and attitude. Simulation results show that the SLPF algorithm has better reliability for feature points matching and robustness against the platform attitude than the traditional algorithms. The CLT method improves trajectory estimation accuracy, especially when flying over moderately undulating terrain or flying with large roll or pitch angles.
This article is based on a paper presented at the ION International Technical Meeting, January 2017. This research used an open-source GNSS/INS simulator based on Matlab, developed by Gongmin Yan of Northwestern Polytechnical University, China.
Haowei Xu is a Ph.D. student at Northwestern Polytechnical University, where he received an M.Sc in Information and Communication Engineering. He is a visiting scholar at The Ohio State University.
Baowang Lian is a professor at Northwestern Polytechnical University where he is also director of the Texas Instruments DSPs Laboratory.
Charles K. Toth is a senior research scientist at the Ohio State University Center for Mapping. He received a Ph.D. in electrical engineering and geo-information sciences from the Technical University of Budapest, Hungary.
Dorota A. Brzezinska is a professor in geodetic science, and director of the Satellite Positioning and Inertial Navigation (SPIN) Laboratory at The Ohio State University.

Sonardyne Inc. has supplied acoustically aided inertial navigation technology to McDermott International for its Lay Vessel 108 (LV 108). McDermott is an offshore engineering, procurement, construction and installation company.
The Ranger 2 Pro DP-INS system, the highest specification available from Sonardyne, is being used to support touchdown monitoring surveys of submarine cables, umbilicals and pipelines and as an independent position reference for the LV 108’s Kongsberg dynamic positioning (DP) system.

McDermott’s LV 108 entered service in 2015 and is on contract in the Ichthys field, Western Australia. Designed as a fast-transit, dynamically positioned (DP 2) vessel for subsea constructions support across a wide variety of water depths, the LV 108 has 21,528 square feet of deck space and can accommodate a crew of 129.
Dynamically positioned construction and installation vessels such as the LV 108, conventionally rely on ultra-short baseline (USBL) acoustics and the GNSS as their primary sources of position reference data.
However, a vessel’s station-keeping capability can be compromised in the event the USBL is affected by thruster aeration and noise and the GNSS signal is simultaneously interrupted. The latter is particularly common around equatorial regions and during periods of high solar radiation.
Sonardyne’s Ranger 2 Pro DP-INS system addresses this operational vulnerability. It aids vessel positioning by exploiting the long-term accuracy of Sonardyne’s Wideband 2 acoustic signal technology with high-integrity, high-update-rate inertial measurements. The resulting navigation output has the ability to ride-through short-term acoustic disruptions and is completely independent from GNSS.
In addition to the system’s deep-water positioning performance and safety benefits, DP-INS has been proven to deliver valuable time and cost savings for vessel owners. It does not need a full seabed array of transponders to be installed and calibrated before subsea operations can commence. For most subsea tasks, positioning specifications can be met with only one or two transponders deployed on the seabed.
Additionally, as the system needs only occasional aiding from the acoustics, transponder battery life is substantially increased and the need to task a remotely operated underwater vehicle (ROV) to deploy and recover transponders for servicing is reduced.
The equipment supplied to McDermott for the LV 108 included Sonardyne’s INS sensor co-located with the company’s sixth-generation (6G) HPT acoustic transceiver. This hardware was installed on one of the vessel’s two Kongsberg through-hull deployment machines and interfaced directly with the vessel’s DP system, also supplied by Kongsberg.
SBG Systems Chief Technology Officer Alexis Guinamard discusses the company’s full line of inertial sensors at Intergeo 2016, which was held Oct. 11-13 in Hamburg, Germany. SBG Systems featured its mobile mapping, aerial survey and georeferencing solutions at the trade fair.
NovAtel debuted two new inertial measurement unit (IMU) products within its SPAN technology portfolio at ION GNSS+ 2016, which was held Sep. 12-16 in Portland, Oregon.
SPAN couples NovAtel’s GNSS precise positioning technology with robust inertial navigation systems (INS) to provide continuous 3D position, velocity and attitude solutions, the company says in a news release.

The compact IMU-µIMU-IC is a high performing, fully commercial MEMS IMU. Small in size, it is suitable for aerial and hydrographic survey and space constrained industrial applications. The µIMU is available as a complete assembly in an environmentally sealed enclosure or as a standalone OEM product, both compatible with the company’s OEM6 and OEM7 SPAN receivers.
NovAtel also developed an enclosure for its Honeywell HG1900 IMU, which was previously available only as an OEM product. The IMU-HG1900 IMU offers a hybrid package of Honeywell’s micro electromechanical systems (MEMS) gyros and RBA accelerometers. The enclosure provides system integrators with design versatility, offering LED indicators and simplified cabling that can be extended in length as required. Both cabling and connectors are available off-the-shelf, NovAtel says.
“These two IMUs are part of our new IMU enclosure family, which now provides four sizes of enclosures – from the small Litef- µIMU to our high performance IMU-ISA-100C,” says Neil Gerein, portfolio manager for NovAtel. “We’ve worked hard to bring our customers the very latest in IMU technology and to expand IMU choices to ensure the optimal positioning performance for their application.”
Shipments of the new IMU enclosures will be available in Q4 of 2016, according to NovAtel.

Geodetics Inc.’s newest mobile mapping product, Geo-MMS, is a fully integrated lidar mapping payload for integration with unmanned aerial systems (UAS).
The Geo-MMS includes an inertial navigation system (INS) coupled with a lidar sensor. Raw data from the integrated GPS, inertial measurement unit (IMU) and lidar sensors are recorded on the internal data-recording device and can be post-processed using Geodetics’ lidar tool software package to directly geo-reference the lidar point clouds with LAS-format output. Geo-MMS is available with a wide range of sensors.
Geo-MMS can be used in various applications in both military and commercial industries such as precision agriculture; mining; utilities; asset management; oil; construction and infrastructure inspections; intelligence, surveillance and reconnaissance (ISR); sense and avoid; coastal surveillance; and situational awareness.
As a company based in the United States, Geodetics can also accommodate defense SAASM and M-code path requirements.

NovAtel Inc. announced a new initiative and engineering team to develop functionally safe GNSS positioning technology for fully autonomous applications. The company leverages its extensive experience developing safety-critical systems for the aviation industry to meet the future safety thresholds required for driverless cars and autonomous applications in agriculture, mining, and other government, military and commercial markets.
In early 2015, NovAtel formed a specialized Safety Critical Systems Group of engineers with backgrounds in functional safety as well as all aspects of GNSS and inertial navigation systems (INS) technology. The Safety Critical Systems Group is focused on creating positioning products that will meet the exceptional performance and safety requirements of autonomous vehicles at the necessary production volumes and at the required price point.
The company has extensive background working within safety critical requirements. Michael Ritter, president & CEO stated, “Aviation in North America relies on NovAtel technology to ensure safe navigation and landing.” Ritter added, “The Federal Aviation Administration’s WAAS, and other global Space Based Augmentation Systems (SBAS), have relied on certified NovAtel GNSS receivers for many years as the foundation of their systems. With full GNSS signal and constellation support needed to solve the performance criteria of autonomous driving, NovAtel is uniquely qualified to deliver the optimal solution that will keep us all safe as we drive the autonomous highways of the future.”

NovAtel manufactures high-precision GNSS receivers, antennas and subsystems, with expertise in sensor integration, specifically that of GNSS and INS. Through its TerraStar correction service, NovAtel also offers a global Precise Point Positioning (PPP) correction solution that is already designed for safety-of-life applications.
With work underway for more than a year, NovAtel plans to achieve ISO/TS 16949 compliance by the end of 2016. This is an early key milestone in the Safety Critical Systems Group’s path, to be followed by an ISO 26262 compliant product.
Jonathan Auld is director of Safety Critical Systems at NovAtel. He first joined the company in 2000 and has held positions as a GNSS test engineer, test group manager, director of technology development, and director of portfolio management.