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
 
794 killagreg 8
#include <stdlib.h>
685 killagreg 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"
754 killagreg 18
#ifdef USE_MM3
694 killagreg 19
#include "mm3.h"
754 killagreg 20
#endif
702 killagreg 21
#include "ubx.h"
685 killagreg 22
#include "_Settings.h"
1 ingob 23
 
752 killagreg 24
 
685 killagreg 25
#define ARRAYSIZE 10
26
uint8_t Array[ARRAYSIZE] = {1,2,3,4,5,6,7,8,9,10};
27
#define DISPLAYBUFFSIZE 80
28
int8_t DisplayBuff[DISPLAYBUFFSIZE] = "Hello World";
29
uint8_t DispPtr = 0;
30
uint8_t RemoteButtons = 0;
1 ingob 31
 
32
#define KEY1    0x01
33
#define KEY2    0x02
34
#define KEY3    0x04
35
#define KEY4    0x08
36
#define KEY5    0x10
37
 
685 killagreg 38
/************************************/
39
/*        Clear LCD Buffer          */
40
/************************************/
41
void LCD_Clear(void)
1 ingob 42
{
685 killagreg 43
 uint8_t i;
44
 for( i = 0; i < DISPLAYBUFFSIZE; i++) DisplayBuff[i] = ' ';
1 ingob 45
}
46
 
685 killagreg 47
 
48
/************************************/
49
/*        Update Menu on LCD        */
50
/************************************/
51
// Display with 20 characters in 4 lines
52
void LCD_PrintMenu(void)
1 ingob 53
 {
754 killagreg 54
  #ifdef USE_MM3
55
  static uint8_t MaxMenuItem = 14;
56
  #else
57
  static uint8_t MaxMenuItem = 12;
58
  #endif
794 killagreg 59
  static uint8_t MenuItem=0;
683 killagreg 60
 
685 killagreg 61
  //  if KEY1 is activated goto previous menu item
62
  if(RemoteButtons & KEY1)
63
  {
64
          if(MenuItem) MenuItem--;
65
          else MenuItem = MaxMenuItem;
66
          LCD_Clear();
67
          RemotePollDisplayLine = -1;
68
  }
69
  // if KEY2 is activated goto next menu item
70
  if(RemoteButtons & KEY2)
71
  {
72
          if (MenuItem == MaxMenuItem) MenuItem = 0;
73
          else MenuItem++;
74
          LCD_Clear();
75
          RemotePollDisplayLine = -1;
76
   }
77
 
78
  // if KEY1 and KEY2 is activated goto initial menu item
79
  if((RemoteButtons & KEY1) && (RemoteButtons & KEY2)) MenuItem = 0;
80
 
81
  // print menu item number in the upper right corner
82
  if(MenuItem < 10)
83
  {
84
          LCD_printfxy(17,0,"[%i]",MenuItem);
85
  }
86
  else
87
  {
88
          LCD_printfxy(16,0,"[%i]",MenuItem);
89
  }
90
 
91
  switch(MenuItem)
92
  {
93
    case 0:// Version Info Menu Item
595 hbuss 94
           LCD_printfxy(0,0,"+ MikroKopter +");
735 killagreg 95
           LCD_printfxy(0,1,"HW:V%d.%d SW:%d.%d%c",BoardRelease/10,BoardRelease%10,VERSION_MAJOR, VERSION_MINOR,VERSION_INDEX+'a');
687 killagreg 96
           LCD_printfxy(0,2,"Setting: %d ", GetActiveParamSet());
1 ingob 97
           LCD_printfxy(0,3,"(c) Holger Buss");
98
           break;
761 killagreg 99
    case 1:// Height Control Menu Item
690 killagreg 100
          if(ParamSet.GlobalConfig & CFG_HEIGHT_CONTROL)
683 killagreg 101
           {
768 killagreg 102
           LCD_printfxy(0,0,"Height:    %5i",ReadingHeight);
103
           LCD_printfxy(0,1,"Set Point: %5i",SetPointHeight);
104
           LCD_printfxy(0,2,"Air Press.:%5i",ReadingAirPressure);
105
           LCD_printfxy(0,3,"Offset    :%5i",PressureSensorOffset);
1 ingob 106
           }
683 killagreg 107
           else
108
           {
694 killagreg 109
           LCD_printfxy(0,1,"No ");
761 killagreg 110
           LCD_printfxy(0,2,"Height Control");
1 ingob 111
           }
683 killagreg 112
 
1 ingob 113
           break;
685 killagreg 114
    case 2:// Attitude Menu Item
694 killagreg 115
           LCD_printfxy(0,0,"Attitude");
701 killagreg 116
           LCD_printfxy(0,1,"Pitch:     %5i",IntegralPitch/1024);
1 ingob 117
           LCD_printfxy(0,2,"Roll:      %5i",IntegralRoll/1024);
701 killagreg 118
           LCD_printfxy(0,3,"Compass:   %5i",CompassHeading);
1 ingob 119
           break;
685 killagreg 120
    case 3:// Remote Control Channel Menu Item
694 killagreg 121
           LCD_printfxy(0,0,"C1:%4i  C2:%4i ",PPM_in[1],PPM_in[2]);
122
           LCD_printfxy(0,1,"C3:%4i  C4:%4i ",PPM_in[3],PPM_in[4]);
123
           LCD_printfxy(0,2,"C5:%4i  C6:%4i ",PPM_in[5],PPM_in[6]);
124
           LCD_printfxy(0,3,"C7:%4i  C8:%4i ",PPM_in[7],PPM_in[8]);
1 ingob 125
           break;
685 killagreg 126
    case 4:// Remote Control Mapping Menu Item
701 killagreg 127
           LCD_printfxy(0,0,"Pi:%4i  Ro:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_PITCH]],PPM_in[ParamSet.ChannelAssignment[CH_ROLL]]);
707 killagreg 128
           LCD_printfxy(0,1,"Gs:%4i  Ya:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_THRUST]],PPM_in[ParamSet.ChannelAssignment[CH_YAW]]);
690 killagreg 129
           LCD_printfxy(0,2,"P1:%4i  P2:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_POTI1]],PPM_in[ParamSet.ChannelAssignment[CH_POTI2]]);
130
           LCD_printfxy(0,3,"P3:%4i  P4:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_POTI3]],PPM_in[ParamSet.ChannelAssignment[CH_POTI4]]);
1 ingob 131
           break;
685 killagreg 132
    case 5:// Gyro Sensor Menu Item
1 ingob 133
           LCD_printfxy(0,0,"Gyro - Sensor");
685 killagreg 134
          if(BoardRelease == 10)
401 hbuss 135
          {
701 killagreg 136
           LCD_printfxy(0,1,"Pitch %4i (%3i)",AdValueGyrPitch - AdNeutralPitch, AdNeutralPitch);
137
           LCD_printfxy(0,2,"Roll  %4i (%3i)",AdValueGyrRoll - AdNeutralRoll, AdNeutralRoll);
711 killagreg 138
           LCD_printfxy(0,3,"Yaw   %4i (%3i)",Reading_GyroYaw, AdNeutralYaw);
401 hbuss 139
          }
683 killagreg 140
          else
401 hbuss 141
          {
701 killagreg 142
           LCD_printfxy(0,1,"Pitch %4i (%3i)",AdValueGyrPitch - AdNeutralPitch, AdNeutralPitch/2);
143
           LCD_printfxy(0,2,"Roll  %4i (%3i)",AdValueGyrRoll - AdNeutralRoll, AdNeutralRoll/2);
711 killagreg 144
           LCD_printfxy(0,3,"Yaw   %4i (%3i)",Reading_GyroYaw, AdNeutralYaw/2);
401 hbuss 145
          }
1 ingob 146
           break;
685 killagreg 147
    case 6:// Acceleration Sensor Menu Item
1 ingob 148
           LCD_printfxy(0,0,"ACC - Sensor");
768 killagreg 149
           LCD_printfxy(0,1,"Pitch  %4i (%3i)",AdValueAccPitch, NeutralAccX);
150
           LCD_printfxy(0,2,"Roll   %4i (%3i)",AdValueAccRoll, NeutralAccY);
761 killagreg 151
           LCD_printfxy(0,3,"Height %4i (%3i)",Mean_AccTop, (int)NeutralAccZ);
1 ingob 152
           break;
685 killagreg 153
    case 7:// Accumulator Voltage / Remote Control Level
694 killagreg 154
           LCD_printfxy(0,1,"Voltage:  %5i",UBat);
800 killagreg 155
           LCD_printfxy(0,2,"RC-Level: %5i",RC_Quality);
1 ingob 156
           break;
685 killagreg 157
    case 8:// Compass Menu Item
694 killagreg 158
           LCD_printfxy(0,0,"Compass       ");
701 killagreg 159
           LCD_printfxy(0,1,"Course:    %5i",CompassCourse);
160
           LCD_printfxy(0,2,"Heading:   %5i",CompassHeading);
161
           LCD_printfxy(0,3,"OffCourse: %5i",CompassOffCourse);
1 ingob 162
           break;
685 killagreg 163
    case 9:// Poti Menu Item
762 killagreg 164
                   LCD_printfxy(0,0,"Po1: %3i Po5: %3i" ,Poti1,Poti5); //PPM24-Extesion
165
                   LCD_printfxy(0,1,"Po2: %3i Po6: %3i" ,Poti2,Poti6); //PPM24-Extesion
166
                   LCD_printfxy(0,2,"Po3: %3i Po7: %3i" ,Poti3,Poti7); //PPM24-Extesion
167
                   LCD_printfxy(0,3,"Po4: %3i Po8: %3i" ,Poti4,Poti8); //PPM24-Extesion
1 ingob 168
           break;
685 killagreg 169
    case 10:// Servo Menu Item
1 ingob 170
           LCD_printfxy(0,0,"Servo  " );
703 killagreg 171
           LCD_printfxy(0,1,"Setpoint  %3i",FCParam.ServoPitchControl);
694 killagreg 172
           LCD_printfxy(0,2,"Position: %3i",ServoValue);
703 killagreg 173
           LCD_printfxy(0,3,"Range:%3i-%3i",ParamSet.ServoPitchMin, ParamSet.ServoPitchMax);
1 ingob 174
           break;
685 killagreg 175
    case 11://Extern Control
595 hbuss 176
           LCD_printfxy(0,0,"ExternControl  " );
703 killagreg 177
           LCD_printfxy(0,1,"Pi:%4i  Ro:%4i ",ExternControl.Pitch, ExternControl.Roll);
707 killagreg 178
           LCD_printfxy(0,2,"Gs:%4i  Ya:%4i ",ExternControl.Thrust, ExternControl.Yaw);
761 killagreg 179
           LCD_printfxy(0,3,"Hi:%4i  Cf:%4i ",ExternControl.Height, ExternControl.Config);
595 hbuss 180
           break;
754 killagreg 181
        case 12://GPS Lat/Lon coords
702 killagreg 182
                        if (GPSInfo.status == INVALID)
183
                        {
722 killagreg 184
                                LCD_printfxy(0,0,"No data available!");
702 killagreg 185
                        }
186
                        else
187
                        {
188
                                switch (GPSInfo.satfix)
189
                                {
190
                                case SATFIX_NONE:
752 killagreg 191
                                        LCD_printfxy(0,0,"Sats: %d Fix: No", GPSInfo.satnum);
702 killagreg 192
                                        break;
193
                                case SATFIX_2D:
752 killagreg 194
                                        LCD_printfxy(0,0,"Sats: %d Fix: 2D", GPSInfo.satnum);
702 killagreg 195
                                        break;
196
                                case SATFIX_3D:
752 killagreg 197
                                        LCD_printfxy(0,0,"Sats: %d Fix: 3D", GPSInfo.satnum);
702 killagreg 198
                                        break;
199
                                default:
752 killagreg 200
                                        LCD_printfxy(0,0,"Sats: %d Fix: ??", GPSInfo.satnum);
702 killagreg 201
                                        break;
202
                                }
794 killagreg 203
                                int16_t i1,i2,i3;
204
                                i1 = (int16_t)(GPSInfo.longitude/10000000L);
205
                                i2 = abs((int16_t)((GPSInfo.longitude%10000000L)/10000L));
206
                                i3 = abs((int16_t)(((GPSInfo.longitude%10000000L)%10000L)/10L));
207
                                LCD_printfxy(0,1,"Lon: %d.%.3d%.3d deg",i1, i2, i3);
208
                                i1 = (int16_t)(GPSInfo.latitude/10000000L);
209
                                i2 = abs((int16_t)((GPSInfo.latitude%10000000L)/10000L));
210
                                i3 = abs((int16_t)(((GPSInfo.latitude%10000000L)%10000L)/10L));
211
                                LCD_printfxy(0,2,"Lat: %d.%.3d%.3d deg",i1, i2, i3);
212
                                i1 = (int16_t)(GPSInfo.altitude/1000L);
213
                                i2 = abs((int16_t)(GPSInfo.altitude%1000L));
214
                                LCD_printfxy(0,3,"Alt: %d.%.3d m",i1, i2);
702 killagreg 215
                        }
216
                        break;
754 killagreg 217
#ifdef USE_MM3
218
        case 13:// MM3 Kompass
219
                        LCD_printfxy(0,0,"MM3 Offset");
220
                        LCD_printfxy(0,1,"X_Offset:  %3i",MM3_calib.X_off);
221
                        LCD_printfxy(0,2,"Y_Offset:  %3i",MM3_calib.Y_off);
222
                        LCD_printfxy(0,3,"Z_Offset:  %3i",MM3_calib.Z_off);
223
                        break;
224
        case 14://MM3 Range
225
                        LCD_printfxy(0,0,"MM3 Range");
226
                        LCD_printfxy(0,1,"X_Range:  %4i",MM3_calib.X_range);
227
                        LCD_printfxy(0,2,"Y_Range:  %4i",MM3_calib.Y_range);
228
                        LCD_printfxy(0,3,"Z_Range:  %4i",MM3_calib.Z_range);
229
                        break;
230
#endif
685 killagreg 231
    default: MaxMenuItem = MenuItem - 1;
232
             MenuItem = 0;
1 ingob 233
           break;
234
    }
685 killagreg 235
 RemoteButtons = 0;
304 ingob 236
}