| 0,0 → 1,207 |
|---|
| /***************************************************************************************************************************** |
| * File: menu.c |
| * |
| * Purpose: collecting ADC analog inputs from PORTA |
| * |
| * Functions: void ADC_Init(void) |
| * void SucheLuftruckOffset(void) |
| * void SucheGyroOffset(void) |
| * ISR(ADC_vect) |
| * |
| *****************************************************************************************************************************/ |
| #include "main.h" |
| #include "menu.h" |
| |
| unsigned int TestInt = 0; |
| #define ARRAYGROESSE 10 |
| unsigned char Array[ARRAYGROESSE] = {1,2,3,4,5,6,7,8,9,10}; |
| char DisplayBuff[80] = "cq de dk9nw"; |
| unsigned char DispPtr = 0; |
| |
| unsigned char MaxMenue = 14; |
| unsigned char MenuePunkt = 0; |
| unsigned char RemoteKeys = 0; |
| |
| #define KEY1 0x01 |
| #define KEY2 0x02 |
| #define KEY3 0x04 |
| #define KEY4 0x08 |
| #define KEY5 0x10 |
| |
| |
| // ---------------------------------------------------------------------------------------------------------------------------- |
| // leert die LCD Anzeige |
| // ---------------------------------------------------------------------------------------------------------------------------- |
| void LcdClear(void) |
| { |
| unsigned char i; |
| for(i=0;i<80;i++) DisplayBuff[i] = ' '; |
| } |
| // ---------------------------------------------------------------------------------------------------------------------------- |
| |
| |
| |
| // --------------------------------------------------------------------------------------------------------------------------- |
| // Anzeigen auf dem MK Toll auf dem dortigen LCD Display |
| // --------------------------------------------------------------------------------------------------------------------------- |
| void Menu(void) |
| { |
| if(MenuePunkt > MaxMenue) MenuePunkt = MaxMenue; // MaxMenue = 14; |
| |
| if(RemoteKeys & KEY1) { if(MenuePunkt) MenuePunkt--; else MenuePunkt = MaxMenue;} // go down |
| |
| if(RemoteKeys & KEY2) { if(MenuePunkt == MaxMenue) MenuePunkt = 0; else MenuePunkt++;} // go up |
| |
| if((RemoteKeys & KEY1) && (RemoteKeys & KEY2)) MenuePunkt = 0; // both keys pressed |
| |
| LcdClear(); |
| |
| if(MenuePunkt < 10) |
| { |
| LCD_printfxy(17,0,"[%i]",MenuePunkt); |
| } |
| else |
| { |
| LCD_printfxy(16,0,"[%i]",MenuePunkt); |
| } |
| |
| switch(MenuePunkt) |
| { |
| case 0: |
| LCD_printfxy(0,0,"+ MikroKopter +"); |
| LCD_printfxy(0,1,"HW:V%d.%d SW:%d.%d%c",PlatinenVersion/10,PlatinenVersion%10, VERSION_MAJOR, VERSION_MINOR, VERSION_PATCH +'a'); |
| LCD_printfxy(0,2,"Setting:%d %s",GetActiveParamSetNumber(),Mixer.Name); |
| if(I2CTimeout < 6) LCD_printfxy(0,3,"I2C ERROR!!!") |
| else |
| if(MissingMotor) LCD_printfxy(0,3,"Missing BL-Ctrl:%d!!",MissingMotor) |
| else LCD_printfxy(0,3,"----BL-Ctrl ok---"); |
| break; |
| |
| case 1: |
| LCD_printfxy(0,0,"DAC Offset"); |
| LCD_printfxy(0,1,"%5i",AnalogOffsetNick); // = 113 |
| LCD_printfxy(0,2,"%5i",AnalogOffsetRoll); // = 114 |
| LCD_printfxy(0,3,"%5i",AnalogOffsetGier); // = 149 |
| break; |
| |
| case 2: |
| LCD_printfxy(0,0,"GlobalConfig"); // |
| LCD_printfxy(0,1,"%5i",EE_Parameter.GlobalConfig); // |
| LCD_printfxy(0,2,"EEPROM310"); // |
| unsigned char c47 = eeprom_read_byte(&EEPromArray[310]); // |
| LCD_printfxy(0,3,"%5i",c47); // |
| break; |
| |
| case 3: |
| LCD_printfxy(0,0,"K1:%4i K2:%4i ",PPM_in[1],PPM_in[2]); // K1 = -125 kann -125 bis 120 = Gas K2 = 2 kann 115 bis -102 = Roll |
| LCD_printfxy(0,1,"K3:%4i K4:%4i ",PPM_in[3],PPM_in[4]); // K3 = 0 kann -117 bis 120 = Nick K4 = 2 kann -120 bis +120 = Gier |
| LCD_printfxy(0,2,"K5:%4i ",PPM_in[5]); // K5 = -117 oder +120 = Kippschalter |
| /* |
| LCD_printfxy(0,0,"Ni:%4i Ro:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_NICK]],PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]); |
| LCD_printfxy(0,1,"Gs:%4i Gi:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_GAS]],PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]); |
| LCD_printfxy(0,2,"P1:%4i P2:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]],PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]]); |
| LCD_printfxy(0,3,"P3:%4i P4:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]],PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]]); |
| */ |
| break; |
| |
| case 4: |
| LCD_printfxy(0,0,"AdNeutral..."); |
| LCD_printfxy(0,1,"Nick: %5i",AdNeutralNick); // 8461 ständig steigend |
| LCD_printfxy(0,2,"Roll: %5i",AdNeutralRoll); // 8463 ständig steigend |
| LCD_printfxy(0,3,"Gier: %5i",AdNeutralGier); // 1039 |
| break; |
| |
| case 5: |
| LCD_printfxy(0,0,"Gyro - Sensor"); |
| LCD_printfxy(0,1,"Nick %4i (%3i)",AdWertNick - AdNeutralNick/8, AdNeutralNick/16); // = 1 (564) |
| LCD_printfxy(0,2,"Roll %4i (%3i)",AdWertRoll - AdNeutralRoll/8, AdNeutralRoll/16); // = 1 (555) |
| LCD_printfxy(0,3,"Gier %4i (%3i)",AdNeutralGier - AdWertGier, AdNeutralGier/2); // = 3 (322) |
| break; |
| |
| case 6: |
| LCD_printfxy(0,0,"ACC - Sensor"); |
| LCD_printfxy(0,1,"Nick %4i (%3i)",AdWertAccNick,NeutralAccX); // = -4 (504) |
| LCD_printfxy(0,2,"Roll %4i (%3i)",AdWertAccRoll,NeutralAccY); // = 7 (487) |
| LCD_printfxy(0,3,"Gier %4i (%3i)",Mittelwert_AccHoch/*accumulate_AccHoch / messanzahl_AccHoch*/,(int)NeutralAccZ); // = 0 (713) |
| break; |
| |
| case 7: |
| LCD_printfxy(0,1,"Spannung: %5i",UBat); // = 120 müsst 12V sein |
| LCD_printfxy(0,2,"Empf.Pegel:%5i",SenderOkay); // = 200 bei gutem Empfang = 0 bei keinem Empfang |
| break; |
| |
| case 8: |
| LCD_printfxy(0,0,"Kompass..."); |
| LCD_printfxy(0,1,"Richtung: %4i",KompassRichtung); // = -75 wurde nach dem Start nach links gedreht |
| LCD_printfxy(0,2,"Value: %4i",KompassValue); // = 318 Anzeigewert des Kompass |
| LCD_printfxy(0,3,"Startwert: %4i",KompassStartwert); // = 34 ist die Differenz zwischen beiden Werten |
| break; |
| |
| case 9: |
| LCD_printfxy(0,0,"Poti1: %3i",Poti1); // = 0 |
| LCD_printfxy(0,1,"Poti2: %3i",Poti2); // = 154 |
| LCD_printfxy(0,2,"Poti3: %3i",Poti3); // = 110 |
| LCD_printfxy(0,3,"Poti4: %3i",Poti4); // = 110 |
| break; |
| |
| case 10: |
| LCD_printfxy(0,0,"Servo " ); |
| LCD_printfxy(0,1,"Setpoint %3i",Parameter_ServoNickControl); // = 100 |
| //LCD_printfxy(0,2,"Stellung: %3i",ServoValue); |
| LCD_printfxy(0,3,"Range:%3i-%3i",EE_Parameter.ServoNickMin,EE_Parameter.ServoNickMax); // 50-150 |
| break; |
| |
| case 11: |
| if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG) |
| { |
| LCD_printfxy(0,0,"Hoehe: %5i",HoehenWert); |
| LCD_printfxy(0,1,"SollHoehe: %5i",SollHoehe); |
| LCD_printfxy(0,2,"Luftdruck: %5i",MessLuftdruck); |
| LCD_printfxy(0,3,"Off : %5i",DruckOffsetSetting); |
| } |
| else |
| { |
| LCD_printfxy(0,1,"Keine "); |
| LCD_printfxy(0,2,"Höhenregelung"); |
| } |
| break; |
| |
| case 12: |
| LCD_printfxy(0,0,"BL-Ctrl Errors " ); |
| LCD_printfxy(0,1," %3d %3d %3d %3d ",MotorError[0],MotorError[1],MotorError[2],MotorError[3]); |
| LCD_printfxy(0,2," %3d %3d %3d %3d ",MotorError[4],MotorError[5],MotorError[6],MotorError[7]); |
| LCD_printfxy(0,3," %3d %3d %3d %3d ",MotorError[8],MotorError[9],MotorError[10],MotorError[11]); |
| break; |
| |
| case 13: |
| LCD_printfxy(0,0,"BL-Ctrl found " ); |
| LCD_printfxy(0,1," %c %c %c %c ",MotorPresent[0] + '-',MotorPresent[1] + '-',MotorPresent[2] + '-',MotorPresent[3] + '-'); |
| LCD_printfxy(0,2," %c %c %c %c ",MotorPresent[4] + '-',MotorPresent[5] + '-',MotorPresent[6] + '-',MotorPresent[7] + '-'); |
| LCD_printfxy(0,3," %c - - -",MotorPresent[8] + '-'); |
| if(MotorPresent[9]) LCD_printfxy(4,3,"10"); |
| if(MotorPresent[10]) LCD_printfxy(8,3,"11"); |
| if(MotorPresent[11]) LCD_printfxy(12,3,"12"); |
| break; |
| |
| case 14: |
| LCD_printfxy(0,0,"Flight-Time " ); |
| LCD_printfxy(0,1," %5umin",FlugMinuten); |
| LCD_printfxy(0,2,"Total:%5umin",FlugMinutenGesamt); |
| LCD_printfxy(13,3,"(reset)"); |
| if(RemoteKeys & KEY4) // #define KEY4 0x08 |
| { |
| FlugMinuten = 0; |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_MINUTES2],FlugMinuten / 256); // FlugMinuten gesamt auf Null setzen |
| eeprom_write_byte(&EEPromArray[EEPROM_ADR_MINUTES2+1],FlugMinuten % 256); |
| } |
| break; |
| |
| default: |
| MaxMenue = MenuePunkt - 1; |
| MenuePunkt = 0; |
| |
| break; |
| } |
| RemoteKeys = 0; |
| } |
| //------------------------------------------------------------------------------------------------------------------------------------ |