Subversion Repositories FlightCtrl

Rev

Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
1 ingob 1
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
2
// + Copyright (c) 04.2007 Holger Buss
3
// + only for non-profit use
4
// + www.MikroKopter.com
5
// + see the File "License.txt" for further Informations
6
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
685 killagreg 7
 
8
 
9
#include <inttypes.h>
1 ingob 10
#include "main.h"
687 killagreg 11
#include "eeprom.h"
685 killagreg 12
#include "timer2.h"
13
#include "fc.h"
14
#include "rc.h"
15
#include "uart.h"
16
#include "printf_P.h"
17
#include "analog.h"
18
#include "_Settings.h"
1 ingob 19
 
685 killagreg 20
uint16_t  TestInt = 0;
21
#define ARRAYSIZE 10
22
uint8_t Array[ARRAYSIZE] = {1,2,3,4,5,6,7,8,9,10};
23
#define DISPLAYBUFFSIZE 80
24
int8_t DisplayBuff[DISPLAYBUFFSIZE] = "Hello World";
25
uint8_t DispPtr = 0;
26
uint8_t RemoteButtons = 0;
1 ingob 27
 
28
#define KEY1    0x01
29
#define KEY2    0x02
30
#define KEY3    0x04
31
#define KEY4    0x08
32
#define KEY5    0x10
33
 
685 killagreg 34
/************************************/
35
/*        Clear LCD Buffer          */
36
/************************************/
37
void LCD_Clear(void)
1 ingob 38
{
685 killagreg 39
 uint8_t i;
40
 for( i = 0; i < DISPLAYBUFFSIZE; i++) DisplayBuff[i] = ' ';
1 ingob 41
}
42
 
685 killagreg 43
 
44
/************************************/
45
/*        Update Menu on LCD        */
46
/************************************/
47
// Display with 20 characters in 4 lines
48
void LCD_PrintMenu(void)
1 ingob 49
 {
685 killagreg 50
  static uint8_t MaxMenuItem = 11, MenuItem=0;
683 killagreg 51
 
685 killagreg 52
  //  if KEY1 is activated goto previous menu item
53
  if(RemoteButtons & KEY1)
54
  {
55
          if(MenuItem) MenuItem--;
56
          else MenuItem = MaxMenuItem;
57
          LCD_Clear();
58
          RemotePollDisplayLine = -1;
59
  }
60
  // if KEY2 is activated goto next menu item
61
  if(RemoteButtons & KEY2)
62
  {
63
          if (MenuItem == MaxMenuItem) MenuItem = 0;
64
          else MenuItem++;
65
          LCD_Clear();
66
          RemotePollDisplayLine = -1;
67
   }
68
 
69
  // if KEY1 and KEY2 is activated goto initial menu item
70
  if((RemoteButtons & KEY1) && (RemoteButtons & KEY2)) MenuItem = 0;
71
 
72
  // print menu item number in the upper right corner
73
  if(MenuItem < 10)
74
  {
75
          LCD_printfxy(17,0,"[%i]",MenuItem);
76
  }
77
  else
78
  {
79
          LCD_printfxy(16,0,"[%i]",MenuItem);
80
  }
81
 
82
  switch(MenuItem)
83
  {
84
    case 0:// Version Info Menu Item
595 hbuss 85
           LCD_printfxy(0,0,"+ MikroKopter +");
685 killagreg 86
           LCD_printfxy(0,1,"HW:V%d.%d SW:%d.%d%c",BoardRelease/10,BoardRelease%10,VERSION_HAUPTVERSION, VERSION_NEBENVERSION,VERSION_INDEX+'a');
687 killagreg 87
           LCD_printfxy(0,2,"Setting: %d ", GetActiveParamSet());
1 ingob 88
           LCD_printfxy(0,3,"(c) Holger Buss");
89
           break;
685 killagreg 90
    case 1:// Hight Control Menu Item
687 killagreg 91
          if(ParamSet.GlobalConfig & CFG_HOEHENREGELUNG)
683 killagreg 92
           {
1 ingob 93
           LCD_printfxy(0,0,"Hoehe:     %5i",HoehenWert);
94
           LCD_printfxy(0,1,"SollHoehe: %5i",SollHoehe);
95
           LCD_printfxy(0,2,"Luftdruck: %5i",MessLuftdruck);
96
           LCD_printfxy(0,3,"Off      : %5i",DruckOffsetSetting);
97
           }
683 killagreg 98
           else
99
           {
1 ingob 100
           LCD_printfxy(0,1,"Keine ");
101
           LCD_printfxy(0,2,"Höhenregelung");
102
           }
683 killagreg 103
 
1 ingob 104
           break;
685 killagreg 105
    case 2:// Attitude Menu Item
1 ingob 106
           LCD_printfxy(0,0,"akt. Lage");
107
           LCD_printfxy(0,1,"Nick:      %5i",IntegralNick/1024);
108
           LCD_printfxy(0,2,"Roll:      %5i",IntegralRoll/1024);
109
           LCD_printfxy(0,3,"Kompass:   %5i",KompassValue);
110
           break;
685 killagreg 111
    case 3:// Remote Control Channel Menu Item
1 ingob 112
           LCD_printfxy(0,0,"K1:%4i  K2:%4i ",PPM_in[1],PPM_in[2]);
113
           LCD_printfxy(0,1,"K3:%4i  K4:%4i ",PPM_in[3],PPM_in[4]);
114
           LCD_printfxy(0,2,"K5:%4i  K6:%4i ",PPM_in[5],PPM_in[6]);
31 ingob 115
           LCD_printfxy(0,3,"K7:%4i  K8:%4i ",PPM_in[7],PPM_in[8]);
1 ingob 116
           break;
685 killagreg 117
    case 4:// Remote Control Mapping Menu Item
687 killagreg 118
           LCD_printfxy(0,0,"Ni:%4i  Ro:%4i ",PPM_in[ParamSet.Kanalbelegung[K_NICK]],PPM_in[ParamSet.Kanalbelegung[K_ROLL]]);
119
           LCD_printfxy(0,1,"Gs:%4i  Gi:%4i ",PPM_in[ParamSet.Kanalbelegung[K_GAS]],PPM_in[ParamSet.Kanalbelegung[K_GIER]]);
120
           LCD_printfxy(0,2,"P1:%4i  P2:%4i ",PPM_in[ParamSet.Kanalbelegung[K_POTI1]],PPM_in[ParamSet.Kanalbelegung[K_POTI2]]);
121
           LCD_printfxy(0,3,"P3:%4i  P4:%4i ",PPM_in[ParamSet.Kanalbelegung[K_POTI3]],PPM_in[ParamSet.Kanalbelegung[K_POTI4]]);
1 ingob 122
           break;
685 killagreg 123
    case 5:// Gyro Sensor Menu Item
1 ingob 124
           LCD_printfxy(0,0,"Gyro - Sensor");
685 killagreg 125
          if(BoardRelease == 10)
401 hbuss 126
          {
683 killagreg 127
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdValueGyrNick - AdNeutralNick, AdNeutralNick);
128
           LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueGyrRoll - AdNeutralRoll, AdNeutralRoll);
395 hbuss 129
           LCD_printfxy(0,3,"Gier %4i (%3i)",MesswertGier, AdNeutralGier);
401 hbuss 130
          }
683 killagreg 131
          else
401 hbuss 132
          {
683 killagreg 133
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdValueGyrNick - AdNeutralNick, AdNeutralNick/2);
134
           LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueGyrRoll - AdNeutralRoll, AdNeutralRoll/2);
401 hbuss 135
           LCD_printfxy(0,3,"Gier %4i (%3i)",MesswertGier, AdNeutralGier/2);
136
          }
1 ingob 137
           break;
685 killagreg 138
    case 6:// Acceleration Sensor Menu Item
1 ingob 139
           LCD_printfxy(0,0,"ACC - Sensor");
683 killagreg 140
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdValueAccNick,NeutralAccX);
141
           LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueAccRoll,NeutralAccY);
395 hbuss 142
           LCD_printfxy(0,3,"Hoch %4i (%3i)",Mittelwert_AccHoch/*accumulate_AccHoch / messanzahl_AccHoch*/,(int)NeutralAccZ);
1 ingob 143
           break;
685 killagreg 144
    case 7:// Accumulator Voltage / Remote Control Level
1 ingob 145
           LCD_printfxy(0,1,"Spannung:  %5i",UBat);
146
           LCD_printfxy(0,2,"Empf.Pegel:%5i",SenderOkay);
147
           break;
685 killagreg 148
    case 8:// Compass Menu Item
1 ingob 149
           LCD_printfxy(0,0,"Kompass       ");
150
           LCD_printfxy(0,1,"Richtung:  %5i",KompassRichtung);
151
           LCD_printfxy(0,2,"Messwert:  %5i",KompassValue);
152
           LCD_printfxy(0,3,"Start:     %5i",KompassStartwert);
153
           break;
685 killagreg 154
    case 9:// Poti Menu Item
1 ingob 155
           LCD_printfxy(0,0,"Poti1:  %3i",Poti1);
156
           LCD_printfxy(0,1,"Poti2:  %3i",Poti2);
157
           LCD_printfxy(0,2,"Poti3:  %3i",Poti3);
158
           LCD_printfxy(0,3,"Poti4:  %3i",Poti4);
159
           break;
685 killagreg 160
    case 10:// Servo Menu Item
1 ingob 161
           LCD_printfxy(0,0,"Servo  " );
162
           LCD_printfxy(0,1,"Setpoint  %3i",Parameter_ServoNickControl);
163
           LCD_printfxy(0,2,"Stellung: %3i",ServoValue);
687 killagreg 164
           LCD_printfxy(0,3,"Range:%3i-%3i",ParamSet.ServoNickMin,ParamSet.ServoNickMax);
1 ingob 165
           break;
685 killagreg 166
    case 11://Extern Control
595 hbuss 167
           LCD_printfxy(0,0,"ExternControl  " );
168
           LCD_printfxy(0,1,"Ni:%4i  Ro:%4i ",ExternControl.Nick,ExternControl.Roll);
169
           LCD_printfxy(0,2,"Gs:%4i  Gi:%4i ",ExternControl.Gas,ExternControl.Gier);
170
           LCD_printfxy(0,3,"Hi:%4i  Cf:%4i ",ExternControl.Hight,ExternControl.Config);
171
           break;
685 killagreg 172
    default: MaxMenuItem = MenuItem - 1;
173
             MenuItem = 0;
1 ingob 174
           break;
175
    }
685 killagreg 176
 RemoteButtons = 0;
304 ingob 177
}