Subversion Repositories FlightCtrl

Rev

Rev 1805 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1805 Rev 1821
Line 79... Line 79...
79 
 
 79 
 
80 
#define DISPLAYBUFFSIZE 80
 80 
#define DISPLAYBUFFSIZE 80
81 
int8_t DisplayBuff[DISPLAYBUFFSIZE] = "Hello World";
 81 
int8_t DisplayBuff[DISPLAYBUFFSIZE] = "Hello World";
Line 82... Line -...
82 
uint8_t DispPtr = 0;
 - 
 
83 
 
 82 
uint8_t DispPtr = 0;
84 
 
 83 
 
85 
/************************************/
 84 
/************************************/
86 
/*        Clear LCD Buffer          */
 85 
/*        Clear LCD Buffer          */
87 
/************************************/
 86 
/************************************/
88 
void LCD_Clear(void) {
 87 
void LCD_Clear(void) {
- 
 
 88 
        uint8_t i;
89 
 uint8_t i;
 89 
        for (i = 0; i < DISPLAYBUFFSIZE; i++)
Line 90... Line -...
90 
 for( i = 0; i < DISPLAYBUFFSIZE; i++) DisplayBuff[i] = ' ';
 - 
 
91 
}
 90 
                DisplayBuff[i] = ' ';
92 
 
 91 
}
93 
 
 92 
 
94 
/************************************/
 93 
/************************************/
95 
/*        Update Menu on LCD        */
 94 
/*        Update Menu on LCD        */
242 
    if(motor[11].Present) LCD_printfxy(12,3,"12");
 252 
                        LCD_printfxy(12,3,"12");
243 
    break;
 253 
                break;
244 
   
 254 
 
245 
#if (defined (USE_NAVICTRL))
 255 
#if (defined (USE_NAVICTRL))
246 
  case 14://GPS Lat/Lon coords
 256 
                case 14://GPS Lat/Lon coords
247 
    if (GPSInfo.status == INVALID) {
 257 
                if (GPSInfo.status == INVALID) {
248 
      LCD_printfxy(0,0,"No GPS data!");
 258 
                        LCD_printfxy(0,0,"No GPS data!");
249 
    } else {
 259 
                } else {
250 
      switch (GPSInfo.satfix)
 260 
                        switch (GPSInfo.satfix)
251 
        {
 261 
                        {
252 
        case SATFIX_NONE:
 262 
                                case SATFIX_NONE:
253 
          LCD_printfxy(0,0,"Sats: %d Fix: No", GPSInfo.satnum);
 263 
                                LCD_printfxy(0,0,"Sats: %d Fix: No", GPSInfo.satnum);
254 
          break;
 264 
                                break;
255 
        case SATFIX_2D:
 265 
                                case SATFIX_2D:
256 
          LCD_printfxy(0,0,"Sats: %d Fix: 2D", GPSInfo.satnum);
 266 
                                LCD_printfxy(0,0,"Sats: %d Fix: 2D", GPSInfo.satnum);
- 
 
 267 
                                break;
- 
 
 268 
                                case SATFIX_3D:
- 
 
 269 
                                LCD_printfxy(0,0,"Sats: %d Fix: 3D", GPSInfo.satnum);
- 
 
 270 
                                break;
- 
 
 271 
                                default:
- 
 
 272 
                                LCD_printfxy(0,0,"Sats: %d Fix: ??", GPSInfo.satnum);
- 
 
 273 
                                break;
- 
 
 274 
                        }
- 
 
 275 
                        int16_t i1,i2,i3;
- 
 
 276 
                        i1 = (int16_t)(GPSInfo.longitude/10000000L);
- 
 
 277 
                        i2 = abs((int16_t)((GPSInfo.longitude%10000000L)/10000L));
- 
 
 278 
                        i3 = abs((int16_t)(((GPSInfo.longitude%10000000L)%10000L)/10L));
- 
 
 279 
                        LCD_printfxy(0,1,"Lon: %d.%03d%03d deg",i1, i2, i3);
- 
 
 280 
                        i1 = (int16_t)(GPSInfo.latitude/10000000L);
- 
 
 281 
                        i2 = abs((int16_t)((GPSInfo.latitude%10000000L)/10000L));
- 
 
 282 
                        i3 = abs((int16_t)(((GPSInfo.latitude%10000000L)%10000L)/10L));
- 
 
 283 
                        LCD_printfxy(0,2,"Lat: %d.%03d%03d deg",i1, i2, i3);
- 
 
 284 
                        i1 = (int16_t)(GPSInfo.altitude/1000L);
257 
          break;
 285 
                        i2 = abs((int16_t)(GPSInfo.altitude%1000L));
- 
 
 286 
                        LCD_printfxy(0,3,"Alt: %d.%03d m",i1, i2);
- 
 
 287 
                }
258 
        case SATFIX_3D:
 288 
                break;
259 
          LCD_printfxy(0,0,"Sats: %d Fix: 3D", GPSInfo.satnum);
 289 
#endif
- 
 
 290 
 
260 
          break;
 291 
        default:
261 
        default:
 292 
                MaxMenuItem = MenuItem - 1;
262 
          LCD_printfxy(0,0,"Sats: %d Fix: ??", GPSInfo.satnum);
 - 
 
263 
          break;
 - 
 
264 
        }
 - 
 
265 
      int16_t i1,i2,i3;
 - 
 
266 
      i1 = (int16_t)(GPSInfo.longitude/10000000L);
 - 
 
267 
      i2 = abs((int16_t)((GPSInfo.longitude%10000000L)/10000L));
 - 
 
268 
      i3 = abs((int16_t)(((GPSInfo.longitude%10000000L)%10000L)/10L));
 - 
 
269 
      LCD_printfxy(0,1,"Lon: %d.%03d%03d deg",i1, i2, i3);
 - 
 
270 
      i1 = (int16_t)(GPSInfo.latitude/10000000L);
 - 
 
271 
      i2 = abs((int16_t)((GPSInfo.latitude%10000000L)/10000L));
 - 
 
272 
      i3 = abs((int16_t)(((GPSInfo.latitude%10000000L)%10000L)/10L));
 - 
 
273 
      LCD_printfxy(0,2,"Lat: %d.%03d%03d deg",i1, i2, i3);
 - 
 
274 
      i1 = (int16_t)(GPSInfo.altitude/1000L);
 - 
 
275 
      i2 = abs((int16_t)(GPSInfo.altitude%1000L));
 - 
 
276 
      LCD_printfxy(0,3,"Alt: %d.%03d m",i1, i2);
 - 
 
277 
    }
 - 
 
278 
    break;
 - 
 
279 
#endif
 - 
 
280 
   
 - 
 
281 
  default:
 - 
 
282 
    MaxMenuItem = MenuItem - 1;
 - 
 
283 
    MenuItem = 0;
 293 
                MenuItem = 0;
284 
    break;
 294 
                break;