Skip to main content
. 2016 May 23;16(5):749. doi: 10.3390/s16050749
Algorithm 1. Estimation of Absolute heading angle using Sun sensor and Inclinometer (EASI algorithm)
  1. Get Sun ray vector from sensor output angles.

    Ss=[SxSySz]T

  2. Transform SS to rover frame.

    Sb=[SxbSybSzb]=Csb[SxSySz]Csb=[100010001]

  3. Transform Sb to local-flat frame.

    Sn=[SxnSynSzn]=Cbn[SxbSybSzb]  Cbn=[cosθsinϕsinθcosϕsinθ0cosϕsinθsinθsinϕcosθcosϕcosθ]

  4. Get Sun’s azimuth (αSS) and elevation angles (ςss) from Sn vector as:

    αss=atan2(Syn,Sxn)ςss=sin1(Szn)

  5. Using local date, time and location (latitude, longitude), get Sun’s azimuth (αEphe.) and elevation (ςEphe.) angles from Ephemeris models.

  6. Determine rover’s absolute heading by comparing the Sun’s position in steps 4 and 5.

    ψss={αEpheαSS     if(αEphe>αSS)αSSαEphe     otherwise