Subversion Repositories NaviCtrl

Rev

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

Rev 500 Rev 502
Line 358... Line 358...
358
                        LCD_printfxy(0,2,"GyroYaw:   %4i", FromFlightCtrl.GyroYaw);
358
                        LCD_printfxy(0,2,"GyroYaw:   %4i", FromFlightCtrl.GyroYaw);
359
                        if(FC_is_Calibrated)    LCD_printfxy(0,3,"Calibrated    ")
359
                        if(FC_is_Calibrated)    LCD_printfxy(0,3,"Calibrated    ")
360
                        else                                    LCD_printfxy(0,3,"not calibrated");
360
                        else                                    LCD_printfxy(0,3,"not calibrated");
361
                        break;
361
                        break;
362
                case 15:
362
                case 15:
363
//                      LCD_printfxy(0,0,"Ubat:   %2i.%1i V", FC.BAT_Voltage/10, FC.BAT_Voltage%10);
-
 
364
                        LCD_printfxy(0,0,"Compass:    %3i", FromFlightCtrl.GyroHeading / 10);
363
                        LCD_printfxy(0,0,"Compass:    %3i", FromFlightCtrl.GyroHeading / 10);
365
                        LCD_printfxy(0,1,"Man.-Offset:%3i", FC.FromFC_CompassOffset / 10);
364
                        LCD_printfxy(0,1,"Man.-Offset:%3i", FC.FromFC_CompassOffset / 10);
366
                        if(FC.FromFC_DisableDeclination)
365
                        if(FC.FromFC_DisableDeclination)
367
                        {
366
                        {
368
                                LCD_printfxy(0,2,"Mag.Declinat.:disabl");
367
                                LCD_printfxy(0,2,"Mag.Declinat.:disabl");
Line 461... Line 460...
461
                case 22:
460
                case 22:
462
                        LCD_printfxy(0,0,"BL Current" );
461
                        LCD_printfxy(0,0,"BL Current" );
463
                        LCD_printfxy(11,3,"(in 0.1A)" );
462
                        LCD_printfxy(11,3,"(in 0.1A)" );
464
                        for(i1 = 0; i1 < 3; i1++)
463
                        for(i1 = 0; i1 < 3; i1++)
465
                        {
464
                        {
466
                     LCD_printfxy(0,i1+1,"%3d %3d %3d %3d ",BL3_Current(i1*4),BL3_Current(i1*4+1),BL3_Current(i1*4+2),BL3_Current(i1*4+3));
465
                                LCD_printfxy(0,i1+1,"%3d %3d %3d %3d ",BL3_Current(i1*4),BL3_Current(i1*4+1),BL3_Current(i1*4+2),BL3_Current(i1*4+3));
467
                         if(Motor[4 + i1 * 4].State == 0) break;
466
                                if(Motor[4 + i1 * 4].State == 0) break;
468
                        }
467
                        }
469
                        break;
468
                        break;
Line 470... Line 469...
470
 
469
 
471
                case 23:
470
                case 23:
Line 497... Line 496...
497
                                if(Keys & KEY4)
496
                                if(Keys & KEY4)
498
                                {
497
                                {
499
                                        WPL_Store.Index = index;
498
                                        WPL_Store.Index = index;
500
                                        if(PointList_ReadFromFile(&WPL_Store) == WPL_OK)
499
                                        if(PointList_ReadFromFile(&WPL_Store) == WPL_OK)
501
                                        {                      
500
                                        {                      
502
                                     if(FC.StatusFlags & FC_STATUS_FLY) PointList_WPActive(TRUE);
501
                                                if(FC.StatusFlags & FC_STATUS_FLY) PointList_WPActive(TRUE);
503
                                 GPS_pWaypoint = PointList_WPBegin(); // updates POI index
502
                                                GPS_pWaypoint = PointList_WPBegin(); // updates POI index
504
                                     BeepTime = 150;
503
                                                BeepTime = 150;
505
                                    }
504
                                    }
506
                                }
505
                                }
507
                                LCD_printfxy(0,0,"Load WPL" );
506
                                LCD_printfxy(0,0,"Load WPL" );
508
                                LCD_printfxy(0,1,"Name: %s", WPL_Store.Name);
507
                                LCD_printfxy(0,1,"Name: %s", WPL_Store.Name);
509
                                //                12345678901234567890
508
                                //                12345678901234567890