Subversion Repositories FlightCtrl

Rev

Rev 747 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 747 Rev 752
Line 105... Line 105...
105
 
105
 
106
 
106
 
107
void GPS_Main(void)
107
void GPS_Main(void)
108
{
-
 
-
 
108
{
Line 109... Line 109...
109
        static uint8_t GPS_Task = TSK_IDLE;
109
        static uint8_t GPS_Task = TSK_IDLE;
110
 
110
        int16_t satbeep;
111
 
111
 
112
        // poti2 enables the gps feature
112
        // poti2 enables the gps feature
Line 117... Line 117...
117
 
117
 
118
        switch(GPSInfo.status)
118
        switch(GPSInfo.status)
119
        {
119
        {
120
        case INVALID:  // invalid gps data
120
        case INVALID:  // invalid gps data
-
 
121
                GPS_Neutral();
-
 
122
                if(GPS_Task != TSK_IDLE)
121
                GPS_Neutral();
123
                {
-
 
124
                        BeepTime = 100; // beep if signal is neccesary
122
                if(GPS_Task != TSK_IDLE) BeepTime = 50; // beep if signal is neccesary
125
                }
123
                break;
126
                break;
124
        case PROCESSED: // if gps data are already processed
127
        case PROCESSED: // if gps data are already processed
125
                // downcount timeout
128
                // downcount timeout
126
                if(GPSTimeout) GPSTimeout--;
129
                if(GPSTimeout) GPSTimeout--;
Line 197... Line 200...
197
                } // eof 3D-FIX
200
                } // eof 3D-FIX
Line 198... Line 201...
198
 
201
 
199
                else // no 3D-SATFIX
202
                else // no 3D-SATFIX
200
                {       // disable gps control
203
                {       // disable gps control
201
                        GPS_Neutral();
204
                        GPS_Neutral();
-
 
205
                        if(GPS_Task != TSK_IDLE)
-
 
206
                        {
-
 
207
                                satbeep = 2048 - (int16_t)GPSInfo.satnum * 256; // is zero at 8 sats
-
 
208
                                if (satbeep < 0) satbeep = 0;
-
 
209
                                BeepTime = 50 + (uint16_t)satbeep;
202
                        if(GPS_Task != TSK_IDLE) BeepTime = 50;
210
                        }
203
                }
-
 
204
 
211
                }
205
                // set current data as processed to avoid further calculations on the same gps data
212
                // set current data as processed to avoid further calculations on the same gps data
206
                GPSInfo.status = PROCESSED;
213
                GPSInfo.status = PROCESSED;
207
                break;
214
                break;
208
        } // eof GPSInfo.status
215
        } // eof GPSInfo.status