Trilateration using 3 latitude and longitude points, and 3 distances

by

Wikipedia gives a pretty thorough discussion of the algebra here:
http://en.wikipedia.org/wiki/Trilateration

The first step, not really covered in the Wikipedia entry, is to convert your lat/long coordinates to Cartesian coordinates:

x0 = cos( lon0 ) * cos( lat0 ) , y0 = sin( lon0 ) * cos( lat0 ) , z0 = sin( lat0 )
x1 = cos( lon1 ) * cos( lat0 ) , y1 = sin( lon1 ) * cos( lat1 ) , z1 = sin( lat1 )
x2 = cos( lon2 ) * cos( lat0 ) , y2 = sin( lon2 ) * cos( lat2 ) , z2 = sin( lat2 )

(To keep calculations simple, I’ve fudged things so we are working in units of “earth radii” instead of kilometers)

For your data, I get

         p0            p1           p2
X   -0.420442596  -0.420430618  -0.42040255
Y   -0.67380418   -0.673826567  -0.673825967
Z    0.607631426   0.607614889   0.607634975

The next step, which is covered in the Wikipedia article, is to simplify the coordinates, by translating the points so p0 is at the origin, and then rotating so that p1 is on the X axis, and p2 is in the X-Y plane.

For the translation, just subtract p0 from p1 and p2:

    p0a      p1a          p2a
X   0    1.19779E-05   4.00462E-05
Y   0   -2.23864E-05  -2.17865E-05
Z   0   -1.65372E-05   3.5486E-06

The rotation isn’t much harder. p1b gets (x,y) = (d,0), where d is just the distance from the origin to p1a (Pythagorean theorem)

For p2b, we need to resolve p2a into two components: one parallel to p1a (which goes on our x axis), and one perpendicular to p1a, (which goes on our y axis in the “b” coordinate system).

To do this, we need a unit vector in the direction of p1a, which is just p1a * ( 1/d ). Take the dot product of this unit vector (call it p1a_hat, if you like) with p2a, and that’s the X coordinate for p2b. The Wikipedia article calls this value “I”

Now the Y coordinate is easy. The length from the origin to p2 can’t change under the coordinate transformation. So calculate p2a’s length using the Pythagorean theorem, then use the Pythagorean theorem “backwards” to get what the Y coordinate for p2b has to be to keep the length the same. That’s the variable that Wikipedia calls “J”. (Note, there’s an ambiguity that I’ll leave for you to figure out over whether J is positive or negative).

Now you’ve got the three variables d, I and J, that the Wikipedia article uses for the calculation. You can convert them back to kilometers now, by multiplying by the earth’s radius. You should be able to do the rest of the calculation from here

(Incidentally, Wikipedia gives a different calculation for the coordinate transformation. I like to avoid trig where possible).

More Related Contents:

  1. How to convert an address to a latitude/longitude?
  2. How can I measure distance and create a bounding box based on two latitude+longitude points in Java?
  3. Calculating Distance between two Latitude and Longitude GeoCoordinates
  4. How to calculate the bounding box for a given lat/lng location?
  5. How can I get city name from a latitude and longitude point?
  6. What datatype to use when storing latitude and longitude data in SQL databases? [duplicate]
  7. Converting Longitude & Latitude to X Y on a map with Calibration points
  8. Get latitude and longitude based on location name with Google Autocomplete API
  9. Polygon area calculation using Latitude and Longitude generated from Cartesian space and a world file
  10. Getting distance between two points based on latitude/longitude
  11. Calculating distance between two geographic locations
  12. Find distance between two points using latitude and longitude in mysql
  13. Given the lat/long coordinates, how can we find out the city/country?
  14. Using Address Instead Of Longitude And Latitude With Google Maps API
  15. R – Finding closest neighboring point and number of neighbors within a given radius, coordinates lat-long
  16. Calculate distance in meters when you know longitude and latitude in java [duplicate]
  17. Get lat/long given current point, distance and bearing
  18. Latitude Longitude Coordinates to State Code in R
  19. Google Maps: how to get country, state/province/region, city given a lat/long value?
  20. Calculate distance between Zip Codes… AND users.
  21. How to GeoCode a simple address using Data Science Toolbox
  22. mySQL longitude and latitude query for other rows within x mile radius
  23. Converting longitude/latitude to X/Y coordinate
  24. Calculating bounding box a certain distance away from a lat/long coordinate in Java
  25. iOS – MKMapView place annotation by using address instead of lat / long
  26. How to find my distance to a known location in JavaScript
  27. Whats the fastest way to lookup big tables for points within radius MySQL (latitude longitude)
  28. How do i return coordinates after forward geocoding?
  29. get city from geocoder results?
  30. Getting GPS data from an image’s EXIF in C#

Leave a Comment