Ejemplo n.º 1
0
        /// <summary>
        /// Handle GPS GPGSA Notifications - Precision - GPS receiver operating mode
        /// </summary>
        /// <param name="notification">GPGSA packet notification</param>
        private void GpGsaHandler(gps.GpGsaNotification notification)
        {
            /*
             *  GSA - GPS DOP and active satellites. This sentence provides details on the nature of the fix.
             *        It includes the numbers of the satellites being used in the current solution and the DOP.
             *        DOP (dilution of precision) is an indication of the effect of satellite geometry on the accuracy of the fix.
             *        It is a unitless number where smaller is better. For 3D fixes using 4 satellites a 1.0 would be considered to be a perfect number, however for overdetermined solutions it is possible to see numbers below 1.0.
             *
             *  There are differences in the way the PRN's are presented which can effect the ability of some programs to display this data.
             *  For example, in the example shown below there are 5 satellites in the solution and the null fields are scattered indicating that the almanac would show satellites in the null positions that are not being used as part of this solution.
             *  Other receivers might output all of the satellites used at the beginning of the sentence with the null field all stacked up at the end.
             *  This difference accounts for some satellite display programs not always being able to display the satellites being tracked.
             *  Some units may show all satellites that have ephemeris data without regard to their use as part of the solution but this is non-standard.
             *
             *    $GPGSA,A,3,04,05,,09,12,,,24,,,,,2.5,1.3,2.1*39
             *
             *  Where:
             *       GSA      Satellite status
             *       A        Auto selection of 2D or 3D fix (M = manual)
             *       3        3D fix - values include: 1 = no fix
             *                                         2 = 2D fix
             *                                         3 = 3D fix
             *       04,05... PRNs of satellites used for fix (space for 12)
             *       2.5      PDOP (dilution of precision)
             *       1.3      Horizontal dilution of precision (HDOP)
             *       2.1      Vertical dilution of precision (VDOP)
             * 39      the checksum data, always begins with *
             */

            if (!_mapperVicinity.robotState.ignoreGps)
            {
                if (!notification.Body.IsValid)
                {
                    Tracer.Error("the GPS reported GPGSA with IsValid=false");
                }
                else
                {
                    if (traceGps)
                    {
                        Tracer.Trace(string.Format("the GPS reported GPGSA: {0} Precision: {1}  Mode: {2}", notification.Body.LastUpdate, notification.Body.HorizontalDilutionOfPrecision, notification.Body.Mode));
                    }

                    GpsState state = _state.gpsState;

                    // Status (like "2D Fix"):
                    state.GPGSA_Status = notification.Body.Status;

                    // Mode (like "Fix2D"):
                    state.GPGSA_Mode = notification.Body.Mode;

                    // Position Dilution Of Precision:
                    state.GPGSA_SphericalDilutionOfPrecision = notification.Body.SphericalDilutionOfPrecision;

                    // Horizontal Dilution Of Precision:
                    state.GPGSA_HorizontalDilutionOfPrecision = notification.Body.HorizontalDilutionOfPrecision;

                    // Vertical Dilution Of Precision:
                    state.GPGSA_VerticalDilutionOfPrecision = notification.Body.VerticalDilutionOfPrecision;

                    // Last Updated:
                    state.GPGSA_LastUpdate = notification.Body.LastUpdate;

                    if (!_testBumpMode && !_state.Dropping && !_doUnitTest)
                    {
                        Decide(SensorEventSource.Gps);
                    }
                }
            }
        }
Ejemplo n.º 2
0
 /// <summary>
 /// Handle GPS GPGSA Notifications - Precision
 /// </summary>
 /// <param name="notification">GPGSA packet notification</param>
 private void GpGsaHandler(gps.GpGsaNotification notification)
 {
     Tracer.Trace(string.Format("the GPS reported GPGSA: {0} Precision: {1}  Mode: {2}", notification.Body.LastUpdate, notification.Body.HorizontalDilutionOfPrecision, notification.Body.Mode));
 }