Subversion Repositories FlightCtrl

Rev

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

Rev 711 Rev 722
Line 46... Line 46...
46
/*        Update Menu on LCD        */
46
/*        Update Menu on LCD        */
47
/************************************/
47
/************************************/
48
// Display with 20 characters in 4 lines
48
// Display with 20 characters in 4 lines
49
void LCD_PrintMenu(void)
49
void LCD_PrintMenu(void)
50
 {
50
 {
51
  static uint8_t MaxMenuItem = 14, MenuItem=0;
51
  static uint8_t MaxMenuItem = 16, MenuItem=0;
Line 52... Line 52...
52
 
52
 
53
  //  if KEY1 is activated goto previous menu item
53
  //  if KEY1 is activated goto previous menu item
54
  if(RemoteButtons & KEY1)
54
  if(RemoteButtons & KEY1)
55
  {
55
  {
Line 180... Line 180...
180
                        LCD_printfxy(0,0,"MM3 Range");
180
                        LCD_printfxy(0,0,"MM3 Range");
181
                        LCD_printfxy(0,1,"X_Range:  %4i",MM3_calib.X_range);
181
                        LCD_printfxy(0,1,"X_Range:  %4i",MM3_calib.X_range);
182
                        LCD_printfxy(0,2,"Y_Range:  %4i",MM3_calib.Y_range);
182
                        LCD_printfxy(0,2,"Y_Range:  %4i",MM3_calib.Y_range);
183
                        LCD_printfxy(0,3,"Z_Range:  %4i",MM3_calib.Z_range);
183
                        LCD_printfxy(0,3,"Z_Range:  %4i",MM3_calib.Z_range);
184
                        break;
184
                        break;
185
        case 14://GPS Status
185
        case 14://GPS Lat/Lon coords
186
                        LCD_printfxy(0,0,"GPS Status");
-
 
187
                        if (GPSInfo.status == INVALID)
186
                        if (GPSInfo.status == INVALID)
188
                        {
187
                        {
189
                                LCD_printfxy(0,1,"No data available!");
188
                                LCD_printfxy(0,0,"No data available!");
190
                        }
189
                        }
191
                        else
190
                        else
192
                        {
191
                        {
193
                                switch (GPSInfo.satfix)
192
                                switch (GPSInfo.satfix)
194
                                {
193
                                {
195
                                case SATFIX_NONE:
194
                                case SATFIX_NONE:
196
                                        LCD_printfxy(0,1,"Satfix:   None");
195
                                        LCD_printfxy(0,0,"Satfix:   None ");
197
                                        break;
196
                                        break;
198
                                case SATFIX_2D:
197
                                case SATFIX_2D:
199
                                        LCD_printfxy(0,1,"Satfix:   2D");
198
                                        LCD_printfxy(0,0,"Satfix:   2D   ");
200
                                        break;
199
                                        break;
201
                                case SATFIX_3D:
200
                                case SATFIX_3D:
202
                                        LCD_printfxy(0,1,"Satfix:   3D");
201
                                        LCD_printfxy(0,0,"Satfix:   3D   ");
203
                                        break;
202
                                        break;
204
                                default:
203
                                default:
205
                                        LCD_printfxy(0,1,"Satfix: Unknown");
204
                                        LCD_printfxy(0,0,"Satfix: Unknown");
206
                                        break;
205
                                        break;
207
                                }
206
                                }
-
 
207
                                LCD_printfxy(0,1,"Lon: %d.%d deg",GPSInfo.longitude/10000000L, (int16_t)(GPSInfo.longitude/100000L)%100);
-
 
208
                                LCD_printfxy(0,2,"Lat: %d.%d deg",GPSInfo.latitude/10000000L, GPSInfo.latitude%10000000L);
-
 
209
                                LCD_printfxy(0,3,"Alt: %d.%d m",GPSInfo.altitude/1000L,GPSInfo.altitude%1000L);
208
                        }
210
                        }
209
                        break;
211
                        break;
-
 
212
        case 15://GPS UTM coords
-
 
213
                        if (GPSInfo.status == INVALID)
-
 
214
                        {
-
 
215
                                LCD_printfxy(0,0,"No data available!");
-
 
216
                        }
-
 
217
                        else
-
 
218
                        {
-
 
219
                                switch (GPSInfo.satfix)
-
 
220
                                {
-
 
221
                                case SATFIX_NONE:
-
 
222
                                        LCD_printfxy(0,0,"No Satfix      ");
-
 
223
                                        break;
-
 
224
                                case SATFIX_2D:
-
 
225
                                        LCD_printfxy(0,0,"Satfix:   2D   ");
-
 
226
                                        break;
-
 
227
                                case SATFIX_3D:
-
 
228
                                        LCD_printfxy(0,0,"Satfix:   3D   ");
-
 
229
                                        break;
-
 
230
                                default:
-
 
231
                                        LCD_printfxy(0,0,"Unknown Satfix ");
-
 
232
                                        break;
-
 
233
                                }
-
 
234
                                LCD_printfxy(0,1,"N: %d",(int16_t)(GPSInfo.utmnorth/100L));
-
 
235
                                LCD_printfxy(0,2,"E: %d",(int16_t)(GPSInfo.utmeast/100L));
-
 
236
                                LCD_printfxy(0,3,"A: %d",(int16_t)(GPSInfo.utmalt/100L));
-
 
237
                        }
-
 
238
                        break;
-
 
239
        case 16://GPS UTM velocity
-
 
240
                                if (GPSInfo.status == INVALID)
-
 
241
                                {
-
 
242
                                        LCD_printfxy(0,0,"No data available!");
-
 
243
                                }
-
 
244
                                else
-
 
245
                                {
-
 
246
                                        switch (GPSInfo.satfix)
-
 
247
                                        {
-
 
248
                                        case SATFIX_NONE:
-
 
249
                                                LCD_printfxy(0,0,"No Satfix      ");
-
 
250
                                                break;
-
 
251
                                        case SATFIX_2D:
-
 
252
                                                LCD_printfxy(0,0,"Satfix:   2D   ");
-
 
253
                                                break;
-
 
254
                                        case SATFIX_3D:
-
 
255
                                                LCD_printfxy(0,0,"Satfix:   3D   ");
-
 
256
                                                break;
-
 
257
                                        default:
-
 
258
                                                LCD_printfxy(0,0,"Unknown Satfix ");
-
 
259
                                                break;
-
 
260
                                        }
-
 
261
                                        LCD_printfxy(0,1,"VN: %d",GPSInfo.velnorth);
-
 
262
                                        LCD_printfxy(0,2,"VE: %d",GPSInfo.veleast);
-
 
263
                                        LCD_printfxy(0,3,"VA: %d",GPSInfo.veltop);
-
 
264
                                }
-
 
265
                        break;
210
    default: MaxMenuItem = MenuItem - 1;
266
    default: MaxMenuItem = MenuItem - 1;
211
             MenuItem = 0;
267
             MenuItem = 0;
212
           break;
268
           break;
213
    }
269
    }
214
 RemoteButtons = 0;
270
 RemoteButtons = 0;