Subversion Repositories FlightCtrl

Rev

Go to most recent revision | Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
1484 killagreg 1
#include "jetimenu.h"
2
#include "libfc.h"
3
#include "printf_P.h"
4
#include "main.h"
5
#include "spi.h"
1500 killagreg 6
#include "capacity.h"
1484 killagreg 7
 
8
#define JETIBOX_KEY_RIGHT       0x1F
9
#define JETIBOX_KEY_UP          0x2F
10
#define JETIBOX_KEY_DOWN        0x4F
11
#define JETIBOX_KEY_LEFT        0x8F
12
#define JETIBOX_KEY_NONE        0x0F
13
#define JETIBOX_KEY_UNDEF       0x00
14
 
15
#define JetiBox_printfxy(x,y,format, args...)  { LIBFC_JetiBox_SetPos(y * 16 + x); _printf_P(&LIBFC_JetiBox_Putchar, PSTR(format) , ## args);}
16
#define JetiBox_printf(format, args...)        {  _printf_P(&LIBFC_JetiBox_Putchar, PSTR(format) , ## args);}
17
 
18
// -----------------------------------------------------------
19
// the menu functions
20
// -----------------------------------------------------------
21
#define JETI_MENU_FCINFO 0
1500 killagreg 22
void mfc0(uint8_t key)
1484 killagreg 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
#define JETI_MENU_VOLT_RC 1
1500 killagreg 28
void mfc1(uint8_t key)
1484 killagreg 29
{
30
        JetiBox_printfxy(0,0,"Volt    RC-Level");
31
        JetiBox_printfxy(0,1,"%2i.%1iV   %03i",UBat/10, UBat%10, SenderOkay);
32
}
33
#define JETI_MENU_HEIGHT 2
1500 killagreg 34
void mfc2(uint8_t key)
1484 killagreg 35
{
36
        JetiBox_printfxy(0,0,"Height   Vario");
37
        if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)
38
        {
39
                JetiBox_printfxy(0,1,"%5i    %5i", (int16_t)(HoehenWert/5), VarioMeter);
40
        }
41
        else
42
        {
43
                JetiBox_printfxy(0,1,"no press. sensor");
44
        }
45
}
46
#define JETI_MENU_ATTITUDE 3
1500 killagreg 47
void mfc3(uint8_t key)
1484 killagreg 48
{
49
        JetiBox_printfxy(0,0,"Nick Roll  Yaw");
50
        JetiBox_printfxy(0,1,"%4i %4i %4i", (int16_t)(IntegralNick/1024), (int16_t)(IntegralRoll/1024), (int16_t)(ErsatzKompass / GIER_GRAD_FAKTOR));
51
}
1500 killagreg 52
#define JETI_MENU_AKKU 4
53
void mfc4(uint8_t key)
54
{                       //0123456789ABCDEF
55
        JetiBox_printfxy(0,0,"U[V] I[A] C[mAh]");
56
        JetiBox_printfxy(0,1,"%2i.%1i %2i.%1i %6i",UBat/10, UBat%10, Capacity.ActualCurrent/10, Capacity.ActualCurrent%10, Capacity.UsedCapacity);
57
}
58
 
59
 
1484 killagreg 60
#define JETI_MENU_NCINFO 4
1500 killagreg 61
void mnc1(uint8_t key)
1484 killagreg 62
{
1500 killagreg 63
        JetiBox_printfxy(1,0,"+ Navi-Ctrl +");
1484 killagreg 64
        if(NaviDataOkay)
65
        {
66
                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');
67
        }
68
        else
69
        {
70
                JetiBox_printfxy(0,1," Not found! ");
71
        }
72
}
73
#define JETI_MENU_GPSINFO 5
1500 killagreg 74
void mnc2(uint8_t key)
1484 killagreg 75
{
76
        JetiBox_printfxy(0,0,"Sat:%02d", GPSInfo.NumOfSats);
77
        switch (GPSInfo.SatFix)
78
        {
79
                case SATFIX_NONE:
80
                        JetiBox_printfxy(6,0,"NoFix");
81
                        break;
82
                case SATFIX_2D:
83
                        JetiBox_printfxy(6,0,"2DFix");
84
                        break;
85
                case SATFIX_3D:
86
                        JetiBox_printfxy(6,0,"3DFix");
87
                        break;
88
                default:
89
                        JetiBox_printfxy(6,0,"??Fix");
90
                        break;
91
        }
92
        if(GPSInfo.Flags & FLAG_DIFFSOLN)
93
        {
94
                JetiBox_printfxy(11,0,"/DGPS");
95
        }
96
        JetiBox_printfxy(0,1,"Home:%03dm %03d%c", GPSInfo.HomeDistance/10, GPSInfo.HomeBearing, 0xDF);
97
}
98
 
99
// -----------------------------------------------------------
100
// the menu topology
101
// -----------------------------------------------------------
102
typedef void (*pFctMenu) (uint8_t);  // the menu item handler function pointer
103
 
104
typedef struct{
105
  int8_t left;
106
  int8_t right;
107
  int8_t up;
108
  int8_t down;
109
  pFctMenu pHandler;
110
} MENU_ENTRY;
111
 
112
 
113
// the menu navigation structure
114
/*
1500 killagreg 115
 
1484 killagreg 116
        |                                                               |
1500 killagreg 117
4 - 1 - 2 - 3 - 4 - 1                           6
1484 killagreg 118
 
119
*/
120
 
121
const MENU_ENTRY JetiBox_Menu[] PROGMEM=
122
{ // l  r  u  d  pHandler
1500 killagreg 123
        {0, 5, 0, 1, &mfc0 },   // 0
124
        {4, 2, 0, 1, &mfc1 },   // 1
125
        {1, 3, 0, 2, &mfc2 },   // 2
126
        {2, 4, 0, 3, &mfc3 },   // 3
127
        {3, 1, 0, 4, &mfc4 },   // 4
128
        {0, 5, 5, 6, &mnc1 },   // 5
129
        {6, 6, 5, 6, &mnc2 }    // 6
1484 killagreg 130
};
131
 
132
 
133
// -----------------------------------------------------------
134
// Update display buffer
135
// -----------------------------------------------------------
136
void JetiBox_Update(unsigned char key)
137
{
138
        static uint8_t item = 0, last_item = 0; // the menu item
139
 
140
        // navigate within the menu by key action
141
        last_item = item;
142
        switch(key)
143
        {
144
                case JETIBOX_KEY_LEFT:
145
                        item = pgm_read_byte(&JetiBox_Menu[item].left);         //trigger to left menu item
146
                        break;
147
                case JETIBOX_KEY_RIGHT:
148
                        item = pgm_read_byte(&JetiBox_Menu[item].right);        //trigger to right menu item
149
                        break;
150
                case JETIBOX_KEY_UP:
151
                        item = pgm_read_byte(&JetiBox_Menu[item].up);           //trigger to up menu item
152
                        break;
153
                case JETIBOX_KEY_DOWN:
154
                        item = pgm_read_byte(&JetiBox_Menu[item].down);         //trigger to down menu item
155
                        break;
156
                default:
157
                        break;
158
        }
159
        // if the menu item has been changed, do not pass the key to the item handler
160
        // to avoid jumping over to items
161
        if(item != last_item) key = JETIBOX_KEY_UNDEF;
162
 
163
        LIBFC_JetiBox_Clear();
164
        //execute menu item handler
165
        ((pFctMenu)(pgm_read_word(&(JetiBox_Menu[item].pHandler))))(key);
166
}
167