GPS Coordinates – How to Calculate Bearing Between Two Decimal GPS Coordinates

algorithmcoordinatesgoogle mapsjavascript

I'm building a virtual tour application that uses custom panoramas in conjunction with Google's StreetView service. With StreetView, you can have 1 to n links at each particular location to move to, and these links are based on compass bearings.

Each panorama has an associated GPS location to six decimal places acquired via iTouchMaps. My issue is when I calculate the compass bearings from each link location, it returns a bearing that is a tiny (as in 0.00001 degree difference) from true north.

Given a map like

                       4
                       |
                       |
                       |
                       2
                       |
                       |
                       |
                       1

where each number is a location and has the following values:

1- 43.682213, -70.450696
2- 43.682194, -70.450769
4- 43.682179, -70.450837

What I'd like is a method to determine programatically that the bearing from 1 to 2 and 2 to 4 is 70 degrees, and 2 to 1 is 250 degrees. Using the code from here as a starting point, I wrote the following function

//starting lat/long along with converting degrees to radius
    var endLat = location.lat();  //for rhumb calc
    var endLong = location.lng();

    //loop over response, calculate new headings for links and add link to array
    for(var i=0; i<data.length; i++){
      //this link's lat/long coordinates
      var startLat = data[i].lat;
      var startLong = data[i].lon;

      //get the delta values between start and end coordinates
      var dLong = endLong - startLong;

      //calculate rhumb bearing to
      var dPhi = Math.log(Math.tan(endLat/2+Math.PI/4)/Math.tan(startLat/2+Math.PI/4));
      if (Math.abs(dLong) > Math.PI ) dLong = dLong > 0 ? -(2*Math.PI-dLong) : (2*Math.PI+dLong);
      var bearing = (toDeg(Math.atan(dLong, dPhi)) + 360) % 360;

Using the above function and substituting

location for position 2
data[0] for position 1
data[1] for position 4

I get the bearings

359.9958174081038 degrees to 4 (should be 70 degrees)

and 

0.0038961130024404156 degrees to 1 (should be 250)

Why is this function returning such different values than expected?

Best Answer

To save you some time here is @MerseyViking answer in javascript:

function radians(n) {
  return n * (Math.PI / 180);
}
function degrees(n) {
  return n * (180 / Math.PI);
}

function getBearing(startLat,startLong,endLat,endLong){
  startLat = radians(startLat);
  startLong = radians(startLong);
  endLat = radians(endLat);
  endLong = radians(endLong);

  var dLong = endLong - startLong;

  var dPhi = Math.log(Math.tan(endLat/2.0+Math.PI/4.0)/Math.tan(startLat/2.0+Math.PI/4.0));
  if (Math.abs(dLong) > Math.PI){
    if (dLong > 0.0)
       dLong = -(2.0 * Math.PI - dLong);
    else
       dLong = (2.0 * Math.PI + dLong);
  }

  return (degrees(Math.atan2(dLong, dPhi)) + 360.0) % 360.0;
}
Related Question