Subversion Repositories FlightCtrl

Rev

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

Rev Author Line No. Line
2050 holgerb 1
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
2
// + Software Nutzungsbedingungen (english version: see below)
3
// + www.MikroKopter.com
4
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
5
// + der Fa. HiSystems GmbH, Flachsmeerstrasse 2, 26802 Moormerland - nachfolgend Lizenzgeber genannt -
6
// + Der Lizenzgeber räumt dem Kunden ein nicht-ausschließliches, zeitlich und räumlich* unbeschränktes Recht ein, die im den
7
// + Mikrocontroller verwendete Firmware für die Hardware Flight-Ctrl, Navi-Ctrl, BL-Ctrl, MK3Mag & PC-Programm MikroKopter-Tool 
8
// + - nachfolgend Software genannt - nur für private Zwecke zu nutzen.
9
// + Der Einsatz dieser Software ist nur auf oder mit Produkten des Lizenzgebers zulässig.
10
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
11
// + Die vom Lizenzgeber gelieferte Software ist urheberrechtlich geschützt. Alle Rechte an der Software sowie an sonstigen im
12
// + Rahmen der Vertragsanbahnung und Vertragsdurchführung überlassenen Unterlagen stehen im Verhältnis der Vertragspartner ausschließlich dem Lizenzgeber zu.
13
// + Die in der Software enthaltenen Copyright-Vermerke, Markenzeichen, andere Rechtsvorbehalte, Seriennummern sowie
14
// + sonstige der Programmidentifikation dienenden Merkmale dürfen vom Kunden nicht verändert oder unkenntlich gemacht werden.
15
// + Der Kunde trifft angemessene Vorkehrungen für den sicheren Einsatz der Software. Er wird die Software gründlich auf deren
16
// + Verwendbarkeit zu dem von ihm beabsichtigten Zweck testen, bevor er diese operativ einsetzt.
17
// + Die Haftung des Lizenzgebers wird - soweit gesetzlich zulässig - begrenzt in Höhe des typischen und vorhersehbaren
18
// + Schadens. Die gesetzliche Haftung bei Personenschäden und nach dem Produkthaftungsgesetz bleibt unberührt. Dem Lizenzgeber steht jedoch der Einwand 
19
// + des Mitverschuldens offen.
20
// + Der Kunde trifft angemessene Vorkehrungen für den Fall, dass die Software ganz oder teilweise nicht ordnungsgemäß arbeitet.
21
// + Er wird die Software gründlich auf deren Verwendbarkeit zu dem von ihm beabsichtigten Zweck testen, bevor er diese operativ einsetzt.
22
// + Der Kunde wird er seine Daten vor Einsatz der Software nach dem Stand der Technik sichern.
23
// + Der Kunde ist darüber unterrichtet, dass der Lizenzgeber seine Daten im zur Vertragsdurchführung erforderlichen Umfang
24
// + und auf Grundlage der Datenschutzvorschriften erhebt, speichert, verarbeitet und, sofern notwendig, an Dritte übermittelt.
25
// + *) Die räumliche Nutzung bezieht sich nur auf den Einsatzort, nicht auf die Reichweite der programmierten Software.
26
// + #### ENDE DER NUTZUNGSBEDINGUNGEN ####'
27
// +  Hinweis: Informationen über erweiterte Nutzungsrechte (wie z.B. Nutzung für nicht-private Zwecke) sind auf Anfrage per Email an info(@)hisystems.de verfügbar.
28
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
29
// + Software LICENSING TERMS
30
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
31
// + of HiSystems GmbH, Flachsmeerstrasse 2, 26802 Moormerland, Germany - the Licensor -
32
// + The Licensor grants the customer a non-exclusive license to use the microcontroller firmware of the Flight-Ctrl, Navi-Ctrl, BL-Ctrl, and MK3Mag hardware 
33
// + (the Software) exclusively for private purposes. The License is unrestricted with respect to time and territory*.
34
// + The Software may only be used with the Licensor's products.
35
// + The Software provided by the Licensor is protected by copyright. With respect to the relationship between the parties to this
36
// + agreement, all rights pertaining to the Software and other documents provided during the preparation and execution of this
37
// + agreement shall be the property of the Licensor.
38
// + The information contained in the Software copyright notices, trademarks, other legal reservations, serial numbers and other
39
// + features that can be used to identify the program may not be altered or defaced by the customer.
40
// + The customer shall be responsible for taking reasonable precautions
41
// + for the safe use of the Software. The customer shall test the Software thoroughly regarding its suitability for the
42
// + intended purpose before implementing it for actual operation. The Licensor's liability shall be limited to the extent of typical and
43
// + foreseeable damage to the extent permitted by law, notwithstanding statutory liability for bodily injury and product
44
// + liability. However, the Licensor shall be entitled to the defense of contributory negligence.
45
// + The customer will take adequate precautions in the case, that the software is not working properly. The customer will test
46
// + the software for his purpose before any operational usage. The customer will backup his data before using the software.
47
// + The customer understands that the Licensor collects, stores and processes, and, where required, forwards, customer data
48
// + to third parties to the extent necessary for executing the agreement, subject to applicable data protection and privacy regulations.
49
// + *) The territory aspect only refers to the place where the Software is used, not its programmed range.
50
// + #### END OF LICENSING TERMS ####
51
// + Note: For information on license extensions (e.g. commercial use), please contact us at info(@)hisystems.de.
52
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
1484 killagreg 53
#include "jetimenu.h"
54
#include "libfc.h"
55
#include "printf_P.h"
56
#include "main.h"
57
#include "spi.h"
1500 killagreg 58
#include "capacity.h"
1930 holgerb 59
#include "hottmenu.h"
1484 killagreg 60
 
61
#define JETIBOX_KEY_RIGHT       0x1F
62
#define JETIBOX_KEY_UP          0x2F
63
#define JETIBOX_KEY_DOWN        0x4F
64
#define JETIBOX_KEY_LEFT        0x8F
65
#define JETIBOX_KEY_NONE        0x0F
66
#define JETIBOX_KEY_UNDEF       0x00
67
 
68
#define JetiBox_printfxy(x,y,format, args...)  { LIBFC_JetiBox_SetPos(y * 16 + x); _printf_P(&LIBFC_JetiBox_Putchar, PSTR(format) , ## args);}
69
#define JetiBox_printf(format, args...)        {  _printf_P(&LIBFC_JetiBox_Putchar, PSTR(format) , ## args);}
70
 
71
// -----------------------------------------------------------
72
// the menu functions
73
// -----------------------------------------------------------
1517 killagreg 74
void Menu_Status(uint8_t key)
75
{                                               //0123456789ABCDEF
2030 holgerb 76
#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)
1512 holgerb 77
        JetiBox_printfxy(0,0,"%2i.%1iV",UBat/10, UBat%10);
78
        if(NaviDataOkay)
1484 killagreg 79
        {
1941 holgerb 80
                JetiBox_printfxy(6,0,"%3d%c %03dm%c",ErsatzKompassInGrad, 0xDF, GPSInfo.HomeDistance/10,NC_GPS_ModeCharacter);
1484 killagreg 81
        }
1517 killagreg 82
        else
83
        {
1591 holgerb 84
                JetiBox_printfxy(6,0,"Status");
1517 killagreg 85
        }
1930 holgerb 86
 
87
#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))
88
        if(NC_ErrorCode)
89
        {
90
         static unsigned int timer;
91
         static char toggle = 1;
92
 
93
         if(CheckDelay(timer)) { if(toggle) toggle = 0; else toggle = 1; timer = SetDelay(1500);};
94
     if(toggle)
95
          {
96
       LIBFC_JetiBox_SetPos(0);
97
           _printf_P(&LIBFC_JetiBox_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);
98
          }
99
          else
100
          {
101
           JetiBox_printfxy(6,0,"ERROR: %2d ",NC_ErrorCode);
2327 holgerb 102
//         if(MotorenEin) JetiBeep = 'O'; 
1930 holgerb 103
          }
104
        }
2344 holgerb 105
        else
2345 holgerb 106
        if(ShowSettingNameTime)
2344 holgerb 107
        {
108
         LIBFC_JetiBox_Clear();
109
         JetiBox_printfxy(0,1,"Set%d:%s  ",ActiveParamSet,EE_Parameter.Name);
110
         return; // nichts weiter ausgeben
111
        }
112
 
1930 holgerb 113
#else
2327 holgerb 114
        if(NC_ErrorCode) { JetiBox_printfxy(6,0,"ERROR: %2d ",NC_ErrorCode); if(MotorenEin) JetiBeep = 'S';};
1930 holgerb 115
#endif
1591 holgerb 116
        JetiBox_printfxy(0,1,"%4i %2i:%02i",Capacity.UsedCapacity,FlugSekunden/60,FlugSekunden%60);
1916 holgerb 117
        if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)
1517 killagreg 118
        {
1591 holgerb 119
                JetiBox_printfxy(10,1,"%4im%c", (int16_t)(HoehenWert/100),VarioCharacter);
1517 killagreg 120
        }
2030 holgerb 121
#endif
1517 killagreg 122
}
1512 holgerb 123
 
1705 holgerb 124
 
1693 holgerb 125
void Menu_Temperature(uint8_t key)
1517 killagreg 126
{                       //0123456789ABCDEF
2030 holgerb 127
#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)
1687 holgerb 128
  JetiBox_printfxy(0,0,"%3i %3i %3i %3i", Motor[0].Temperature, Motor[1].Temperature, Motor[2].Temperature, Motor[3].Temperature);
1693 holgerb 129
  JetiBox_printfxy(0,1,"%3i %3i %3i %3i", Motor[4].Temperature, Motor[5].Temperature, Motor[6].Temperature, Motor[7].Temperature);
1690 holgerb 130
  if(RequiredMotors <= 4)
131
        {
132
         JetiBox_printfxy(0,1,"Temperatures    ");
133
    }
134
        else
135
    if(RequiredMotors <= 6)
136
        {
137
         JetiBox_printfxy(8,1,"\%cC     ",0xdf);
138
        }
1692 holgerb 139
 
2030 holgerb 140
#endif
1484 killagreg 141
}
1517 killagreg 142
 
143
void Menu_Battery(uint8_t key)
1500 killagreg 144
{                       //0123456789ABCDEF
2030 holgerb 145
#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)
1972 holgerb 146
        JetiBox_printfxy(0,0,"%2i.%1iV %3i.%1iA", UBat/10, UBat%10, Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);
1529 killagreg 147
        JetiBox_printfxy(0,1,"%4iW %6imAh",Capacity.ActualPower, Capacity.UsedCapacity);
2030 holgerb 148
#endif
1500 killagreg 149
}
150
 
1972 holgerb 151
void Magnet_Values(uint8_t key)
152
{                       //0123456789ABCDEF
2030 holgerb 153
#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)
1972 holgerb 154
        JetiBox_printfxy(0,0,"Magnet:%3i%% %3i%c",EarthMagneticField, KompassValue,0xDF);
155
        JetiBox_printfxy(0,1,"Incli.:%3i%c (%i) ",EarthMagneticInclination, 0xDF,EarthMagneticInclinationTheoretic);
2030 holgerb 156
#endif
1972 holgerb 157
}
1680 holgerb 158
 
1972 holgerb 159
 
2418 holgerb 160
void Menu_WPL_A1(uint8_t key)
161
{                       //0123456789ABCDEF
162
#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)
163
        JetiBox_printfxy(0,0,"Load Waypoints");
2420 holgerb 164
        JetiBox_printfxy(0,1,"(Fixed)      ");
2418 holgerb 165
#endif
166
}
167
 
168
void Menu_WPL_R1(uint8_t key)
169
{                       //0123456789ABCDEF
170
#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)
171
        JetiBox_printfxy(0,0,"Load Waypoints");
172
        JetiBox_printfxy(0,1,"(Relative)   ");
173
#endif
174
}
175
 
176
void Menu_WPL_A2(uint8_t key)
177
{                       //0123456789ABCDEF
178
#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)
2420 holgerb 179
static unsigned char load_waypoint_tmp = 1, changed;
2424 holgerb 180
 
181
  if(WPL_Name[0] == 0) JetiBox_printfxy(0,0,"FIX Waypoints")
182
  else JetiBox_printfxy(0,0,"FIX:%s",WPL_Name);
2418 holgerb 183
 
2420 holgerb 184
  if(NaviData_MaxWpListIndex == 0) JetiBox_printfxy(0,1,"no SD-Card")
185
  else
186
  {
187
        JetiBox_printfxy(0,1,"#%2d WP:",load_waypoint_tmp);
188
        if(NaviData_WaypointNumber)     JetiBox_printfxy(8,1,"%2d/%d ",NaviData_WaypointIndex,NaviData_WaypointNumber)
189
        else JetiBox_printfxy(8,1,"--/--")
190
 
2418 holgerb 191
    if(changed)         JetiBox_printfxy(14,1,"->")
192
        else            JetiBox_printfxy(14,1,"  ");
193
 
2420 holgerb 194
        if(key == JETIBOX_KEY_UP && load_waypoint_tmp < NaviData_MaxWpListIndex) { load_waypoint_tmp++; changed = 1;}
195
        if(key == JETIBOX_KEY_DOWN && load_waypoint_tmp > 1) { load_waypoint_tmp--; changed = 1; }
2418 holgerb 196
 
197
        if(key == JETIBOX_KEY_RIGHT && load_waypoint_tmp)
198
        {
199
         ToNC_Load_WP_List = load_waypoint_tmp;
200
         changed = 0;
201
        }
2420 holgerb 202
  }
2418 holgerb 203
#endif
204
}
205
 
206
void Menu_WPL_R2(uint8_t key)
207
{                       //0123456789ABCDEF
208
#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)
2420 holgerb 209
static unsigned char load_waypoint_tmp = 1, changed;
2418 holgerb 210
 
2424 holgerb 211
  if(WPL_Name[0] == 0) JetiBox_printfxy(0,0,"FIX Waypoints")
212
  else JetiBox_printfxy(0,0,"Rel:%s",WPL_Name);
213
 
2420 holgerb 214
  if(NaviData_MaxWpListIndex == 0) JetiBox_printfxy(0,1,"no SD-Card")
215
  else
216
  {
217
        JetiBox_printfxy(0,1,"#%2d WPs:",load_waypoint_tmp);
218
        if(NaviData_WaypointNumber)     JetiBox_printfxy(8,1,"%2d/%d ",NaviData_WaypointIndex,NaviData_WaypointNumber)
219
        else JetiBox_printfxy(8,1,"--/--")
2418 holgerb 220
 
221
    if(changed)         JetiBox_printfxy(14,1,"->")
222
        else            JetiBox_printfxy(14,1,"  ");
223
 
2420 holgerb 224
        if(key == JETIBOX_KEY_UP && load_waypoint_tmp < NaviData_MaxWpListIndex) { load_waypoint_tmp++; changed = 1;}
225
        if(key == JETIBOX_KEY_DOWN && load_waypoint_tmp > 1) { load_waypoint_tmp--; changed = 1; }
2418 holgerb 226
 
227
        if(key == JETIBOX_KEY_RIGHT && load_waypoint_tmp)
228
        {
229
         ToNC_Load_WP_List = load_waypoint_tmp | 0x80;
230
         changed = 0;
231
        }
2420 holgerb 232
  }
2418 holgerb 233
#endif
234
}
235
 
236
 
237
 
1517 killagreg 238
void Menu_PosInfo(uint8_t key)
1484 killagreg 239
{
2030 holgerb 240
#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)
1484 killagreg 241
        if(NaviDataOkay)
242
        {
1690 holgerb 243
                JetiBox_printfxy(0,0,"%2um/s Sat:%d ",GPSInfo.Speed,GPSInfo.NumOfSats);
1517 killagreg 244
                switch (GPSInfo.SatFix)
245
                {
1690 holgerb 246
                        case SATFIX_3D:
247
                                JetiBox_printfxy(12,0,"  3D");
1517 killagreg 248
                                break;
1933 holgerb 249
//                      case SATFIX_2D:
250
//                      case SATFIX_NONE:
1517 killagreg 251
                        default:
1690 holgerb 252
                                JetiBox_printfxy(12,0,"NoFx");
1517 killagreg 253
                                break;
254
                }
255
                if(GPSInfo.Flags & FLAG_DIFFSOLN)
256
                {
1690 holgerb 257
                        JetiBox_printfxy(12,0,"DGPS");
1517 killagreg 258
                }
1923 holgerb 259
                JetiBox_printfxy(0,1,"Home:%3dm %3d%c %c", GPSInfo.HomeDistance/10, GPSInfo.HomeBearing, 0xDF,NC_GPS_ModeCharacter);
1484 killagreg 260
        }
261
        else
1517 killagreg 262
        {                     //0123456789ABCDEF
263
                JetiBox_printfxy(2,0,"No NaviCtrl!");
1484 killagreg 264
        }
2030 holgerb 265
#endif
1484 killagreg 266
}
267
 
1517 killagreg 268
 
1484 killagreg 269
// -----------------------------------------------------------
270
// the menu topology
271
// -----------------------------------------------------------
272
typedef void (*pFctMenu) (uint8_t);  // the menu item handler function pointer
273
 
274
typedef struct{
275
  int8_t left;
276
  int8_t right;
277
  int8_t up;
278
  int8_t down;
279
  pFctMenu pHandler;
280
} MENU_ENTRY;
281
 
282
 
283
// the menu navigation structure
1517 killagreg 284
/*                                              |
285
3 - 0 - 1 - 2 - 3 - 0
1484 killagreg 286
*/
287
 
288
const MENU_ENTRY JetiBox_Menu[] PROGMEM=
289
{ // l  r  u  d  pHandler
2030 holgerb 290
#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)
2418 holgerb 291
        {6, 1, 0, 0, &Menu_Status },    // 0
1693 holgerb 292
        {0, 2, 1, 1, &Menu_Temperature },       // 1
1517 killagreg 293
        {1, 3, 2, 2, &Menu_Battery },   // 2
1972 holgerb 294
        {2, 4, 3, 3, &Menu_PosInfo },   // 3
2420 holgerb 295
        {3, 5, 7, 7, &Menu_WPL_A1 },    // 4
296
        {4, 6, 8, 8, &Menu_WPL_R1 },    // 5
2418 holgerb 297
        {5, 0, 6, 6, &Magnet_Values },  // 6
298
 
299
        {4, 7, 7, 7, &Menu_WPL_A2 },    // 7
300
        {5, 8, 8, 8, &Menu_WPL_R2 },    // 8
301
 
2030 holgerb 302
#endif
1484 killagreg 303
};
304
 
305
// -----------------------------------------------------------
306
// Update display buffer
307
// -----------------------------------------------------------
1583 ingob 308
unsigned char JetiBox_Update(unsigned char key)
1484 killagreg 309
{
2030 holgerb 310
#if !defined (RECEIVER_SPEKTRUM_DX7EXP) && !defined (RECEIVER_SPEKTRUM_DX8EXP)
1484 killagreg 311
        static uint8_t item = 0, last_item = 0; // the menu item
2418 holgerb 312
        static uint8_t updateDelay = 1 , last_key;
1484 killagreg 313
 
314
        // navigate within the menu by key action
315
        last_item = item;
316
        switch(key)
317
        {
318
                case JETIBOX_KEY_LEFT:
1972 holgerb 319
                        //if (item == 0) return (1);                                                                    // switch back to jeti expander menu
320
                        // else 
321
                         item = pgm_read_byte(&JetiBox_Menu[item].left);                //trigger to left menu item
1484 killagreg 322
                        break;
323
                case JETIBOX_KEY_RIGHT:
324
                        item = pgm_read_byte(&JetiBox_Menu[item].right);        //trigger to right menu item
325
                        break;
326
                case JETIBOX_KEY_UP:
327
                        item = pgm_read_byte(&JetiBox_Menu[item].up);           //trigger to up menu item
328
                        break;
329
                case JETIBOX_KEY_DOWN:
330
                        item = pgm_read_byte(&JetiBox_Menu[item].down);         //trigger to down menu item
331
                        break;
332
                default:
333
                        break;
334
        }
335
        // if the menu item has been changed, do not pass the key to the item handler
336
        // to avoid jumping over to items
337
        if(item != last_item) key = JETIBOX_KEY_UNDEF;
338
 
2418 holgerb 339
        if((updateDelay++ & 0x01) || (key != last_key))
2182 ingob 340
        {      
2418 holgerb 341
                last_key = key;
2182 ingob 342
                LIBFC_JetiBox_Clear();
343
                //execute menu item handler
344
                ((pFctMenu)(pgm_read_word(&(JetiBox_Menu[item].pHandler))))(key);
345
        }      
2030 holgerb 346
#endif
1583 ingob 347
        return (0);
1484 killagreg 348
}
349