Skip to main content
. 2018 Jul 3;18(7):2142. doi: 10.3390/s18072142
Algorithm 2 Location mapping/translation.
  •  1:

    λbase,γbase,θbase              ▹ Latitude, longitude, compass direction of base coordinate system

  •  2:

    For every position update, do:

  •  3:

    [xnew,ynew][XValue,YValue]

  •  4:

    ifλref=nullthen                        ▹ First position update for the technology

  •  5:

    [λref,γref,θref,altituderef]retrieveReferencePoint()

  •  6:

    earthRadiusgetRadius(λref,altituderef)                 ▹ [6356.752km : 6378.137km]

  •  7:

    Δλλrefπ/180λbaseπ/180

  •  8:

    Δγγrefπ/180γbaseπ/180

  •  9:

    β=sin2(Δλ/2)+cos(λbaseπ/180)cos(λrefπ/180)sin(δγ/2)sin(Δγ/2)

  • 10:

    ϵ=2atan2(β2,1β2)

  • 11:

    distanceearthRadiusϵ1000

  • 12:

    bearingatan2(cos(λbase)sin(λref)sin(λbase)cos(λref)cos(γrefγbase),sin(γrefγbase)cos(λref))

  • 13:

    xoffsetdistancesin(bearing))

  • 14:

    yoffsetdistancecos(bearing))

  • 15:

    Δθθrefθbase

  • 16:

    end if

  • 17:

    xmappedxnewcos(Δθ)ynewsin(Δθ)+xoffset

  • 18:

    ymappedxnewsin(Δθ)+ynewcos(Δθ)+yoffset

  • 19:

    plot(xmapped,ymapped)                          ▹ Mapped/translated location data

  • 20:

    return