Subversion Repositories FlightCtrl

Rev

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

Rev 1512 Rev 1517
Line 16... Line 16...
16
#define JetiBox_printf(format, args...)        {  _printf_P(&LIBFC_JetiBox_Putchar, PSTR(format) , ## args);}
16
#define JetiBox_printf(format, args...)        {  _printf_P(&LIBFC_JetiBox_Putchar, PSTR(format) , ## args);}
Line 17... Line 17...
17
 
17
 
18
// -----------------------------------------------------------
18
// -----------------------------------------------------------
19
// the menu functions
19
// the menu functions
20
// -----------------------------------------------------------
-
 
21
#define JETI_MENU_FCINFO 0
-
 
22
void mfc0(uint8_t key)
-
 
23
{
-
 
24
        JetiBox_printfxy(0,0,"+ Flight-Ctrl + ");
-
 
25
        JetiBox_printfxy(0,1,"HW:%d.%d SW:%d.%d%c",PlatinenVersion/10,PlatinenVersion%10,VERSION_MAJOR, VERSION_MINOR, VERSION_PATCH+'a');
-
 
26
}
-
 
27
/*
-
 
28
#define JETI_MENU_VOLT_RC 1
-
 
29
void mfc1(uint8_t key)
-
 
30
{
-
 
31
        JetiBox_printfxy(0,0,"Volt    RC-Level");
-
 
32
        JetiBox_printfxy(0,1,"%2i.%1iV   %03i",UBat/10, UBat%10, SenderOkay);
-
 
33
}
-
 
34
*/
-
 
35
#define JETI_MENU_HEIGHT 2
-
 
36
void mfc2(uint8_t key)
-
 
37
{
-
 
38
        if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)
-
 
39
        {
-
 
40
         JetiBox_printfxy(11,1,"%4im", (int16_t)(HoehenWert/100));
-
 
41
        }
-
 
Line -... Line 20...
-
 
20
// -----------------------------------------------------------
-
 
21
 
42
        JetiBox_printfxy(0,0,"%2i.%1iV",UBat/10, UBat%10);
22
void Menu_Status(uint8_t key)
43
 
23
{                                               //0123456789ABCDEF
44
        JetiBox_printfxy(0,1,"%4i  %2i:%02i",Capacity.UsedCapacity,FlugSekunden/60,FlugSekunden%60);
24
        JetiBox_printfxy(0,0,"%2i.%1iV",UBat/10, UBat%10);
45
        if(NaviDataOkay)
25
        if(NaviDataOkay)
-
 
26
        {
-
 
27
                JetiBox_printfxy(7,0,"%03dm %03d%c", GPSInfo.HomeDistance/10,GPSInfo.HomeBearing, 0xDF);
-
 
28
        }
-
 
29
        else
-
 
30
        {
-
 
31
                JetiBox_printfxy(7,0,"Status");
-
 
32
        }
-
 
33
        JetiBox_printfxy(0,1,"%4i  %2i:%02i",Capacity.UsedCapacity,FlugSekunden/60,FlugSekunden%60);
-
 
34
        if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)
46
        {
35
        {
47
         JetiBox_printfxy(7,0,"%03dm %03d%c", GPSInfo.HomeDistance/10,GPSInfo.HomeBearing, 0xDF);
-
 
48
        }
-
 
49
        else
-
 
50
        JetiBox_printfxy(7,0,"Status");
36
                JetiBox_printfxy(11,1,"%4im", (int16_t)(HoehenWert/100));
51
 
-
 
52
}
-
 
53
#define JETI_MENU_ATTITUDE 3
37
        }
-
 
38
}
-
 
39
 
54
void mfc3(uint8_t key)
40
void Menu_Attitude(uint8_t key)
55
{
41
{                       //0123456789ABCDEF
56
        JetiBox_printfxy(0,0,"Nick Roll  Yaw");
42
        JetiBox_printfxy(0,0,"Nick Roll  Yaw");
57
        JetiBox_printfxy(0,1,"%4i %4i %4i", (int16_t)(IntegralNick/1024), (int16_t)(IntegralRoll/1024), (int16_t)(ErsatzKompass / GIER_GRAD_FAKTOR));
-
 
-
 
43
        JetiBox_printfxy(0,1,"%4i %4i %4i", (int16_t)(IntegralNick/1024), (int16_t)(IntegralRoll/1024), (int16_t)(ErsatzKompass / GIER_GRAD_FAKTOR));
58
}
44
}
59
#define JETI_MENU_AKKU 4
45
 
60
void mfc4(uint8_t key)
46
void Menu_Battery(uint8_t key)
61
{                       //0123456789ABCDEF
47
{                       //0123456789ABCDEF
62
        JetiBox_printfxy(0,0," [V]  [A]  [mAh]");
48
        JetiBox_printfxy(0,0," [V]  [A]  [mAh]");
Line 63... Line -...
63
        JetiBox_printfxy(0,1,"%2i.%1i %2i.%1i %6i",UBat/10, UBat%10, Capacity.ActualCurrent/10, Capacity.ActualCurrent%10, Capacity.UsedCapacity);
-
 
64
}
-
 
65
 
49
        JetiBox_printfxy(0,1,"%2i.%1i %2i.%1i %6i",UBat/10, UBat%10, Capacity.ActualCurrent/10, Capacity.ActualCurrent%10, Capacity.UsedCapacity);
66
 
50
}
67
#define JETI_MENU_NCINFO 5
-
 
68
void mnc1(uint8_t key)
51
 
69
{
52
void Menu_PosInfo(uint8_t key)
-
 
53
{
-
 
54
        if(NaviDataOkay)
-
 
55
        {
-
 
56
                JetiBox_printfxy(0,0,"Sat:%02d", GPSInfo.NumOfSats);
-
 
57
                switch (GPSInfo.SatFix)
-
 
58
                {
-
 
59
                        case SATFIX_NONE:
-
 
60
                                JetiBox_printfxy(6,0,"NoFix");
-
 
61
                                break;
-
 
62
                        case SATFIX_2D:
-
 
63
                                JetiBox_printfxy(6,0,"2DFix");
-
 
64
                                break;
-
 
65
                        case SATFIX_3D:
-
 
66
                                JetiBox_printfxy(6,0,"3DFix");
-
 
67
                                break;
-
 
68
                        default:
-
 
69
                                JetiBox_printfxy(6,0,"??Fix");
-
 
70
                                break;
-
 
71
                }
-
 
72
                if(GPSInfo.Flags & FLAG_DIFFSOLN)
70
        JetiBox_printfxy(1,0,"+ Navi-Ctrl +");
73
                {
71
        if(NaviDataOkay)
74
                        JetiBox_printfxy(11,0,"/DGPS");
72
        {
75
                }
73
                JetiBox_printfxy(0,1,"HW:%d.%d SW:%d.%d%c",NC_Version.Hardware/10,NC_Version.Hardware%10,NC_Version.Major, NC_Version.Minor, NC_Version.Patch+'a');
-
 
-
 
76
                JetiBox_printfxy(0,1,"Home:%03dm %03d%c", GPSInfo.HomeDistance/10, GPSInfo.HomeBearing, 0xDF);
74
        }
77
        }
75
        else
78
        else
76
        {
79
        {                     //0123456789ABCDEF
77
                JetiBox_printfxy(0,1," Not found! ");
-
 
78
        }
-
 
79
}
80
                JetiBox_printfxy(2,0,"No NaviCtrl!");
80
#define JETI_MENU_GPSINFO 6
-
 
81
void mnc2(uint8_t key)
-
 
82
{
-
 
83
        JetiBox_printfxy(0,0,"Sat:%02d", GPSInfo.NumOfSats);
-
 
84
        switch (GPSInfo.SatFix)
-
 
85
        {
-
 
86
                case SATFIX_NONE:
-
 
87
                        JetiBox_printfxy(6,0,"NoFix");
-
 
88
                        break;
-
 
89
                case SATFIX_2D:
-
 
90
                        JetiBox_printfxy(6,0,"2DFix");
-
 
91
                        break;
-
 
92
                case SATFIX_3D:
-
 
93
                        JetiBox_printfxy(6,0,"3DFix");
-
 
94
                        break;
-
 
95
                default:
-
 
96
                        JetiBox_printfxy(6,0,"??Fix");
-
 
97
                        break;
-
 
98
        }
-
 
99
        if(GPSInfo.Flags & FLAG_DIFFSOLN)
-
 
100
        {
-
 
101
                JetiBox_printfxy(11,0,"/DGPS");
-
 
Line 102... Line 81...
102
        }
81
        }
103
        JetiBox_printfxy(0,1,"Home:%03dm %03d%c", GPSInfo.HomeDistance/10, GPSInfo.HomeBearing, 0xDF);
82
}
104
}
83
 
105
 
84
 
Line 116... Line 95...
116
  pFctMenu pHandler;
95
  pFctMenu pHandler;
117
} MENU_ENTRY;
96
} MENU_ENTRY;
Line 118... Line 97...
118
 
97
 
119
 
-
 
120
// the menu navigation structure
-
 
121
/*
98
 
-
 
99
// the menu navigation structure
122
        0 ----------------------------- 5
100
/*                                              |
Line 123... Line 101...
123
        |                                                               |
101
 
Line 124... Line 102...
124
4 - 1 - 2 - 3 - 4 - 1                           6
102
3 - 0 - 1 - 2 - 3 - 0
125
 
103
 
126
*/
104
*/
127
 
105
 
128
const MENU_ENTRY JetiBox_Menu[] PROGMEM=
106
const MENU_ENTRY JetiBox_Menu[] PROGMEM=
129
{ // l  r  u  d  pHandler
107
{ // l  r  u  d  pHandler
130
        {0, 4, 0, 1, &mfc0 },   // 0
-
 
131
        {0, 3, 0, 1, &mfc2 },   // 1
-
 
132
        {1, 3, 0, 2, &mfc3 },   // 2
108
        {3, 1, 0, 0, &Menu_Status },    // 0
Line 133... Line -...
133
        {2, 0, 0, 3, &mfc4 },   // 3
-
 
134
        {0, 4, 4, 5, &mnc1 },   // 4
109
        {0, 2, 1, 1, &Menu_Attitude },  // 1
135
        {5, 5, 4, 6, &mnc2 }    // 5
110
        {1, 3, 2, 2, &Menu_Battery },   // 2
136
};
111
        {2, 0, 3, 3, &Menu_PosInfo },   // 3
137
 
112
};
138
 
113