Subversion Repositories FlightCtrl

Rev

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

Rev 690 Rev 694
Line 13... Line 13...
13
#include "fc.h"
13
#include "fc.h"
14
#include "rc.h"
14
#include "rc.h"
15
#include "uart.h"
15
#include "uart.h"
16
#include "printf_P.h"
16
#include "printf_P.h"
17
#include "analog.h"
17
#include "analog.h"
-
 
18
#include "mm3.h"
18
#include "_Settings.h"
19
#include "_Settings.h"
Line 19... Line -...
19
 
-
 
20
uint16_t  TestInt = 0;
20
 
21
#define ARRAYSIZE 10
21
#define ARRAYSIZE 10
22
uint8_t Array[ARRAYSIZE] = {1,2,3,4,5,6,7,8,9,10};
22
uint8_t Array[ARRAYSIZE] = {1,2,3,4,5,6,7,8,9,10};
23
#define DISPLAYBUFFSIZE 80
23
#define DISPLAYBUFFSIZE 80
24
int8_t DisplayBuff[DISPLAYBUFFSIZE] = "Hello World";
24
int8_t DisplayBuff[DISPLAYBUFFSIZE] = "Hello World";
Line 45... Line 45...
45
/*        Update Menu on LCD        */
45
/*        Update Menu on LCD        */
46
/************************************/
46
/************************************/
47
// Display with 20 characters in 4 lines
47
// Display with 20 characters in 4 lines
48
void LCD_PrintMenu(void)
48
void LCD_PrintMenu(void)
49
 {
49
 {
50
  static uint8_t MaxMenuItem = 11, MenuItem=0;
50
  static uint8_t MaxMenuItem = 13, MenuItem=0;
Line 51... Line 51...
51
 
51
 
52
  //  if KEY1 is activated goto previous menu item
52
  //  if KEY1 is activated goto previous menu item
53
  if(RemoteButtons & KEY1)
53
  if(RemoteButtons & KEY1)
54
  {
54
  {
Line 88... Line 88...
88
           LCD_printfxy(0,3,"(c) Holger Buss");
88
           LCD_printfxy(0,3,"(c) Holger Buss");
89
           break;
89
           break;
90
    case 1:// Hight Control Menu Item
90
    case 1:// Hight Control Menu Item
91
          if(ParamSet.GlobalConfig & CFG_HEIGHT_CONTROL)
91
          if(ParamSet.GlobalConfig & CFG_HEIGHT_CONTROL)
92
           {
92
           {
93
           LCD_printfxy(0,0,"Hoehe:     %5i",HoehenWert);
93
           LCD_printfxy(0,0,"Hight:      %5i",HoehenWert);
94
           LCD_printfxy(0,1,"SollHoehe: %5i",SollHoehe);
94
           LCD_printfxy(0,1,"Set Point:  %5i",SollHoehe);
95
           LCD_printfxy(0,2,"Luftdruck: %5i",MessLuftdruck);
95
           LCD_printfxy(0,2,"Air Press.: %5i",MessLuftdruck);
96
           LCD_printfxy(0,3,"Off      : %5i",DruckOffsetSetting);
96
           LCD_printfxy(0,3,"Offset    : %5i",DruckOffsetSetting);
97
           }
97
           }
98
           else
98
           else
99
           {
99
           {
100
           LCD_printfxy(0,1,"Keine ");
100
           LCD_printfxy(0,1,"No ");
101
           LCD_printfxy(0,2,"Höhenregelung");
101
           LCD_printfxy(0,2,"Hight Control");
102
           }
102
           }
Line 103... Line 103...
103
 
103
 
104
           break;
104
           break;
105
    case 2:// Attitude Menu Item
105
    case 2:// Attitude Menu Item
106
           LCD_printfxy(0,0,"akt. Lage");
106
           LCD_printfxy(0,0,"Attitude");
107
           LCD_printfxy(0,1,"Nick:      %5i",IntegralNick/1024);
107
           LCD_printfxy(0,1,"Nick:      %5i",IntegralNick/1024);
108
           LCD_printfxy(0,2,"Roll:      %5i",IntegralRoll/1024);
108
           LCD_printfxy(0,2,"Roll:      %5i",IntegralRoll/1024);
109
           LCD_printfxy(0,3,"Kompass:   %5i",KompassValue);
109
           LCD_printfxy(0,3,"Compass:   %5i",KompassValue);
110
           break;
110
           break;
111
    case 3:// Remote Control Channel Menu Item
111
    case 3:// Remote Control Channel Menu Item
112
           LCD_printfxy(0,0,"K1:%4i  K2:%4i ",PPM_in[1],PPM_in[2]);
112
           LCD_printfxy(0,0,"C1:%4i  C2:%4i ",PPM_in[1],PPM_in[2]);
113
           LCD_printfxy(0,1,"K3:%4i  K4:%4i ",PPM_in[3],PPM_in[4]);
113
           LCD_printfxy(0,1,"C3:%4i  C4:%4i ",PPM_in[3],PPM_in[4]);
114
           LCD_printfxy(0,2,"K5:%4i  K6:%4i ",PPM_in[5],PPM_in[6]);
114
           LCD_printfxy(0,2,"C5:%4i  C6:%4i ",PPM_in[5],PPM_in[6]);
115
           LCD_printfxy(0,3,"K7:%4i  K8:%4i ",PPM_in[7],PPM_in[8]);
115
           LCD_printfxy(0,3,"C7:%4i  C8:%4i ",PPM_in[7],PPM_in[8]);
116
           break;
116
           break;
117
    case 4:// Remote Control Mapping Menu Item
117
    case 4:// Remote Control Mapping Menu Item
118
           LCD_printfxy(0,0,"Ni:%4i  Ro:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_NICK]],PPM_in[ParamSet.ChannelAssignment[CH_ROLL]]);
118
           LCD_printfxy(0,0,"Ni:%4i  Ro:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_NICK]],PPM_in[ParamSet.ChannelAssignment[CH_ROLL]]);
119
           LCD_printfxy(0,1,"Gs:%4i  Gi:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_GAS]],PPM_in[ParamSet.ChannelAssignment[CH_GIER]]);
119
           LCD_printfxy(0,1,"Gs:%4i  Gi:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_GAS]],PPM_in[ParamSet.ChannelAssignment[CH_GIER]]);
Line 124... Line 124...
124
           LCD_printfxy(0,0,"Gyro - Sensor");
124
           LCD_printfxy(0,0,"Gyro - Sensor");
125
          if(BoardRelease == 10)
125
          if(BoardRelease == 10)
126
          {
126
          {
127
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdValueGyrNick - AdNeutralNick, AdNeutralNick);
127
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdValueGyrNick - AdNeutralNick, AdNeutralNick);
128
           LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueGyrRoll - AdNeutralRoll, AdNeutralRoll);
128
           LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueGyrRoll - AdNeutralRoll, AdNeutralRoll);
129
           LCD_printfxy(0,3,"Gier %4i (%3i)",MesswertGier, AdNeutralGier);
129
           LCD_printfxy(0,3,"Yaw  %4i (%3i)",MesswertGier, AdNeutralGier);
130
          }
130
          }
131
          else
131
          else
132
          {
132
          {
133
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdValueGyrNick - AdNeutralNick, AdNeutralNick/2);
133
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdValueGyrNick - AdNeutralNick, AdNeutralNick/2);
134
           LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueGyrRoll - AdNeutralRoll, AdNeutralRoll/2);
134
           LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueGyrRoll - AdNeutralRoll, AdNeutralRoll/2);
135
           LCD_printfxy(0,3,"Gier %4i (%3i)",MesswertGier, AdNeutralGier/2);
135
           LCD_printfxy(0,3,"Yaw  %4i (%3i)",MesswertGier, AdNeutralGier/2);
136
          }
136
          }
137
           break;
137
           break;
138
    case 6:// Acceleration Sensor Menu Item
138
    case 6:// Acceleration Sensor Menu Item
139
           LCD_printfxy(0,0,"ACC - Sensor");
139
           LCD_printfxy(0,0,"ACC - Sensor");
140
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdValueAccNick,NeutralAccX);
140
           LCD_printfxy(0,1,"Nick  %4i (%3i)",AdValueAccNick,NeutralAccX);
141
           LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueAccRoll,NeutralAccY);
141
           LCD_printfxy(0,2,"Roll  %4i (%3i)",AdValueAccRoll,NeutralAccY);
142
           LCD_printfxy(0,3,"Hoch %4i (%3i)",Mittelwert_AccHoch/*accumulate_AccHoch / messanzahl_AccHoch*/,(int)NeutralAccZ);
142
           LCD_printfxy(0,3,"Hight %4i (%3i)",Mittelwert_AccHoch/*accumulate_AccHoch / messanzahl_AccHoch*/,(int)NeutralAccZ);
143
           break;
143
           break;
144
    case 7:// Accumulator Voltage / Remote Control Level
144
    case 7:// Accumulator Voltage / Remote Control Level
145
           LCD_printfxy(0,1,"Spannung:  %5i",UBat);
145
           LCD_printfxy(0,1,"Voltage:  %5i",UBat);
146
           LCD_printfxy(0,2,"Empf.Pegel:%5i",SenderOkay);
146
           LCD_printfxy(0,2,"RC-Level: %5i",SenderOkay);
147
           break;
147
           break;
148
    case 8:// Compass Menu Item
148
    case 8:// Compass Menu Item
149
           LCD_printfxy(0,0,"Kompass       ");
149
           LCD_printfxy(0,0,"Compass       ");
150
           LCD_printfxy(0,1,"Richtung:  %5i",KompassRichtung);
150
           LCD_printfxy(0,1,"Direction: %5i",KompassRichtung);
151
           LCD_printfxy(0,2,"Messwert:  %5i",KompassValue);
151
           LCD_printfxy(0,2,"Reading:   %5i",KompassValue);
152
           LCD_printfxy(0,3,"Start:     %5i",KompassStartwert);
152
           LCD_printfxy(0,3,"Start:     %5i",KompassStartwert);
153
           break;
153
           break;
154
    case 9:// Poti Menu Item
154
    case 9:// Poti Menu Item
155
           LCD_printfxy(0,0,"Poti1:  %3i",Poti1);
155
           LCD_printfxy(0,0,"Poti1:  %3i",Poti1);
156
           LCD_printfxy(0,1,"Poti2:  %3i",Poti2);
156
           LCD_printfxy(0,1,"Poti2:  %3i",Poti2);
Line 158... Line 158...
158
           LCD_printfxy(0,3,"Poti4:  %3i",Poti4);
158
           LCD_printfxy(0,3,"Poti4:  %3i",Poti4);
159
           break;
159
           break;
160
    case 10:// Servo Menu Item
160
    case 10:// Servo Menu Item
161
           LCD_printfxy(0,0,"Servo  " );
161
           LCD_printfxy(0,0,"Servo  " );
162
           LCD_printfxy(0,1,"Setpoint  %3i",Parameter_ServoNickControl);
162
           LCD_printfxy(0,1,"Setpoint  %3i",Parameter_ServoNickControl);
163
           LCD_printfxy(0,2,"Stellung: %3i",ServoValue);
163
           LCD_printfxy(0,2,"Position: %3i",ServoValue);
164
           LCD_printfxy(0,3,"Range:%3i-%3i",ParamSet.ServoNickMin,ParamSet.ServoNickMax);
164
           LCD_printfxy(0,3,"Range:%3i-%3i",ParamSet.ServoNickMin,ParamSet.ServoNickMax);
165
           break;
165
           break;
166
    case 11://Extern Control
166
    case 11://Extern Control
167
           LCD_printfxy(0,0,"ExternControl  " );
167
           LCD_printfxy(0,0,"ExternControl  " );
168
           LCD_printfxy(0,1,"Ni:%4i  Ro:%4i ",ExternControl.Nick,ExternControl.Roll);
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);
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);
170
           LCD_printfxy(0,3,"Hi:%4i  Cf:%4i ",ExternControl.Hight,ExternControl.Config);
171
           break;
171
           break;
-
 
172
   case 12:// MM3 Kompass
-
 
173
                        LCD_printfxy(0,0,"MM3 Offset");
-
 
174
                        LCD_printfxy(0,1,"X_Offset:  %3i",MM3_calib.X_off);
-
 
175
                        LCD_printfxy(0,2,"Y_Offset:  %3i",MM3_calib.Y_off);
-
 
176
                        LCD_printfxy(0,3,"Z_Offset:  %3i",MM3_calib.Z_off);
-
 
177
                        break;
-
 
178
        case 13://MM3 Range
-
 
179
                        LCD_printfxy(0,0,"MM3 Range");
-
 
180
                        LCD_printfxy(0,1,"X_Range:  %4i",MM3_calib.X_range);
-
 
181
                        LCD_printfxy(0,2,"Y_Range:  %4i",MM3_calib.Y_range);
-
 
182
                        LCD_printfxy(0,3,"Z_Range:  %4i",MM3_calib.Z_range);
-
 
183
        break;
172
    default: MaxMenuItem = MenuItem - 1;
184
    default: MaxMenuItem = MenuItem - 1;
173
             MenuItem = 0;
185
             MenuItem = 0;
174
           break;
186
           break;
175
    }
187
    }
176
 RemoteButtons = 0;
188
 RemoteButtons = 0;