How to Smooth Your Location Data & Snap to the Nearest Road

PubNub Developer Relations - Aug 29 - - Dev Community

We have many customers who use PubNub to exchange geolocation data (latitude, longitude) and track assets in real-time. For example, they can track food delivery, manage a fleet of vehicles, or monitor when riders will arrive safely at their destination.

All delivery solutions face a common set of challenges, and some of the common questions we receive from developers are:

  • “How do I stop location fixes from ‘jumping around’?”
  • “How do I snap the vehicle to the road?”
  • “What if the vehicle GPS location is bad? Can I smooth that data?”

This how-to aims to answer all these questions.

TL;DR

PubNub Functions allow you to transform raw location data in real-time to conform to the road. Start the demo below to see how Real GPS data gathered from a moving vehicle is corrected in real-time Since a single point at an intersection is ambiguous, previous points in your route are considered to ensure the right road is followed.

Interactive Demo

If the embedded content is not available on this page, it can also be viewed at https://pubnub-roads-api-demo.netlify.app/

The application is also available at https://pubnub-roads-api-demo.netlify.app/ | Source Code.

For an explanation of how this application works, jump to the ‘Snap to the Nearest Road’ section.

Is this real data, or faked? The GPS coordinates are real, I recorded them myself from my Android phone whilst riding in an Uber. The corrected location is generated live everytime you run the demo, it is not predefined - feel free to check the code :)

Where to Start?

A naive Google search for “How to smooth GPS data” will return mostly mathematical answers and can potentially mislead developers. You are quickly led down the path of signal filtering and creating a Kalman filter to smooth your GPS track, and it is very easy to lose sight of the end goal.

Using a Kalman Filter

Many blogs that discuss the problem of noisy location data will make a sweeping statement such as “create a GPS point smoothing function, such as a simple Kalman filter,” and the Wikipedia article even includes an ‘Example application’ section that discusses using a filter to determine the precise location of a truck. Developers going down this route will then probably stumble on this ubiquitous Stack Overflow post or open source projects such as KalmanJS which appear suitable at first glance.

Developers quickly come up against practical issues in their implementation however; for example, the KalmanJS project is a 1D filter and so not ideal for location data, as emphasized by the author in his accompanying blog. The Stack Overflow code example is ideal for assets moving at a constant speed but breaks down as the velocity changes between updates (if you dive into the comments of that post, there is a discussion about why you cannot just naively change the velocity value based on the asset’s current speed)

So, why do all resources about smoothing location talk about using a Kalman Filter? In some situations, a Kalman filter is ideal. Consider a vehicle entering a tunnel or driving down a street with an intermittent line of sight to satellites. Using a combination of dead reckoning based on the last known position, speed, and velocity of the vehicle, along with GPS coordinates, a reliable tracking algorithm can be developed based on Kalman Filtering. A careful reading of the Example application from Wikipedia mentioned earlier shows that this is the exact scenario being discussed, NOT extrapolating the location based purely on GPS readings.

The maths required to create a reliable multi-dimensional filter is beyond the scope of this article and probably overkill for most developers creating a solution to track moving assets.

Location APIs

Developers have a wide choice of location APIs depending on their chosen platform, for example, the HTML5 geolocation API for web, the Android Fused location provider, or Apple’s Core Location Framework.

Location technologies and mobile phones (where most people first encounter location hardware) have been around for a long time. It is important to understand how the technology has evolved, especially since many search results on Stack Overflow are from nearly a decade ago.

Early location APIs only returned data from a single source to your application. For example, you could request data from the GPS chip, but then it was up to you as the developer to decide how best to handle that data.

The most significant enhancement to location accuracy came by amalgamating different location sources, not from smoothing data. For example, on Android, the Fused location provider’ will amalgamate the location data from GPS with other sources such as nearby WiFi, cellular signals, and Bluetooth signals.

Do I need to smooth data from the Location API? No, high-level APIs such as those returned by Android and iOS are already smoothed and processed, so it is not necessary to apply further smoothing. Even ‘raw’ GPS data is subject to smoothing by the chip firmware that reports its data to the higher-level OS, so no benefit will be gained from smoothing it further.

If all location APIs are smoothed, why does my location still jump around?

Moving at a low speed will never give a stable position, no matter how much the data is smoothed owing to technological limitations.

If you are tracking mostly stationary assets, the best way to avoid ‘jittery’ location fixes is to ignore any small changes that the API reports. Some high-level APIs make this especially easy with dedicated methods to set the minimum update distance before a location update is triggered. This will not enhance the accuracy of the location fix but will make it appear more stable.

What if you are tracking a moving asset, and the route traced by the location fixes is not smooth? The most straightforward approach to this problem is a pragmatic one, assuming the asset you are tracking is a vehicle moving along a road, just snap its location to the most likely road they are following.

Snap to the Nearest Road / Map Matching

Google provides a set of backend Roads APIs that take care of all the difficult road network logic for you.

The Snap to Roads API will take a series of points and return the most likely route that the vehicle followed along a road or road segment:

Google Roads API

By providing a series of points to the API, it is able to disambiguate which road the vehicle followed at intersections or where the vehicle crosses flyovers and underpasses. Although the API is provided from Google it can work with any mapping provider, such as OpenStreetMap (OSM) or Mapbox.

The downside is that each client is responsible for smoothing its own location data, increasing traffic, and complicating the solution.

Snap to the Nearest Road with PubNub

Let’s say your clients are reporting their location data with PubNub by sending the last set of recorded location fixes

  pubnub.publish({
    channel: 'loc.vehicle',
    message: recordedPoints  //  Array or [{"lat":.., "lng"...}]
  })
Enter fullscreen mode Exit fullscreen mode

Create a PubNub Function

  1. Log into the PubNub admin portal and select the ‘Functions’ tab
  2. Select the application and keyset you wish to use
  3. Click ‘+ CREATE NEW MODULE’
  4. Give the module and name and description and hit ‘create’.
  5. Select the module you just created
  6. Select ‘+ CREATE NEW FUNCTION’
  7. Give the function a name and select the Before Publish or Fire event type
  8. Choose a channel name (this example uses loc.*) then hit ‘create’.
  9. This will bring you to the function creation window.
  10. Specify the test payload as follows:
[{
  "lat": -35.27801,
  "lng": 149.12958
}]
Enter fullscreen mode Exit fullscreen mode
  • Copy the following code into the function:
    • Replace the GOOGLE_API_KEY with your own Google API key. For information on setting up your own Google API Key, see the Google instructions. Please ensure that the key has the Roads API enabled.
const xhr = require('xhr');
const GOOGLE_API_KEY = "GOOGLE_API_KEY"

function roadsAPI(path) {
    var pathParam = "path="
    for (var i = 0; i < path.length; i++)
    {
        if (i > 0) {pathParam += "%7C"}
        pathParam += path[i].lat
        pathParam += "%2C"
        pathParam += path[i].lng
    }
    const url = "https://roads.googleapis.com/v1/snapToRoads?" + pathParam + "&key=" + GOOGLE_API_KEY + "&interpolate=true";
    const httpOptions = {
        method: 'GET',
    };
    return xhr.fetch(url, httpOptions).then((resp) => JSON.parse(resp.body))
}

export default (request) => {
    if (!(request.message[0].lat && request.message[0].lng))
    {
        console.log("Message does not have the expected format of {'lat':xxx,'lng':xxx}")
        return request.ok()
    }
    else
    {
    return roadsAPI(request.message)
      .then(roadsResponse => {
          console.log("Roads API response: ", roadsResponse);
          if (roadsResponse && roadsResponse.snappedPoints && roadsResponse.snappedPoints[0])
          {
            request.message = roadsResponse;
          }
          return request.ok()
      })    
    }
};
Enter fullscreen mode Exit fullscreen mode

How-to - Smooth Location Data - Image 02

How does it work?

When a PubNub Message is received containing the last known positions of the vehicle, that data is sent to the Google Snap to Roads API. The lat / long data in the original message is replaced with the lat / long data returned by the Google API, including interpolated points, before it is distributed to listening clients. This means that a client displaying the vehicle location will only draw points along the nearest road.

The demo will draw two polylines on the map to clarify what is happening, but this is not required.

Summary

Sign up for a free trial to start building your real-time location solution with PubNub today.

Need help getting started?

Questions? Feel free to reach out to the DevRel team at devrel@pubnub.com or contact our Support team for help with any aspect of your PubNub development.

How can PubNub help you?

This article was originally published on PubNub.com

Our platform helps developers build, deliver, and manage real-time interactivity for web apps, mobile apps, and IoT devices.

The foundation of our platform is the industry's largest and most scalable real-time edge messaging network. With over 15 points-of-presence worldwide supporting 800 million monthly active users, and 99.999% reliability, you'll never have to worry about outages, concurrency limits, or any latency issues caused by traffic spikes.

Experience PubNub

Check out Live Tour to understand the essential concepts behind every PubNub-powered app in less than 5 minutes

Get Setup

Sign up for a PubNub account for immediate access to PubNub keys for free

Get Started

The PubNub docs will get you up and running, regardless of your use case or SDK

. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .