WebSVN - FlightCtrl - Diff - Rev 1944 and 1966 - /branches/V0.86d_ACC-HH_HR


// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
// + Copyright (c) Holger Buss, Ingo Busker
// + only for non-profit use
// + www.MikroKopter.com
// + porting the sources to other systems or using the software on other systems (except hardware from www.mikrokopter.de) is not allowed
// + see the File "License.txt" for further Informations
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
#include "main.h"
#include "eeprom.h"
 
char DisplayBuff[80];
unsigned char DispPtr = 0;
 
unsigned char MaxMenue = 16;
unsigned char MenuePunkt = 0;
unsigned char RemoteKeys = 0;
 
#define KEY1    0x01
#define KEY2    0x02
#define KEY3    0x04
#define KEY4    0x08
#define KEY5    0x10
 
void LcdClear(void)
{
 unsigned char i;
 for(i=0;i<80;i++) DisplayBuff[i] = ' ';
}
 
void Menu_Putchar(char c)
{
 if(DispPtr < 80) DisplayBuff[DispPtr++] = c;
}
 
void Menu(void)
 {
  unsigned char i;
  if(RemoteKeys & KEY1) { if(MenuePunkt) MenuePunkt--; else MenuePunkt = MaxMenue;}
  if(RemoteKeys & KEY2) { if(MenuePunkt == MaxMenue) MenuePunkt = 0; else MenuePunkt++;}
  if((RemoteKeys & KEY1) && (RemoteKeys & KEY2)) MenuePunkt = 0;
  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", GetActiveParamSet(),Mixer.Name);
 
            if(VersionInfo.HardwareError[1] & FC_ERROR1_MIXER) LCD_printfxy(0,3,"Mixer Error!")
                    else
#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))
                        if(NC_ErrorCode)
                        {
                                LCD_printfxy(0,3,"ERR%2d:",NC_ErrorCode);
                                _printf_P(&Menu_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);
                        }
                   else
#endif
                   if(VersionInfo.HardwareError[0]) LCD_printfxy(0,3,"Hardware Error 1:%d !!",VersionInfo.HardwareError[0])
                   else
           if(MissingMotor) LCD_printfxy(0,3,"Missing BL-Ctrl:%d!!",MissingMotor)
#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))
#else
                   else
                        if(NC_ErrorCode)
                        {
                                LCD_printfxy(0,3,"! NC-ERR: %2d ! ",NC_ErrorCode);
                        }
#endif
//                 if(VersionInfo.HardwareError[1]) LCD_printfxy(0,3,"Error 2:%d !!",VersionInfo.HardwareError[1])
                   else
           if(I2CTimeout < 6) LCD_printfxy(0,3,"I2C ERROR!!!")
           break;
    case 1:
          if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)
           {
           LCD_printfxy(0,0,"Height:  %5i",(int)(HoehenWert/5));
           LCD_printfxy(0,1,"Setpoint:%5i",(int)(SollHoehe/5));
           LCD_printfxy(0,2,"Pressure:%5i",MessLuftdruck);
           LCD_printfxy(0,3,"Offset:  %5i",OCR0A);
           }
           else
           {
           LCD_printfxy(0,0,"Height control");
           LCD_printfxy(0,1,"DISABLED");
           //LCD_printfxy(0,2,"Height control");
           //LCD_printfxy(0,3,"DISABLED");
           }
 
           break;
    case 2:
           LCD_printfxy(0,0,"act. bearing");
           LCD_printfxy(0,1,"Nick:      %5i",IntegralNick/1024);
           LCD_printfxy(0,2,"Roll:      %5i",IntegralRoll/1024);
           LCD_printfxy(0,3,"Compass:   %5i",ErsatzKompassInGrad);
           break;
    case 3:
           for(i=1;i<9;i+=2) LCD_printfxy(0,i/2,"K%i:%4i  K%i:%4i ",i,PPM_in[i],i+1,PPM_in[i+1]);
           break;
    case 4:
           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]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]);
           LCD_printfxy(0,2,"P1:%4i  P2:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]]+127);
           LCD_printfxy(0,3,"P3:%4i  P4:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]]+127);
           break;
    case 5:
           LCD_printfxy(0,0,"Gyro - Sensor");
          if(PlatinenVersion == 10)
          {
           LCD_printfxy(0,1,"Nick%4i (%3i.%i)",AdWertNick - AdNeutralNick/8, AdNeutralNick/8, AdNeutralNick%8);
           LCD_printfxy(0,2,"Roll%4i (%3i.%i)",AdWertRoll - AdNeutralRoll/8, AdNeutralRoll/8, AdNeutralRoll%8);
           LCD_printfxy(0,3,"Gier%4i (%3i)",AdNeutralGier - AdWertGier, AdNeutralGier);
          }
          else
          if((PlatinenVersion == 11) || (PlatinenVersion >= 20))
          {
           LCD_printfxy(0,1,"Nick %4i (%3i.%x)",AdWertNick - AdNeutralNick/8, AdNeutralNick/16, (AdNeutralNick%16)/2);
           LCD_printfxy(0,2,"Roll %4i (%3i.%x)",AdWertRoll - AdNeutralRoll/8, AdNeutralRoll/16, (AdNeutralRoll%16)/2);
           LCD_printfxy(0,3,"Yaw  %4i (%3i)",AdNeutralGier - AdWertGier, AdNeutralGier/2);
          }
          else
          if(PlatinenVersion == 13)
          {
           LCD_printfxy(0,1,"Nick %4i (%3i)(%3i)",AdWertNick - AdNeutralNick/8, AdNeutralNick/16,AnalogOffsetNick);
           LCD_printfxy(0,2,"Roll %4i (%3i)(%3i)",AdWertRoll - AdNeutralRoll/8, AdNeutralRoll/16,AnalogOffsetRoll);
           LCD_printfxy(0,3,"Yaw  %4i (%3i)(%3i)",AdNeutralGier - AdWertGier, AdNeutralGier/2,AnalogOffsetGier);
          }
           break;
    case 6:
           LCD_printfxy(0,0,"ACC - Sensor");
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdWertAccNick,NeutralAccX);
           LCD_printfxy(0,2,"Roll %4i (%3i)",AdWertAccRoll,NeutralAccY);
           LCD_printfxy(0,3,"Z    %4i (%3i)",AdWertAccHoch,(int)NeutralAccZ);
           break;
    case 7:
                        LCD_printfxy(0,0,"Voltage:   %3i.%1iV",UBat/10, UBat%10);
                        LCD_printfxy(0,1,"Current:   %3i.%1iA",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);
                        LCD_printfxy(0,2,"Power:     %4iW",Capacity.ActualPower);
                        LCD_printfxy(0,3,"Discharge: %5imAh", Capacity.UsedCapacity);
           break;
    case 8:
           LCD_printfxy(0,0,"Receiver");
           LCD_printfxy(0,1,"RC-RSSI:    %4i", PPM_in[0]);
           LCD_printfxy(0,2,"RC-Quality: %4i", SenderOkay);
           LCD_printfxy(0,3,"RC-Channels:%4i", Channels-1);
           break;
    case 9:
           LCD_printfxy(0,0,"Compass");
           LCD_printfxy(0,1,"Magnet:   %5i",KompassValue);
           LCD_printfxy(0,2,"Gyro:     %5i",ErsatzKompassInGrad);
           LCD_printfxy(0,3,"Setpoint: %5i",KompassSollWert);
           break;
    case 10:
           for(i=0;i<4;i++) LCD_printfxy(0,i,"Poti%i:  %3i",i+1,Poti[i]);
           break;
    case 11:
           for(i=0;i<4;i++) LCD_printfxy(0,i,"Poti%i:  %3i",i+5,Poti[i+4]);
           break;
    case 12:
           LCD_printfxy(0,0,"Servo  " );
           LCD_printfxy(0,1,"Setpoint  %3i",Parameter_ServoNickControl);
           LCD_printfxy(0,2,"Position: %3i",ServoNickValue/4);
           LCD_printfxy(0,3,"Range:%3i-%3i",EE_Parameter.ServoNickMin,EE_Parameter.ServoNickMax);
           break;
/*    case 13:
           LCD_printfxy(0,0,"ExternControl  " );
           LCD_printfxy(0,1,"Ni:%4i  Ro:%4i ",ExternControl.Nick,ExternControl.Roll);
           LCD_printfxy(0,2,"Gs:%4i  Gi:%4i ",ExternControl.Gas,ExternControl.Gier);
           LCD_printfxy(0,3,"Hi:%4i  Cf:%4i ",ExternControl.Hight,ExternControl.Config);
           break;
*/
    case 13:
           LCD_printfxy(0,0,"BL-Ctrl Errors " );
                   for(i=0;i<3;i++)                                                              
                   {
                    LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",Motor[i*4].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+1].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+2].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+3].State & MOTOR_STATE_ERROR_MASK);
//                      if(i*4 >= RequiredMotors) break;
                   }   
           break;
    case 14:
           LCD_printfxy(0,0,"BL Temperature" );
                   for(i=0;i<3;i++)
                    {
                     LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",Motor[i*4].Temperature,Motor[i*4+1].Temperature,Motor[i*4+2].Temperature,Motor[i*4+3].Temperature);
//                       if(4 + i * 4 >= RequiredMotors) break;
                        }                      
           break;
    case 15:
           LCD_printfxy(0,0,"BL-Ctrl found " );
                   LCD_printfxy(0,1," %c   %c   %c   %c ",'-' + 4 * (Motor[0].State>>7),'-' + 5 * (Motor[1].State>>7),'-' + 6 * (Motor[2].State>>7),'-' + 7 * (Motor[3].State>>7));
                   LCD_printfxy(0,2," %c   %c   %c   %c ",'-' + 8 * (Motor[4].State>>7),'-' + 9 * (Motor[5].State>>7),'-' + 10 * (Motor[6].State>>7),'-' + 11 * (Motor[7].State>>7));
                   LCD_printfxy(0,3," %c   -   -   - ",'-' + 12 * (Motor[8].State>>7));
                   if(Motor[9].State>>7)  LCD_printfxy(4,3,"10");
                   if(Motor[10].State>>7) LCD_printfxy(8,3,"11");
                   if(Motor[11].State>>7) LCD_printfxy(12,3,"12");
           break;
    case 16:
           LCD_printfxy(0,0,"Flight-Time  " );
           LCD_printfxy(0,1,"Total:%5umin",FlugMinutenGesamt);
           LCD_printfxy(0,2,"Act:  %5umin",FlugMinuten);
           LCD_printfxy(13,3,"(reset)");
                   if(RemoteKeys & KEY4)
             {
               FlugMinuten = 0;
               SetParamWord(PID_FLIGHT_MINUTES, FlugMinuten);
                         }
           break;
    default:
           if(MenuePunkt == MaxMenue) MaxMenue--;
           MenuePunkt = 0;
           break;
    }
    RemoteKeys = 0;
}
 

Rev 1944	Rev 1966
1	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++	1	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
2	// + Copyright (c) Holger Buss, Ingo Busker	2	// + Copyright (c) Holger Buss, Ingo Busker
3	// + only for non-profit use	3	// + only for non-profit use
4	// + www.MikroKopter.com	4	// + www.MikroKopter.com
5	// + porting the sources to other systems or using the software on other systems (except hardware from www.mikrokopter.de) is not allowed	5	// + porting the sources to other systems or using the software on other systems (except hardware from www.mikrokopter.de) is not allowed
6	// + see the File "License.txt" for further Informations	6	// + see the File "License.txt" for further Informations
7	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++	7	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
8	#include "main.h"	8	#include "main.h"
9	#include "eeprom.h"	9	#include "eeprom.h"
10		10
11	char DisplayBuff[80];	11	char DisplayBuff[80];
12	unsigned char DispPtr = 0;	12	unsigned char DispPtr = 0;
13		13
14	unsigned char MaxMenue = 16;	14	unsigned char MaxMenue = 16;
15	unsigned char MenuePunkt = 0;	15	unsigned char MenuePunkt = 0;
16	unsigned char RemoteKeys = 0;	16	unsigned char RemoteKeys = 0;
17		17
18	#define KEY1 0x01	18	#define KEY1 0x01
19	#define KEY2 0x02	19	#define KEY2 0x02
20	#define KEY3 0x04	20	#define KEY3 0x04
21	#define KEY4 0x08	21	#define KEY4 0x08
22	#define KEY5 0x10	22	#define KEY5 0x10
23		23
24	void LcdClear(void)	24	void LcdClear(void)
25	{	25	{
26	unsigned char i;	26	unsigned char i;
27	for(i=0;i<80;i++) DisplayBuff[i] = ' ';	27	for(i=0;i<80;i++) DisplayBuff[i] = ' ';
28	}	28	}
29		29
30	void Menu_Putchar(char c)	30	void Menu_Putchar(char c)
31	{	31	{
32	if(DispPtr < 80) DisplayBuff[DispPtr++] = c;	32	if(DispPtr < 80) DisplayBuff[DispPtr++] = c;
33	}	33	}
34		34
35	void Menu(void)	35	void Menu(void)
36	{	36	{
37	unsigned char i;	37	unsigned char i;
38	if(RemoteKeys & KEY1) { if(MenuePunkt) MenuePunkt--; else MenuePunkt = MaxMenue;}	38	if(RemoteKeys & KEY1) { if(MenuePunkt) MenuePunkt--; else MenuePunkt = MaxMenue;}
39	if(RemoteKeys & KEY2) { if(MenuePunkt == MaxMenue) MenuePunkt = 0; else MenuePunkt++;}	39	if(RemoteKeys & KEY2) { if(MenuePunkt == MaxMenue) MenuePunkt = 0; else MenuePunkt++;}
40	if((RemoteKeys & KEY1) && (RemoteKeys & KEY2)) MenuePunkt = 0;	40	if((RemoteKeys & KEY1) && (RemoteKeys & KEY2)) MenuePunkt = 0;
41	LcdClear();	41	LcdClear();
42	if(MenuePunkt < 10) {LCD_printfxy(17,0,"[%i]",MenuePunkt);}	42	if(MenuePunkt < 10) {LCD_printfxy(17,0,"[%i]",MenuePunkt);}
43	else {LCD_printfxy(16,0,"[%i]",MenuePunkt);};	43	else {LCD_printfxy(16,0,"[%i]",MenuePunkt);};
44		44
45	switch(MenuePunkt)	45	switch(MenuePunkt)
46	{	46	{
47	case 0:	47	case 0:
48	LCD_printfxy(0,0,"+ MikroKopter +");	48	LCD_printfxy(0,0,"+ MikroKopter +");
49	LCD_printfxy(0,1,"HW:V%d.%d SW:%d.%d%c",PlatinenVersion/10,PlatinenVersion%10, VERSION_MAJOR, VERSION_MINOR, VERSION_PATCH +'a');	49	LCD_printfxy(0,1,"HW:V%d.%d SW:%d.%d%c",PlatinenVersion/10,PlatinenVersion%10, VERSION_MAJOR, VERSION_MINOR, VERSION_PATCH +'a');
50	LCD_printfxy(0,2,"Setting:%d %s", GetActiveParamSet(),Mixer.Name);	50	LCD_printfxy(0,2,"Setting:%d %s", GetActiveParamSet(),Mixer.Name);
51		51
52	if(VersionInfo.HardwareError[1] & FC_ERROR1_MIXER) LCD_printfxy(0,3,"Mixer Error!")	52	if(VersionInfo.HardwareError[1] & FC_ERROR1_MIXER) LCD_printfxy(0,3,"Mixer Error!")
53	else	53	else
54	#if (defined(__AVR_ATmega1284__) \|\| defined(__AVR_ATmega1284P__))	54	#if (defined(__AVR_ATmega1284__) \|\| defined(__AVR_ATmega1284P__))
55	if(NC_ErrorCode)	55	if(NC_ErrorCode)
56	{	56	{
57	LCD_printfxy(0,3,"ERR%2d:",NC_ErrorCode);	57	LCD_printfxy(0,3,"ERR%2d:",NC_ErrorCode);
58	_printf_P(&Menu_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);	58	_printf_P(&Menu_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);
59	}	59	}
60	else	60	else
61	#endif	61	#endif
62	if(VersionInfo.HardwareError[0]) LCD_printfxy(0,3,"Hardware Error 1:%d !!",VersionInfo.HardwareError[0])	62	if(VersionInfo.HardwareError[0]) LCD_printfxy(0,3,"Hardware Error 1:%d !!",VersionInfo.HardwareError[0])
63	else	63	else
64	if(MissingMotor) LCD_printfxy(0,3,"Missing BL-Ctrl:%d!!",MissingMotor)	64	if(MissingMotor) LCD_printfxy(0,3,"Missing BL-Ctrl:%d!!",MissingMotor)
65	#if (defined(__AVR_ATmega1284__) \|\| defined(__AVR_ATmega1284P__))	65	#if (defined(__AVR_ATmega1284__) \|\| defined(__AVR_ATmega1284P__))
66	#else	66	#else
67	else	67	else
68	if(NC_ErrorCode)	68	if(NC_ErrorCode)
69	{	69	{
70	LCD_printfxy(0,3,"! NC-ERR: %2d ! ",NC_ErrorCode);	70	LCD_printfxy(0,3,"! NC-ERR: %2d ! ",NC_ErrorCode);
71	}	71	}
72	#endif	72	#endif
73	// if(VersionInfo.HardwareError[1]) LCD_printfxy(0,3,"Error 2:%d !!",VersionInfo.HardwareError[1])	73	// if(VersionInfo.HardwareError[1]) LCD_printfxy(0,3,"Error 2:%d !!",VersionInfo.HardwareError[1])
74	else	74	else
75	if(I2CTimeout < 6) LCD_printfxy(0,3,"I2C ERROR!!!")	75	if(I2CTimeout < 6) LCD_printfxy(0,3,"I2C ERROR!!!")
76	break;	76	break;
77	case 1:	77	case 1:
78	if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)	78	if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)
79	{	79	{
80	LCD_printfxy(0,0,"Height: %5i",(int)(HoehenWert/5));	80	LCD_printfxy(0,0,"Height: %5i",(int)(HoehenWert/5));
81	LCD_printfxy(0,1,"Setpoint:%5i",(int)(SollHoehe/5));	81	LCD_printfxy(0,1,"Setpoint:%5i",(int)(SollHoehe/5));
82	LCD_printfxy(0,2,"Pressure:%5i",MessLuftdruck);	82	LCD_printfxy(0,2,"Pressure:%5i",MessLuftdruck);
83	LCD_printfxy(0,3,"Offset: %5i",OCR0A);	83	LCD_printfxy(0,3,"Offset: %5i",OCR0A);
84	}	84	}
85	else	85	else
86	{	86	{
87	LCD_printfxy(0,0,"Height control");	87	LCD_printfxy(0,0,"Height control");
88	LCD_printfxy(0,1,"DISABLED");	88	LCD_printfxy(0,1,"DISABLED");
89	//LCD_printfxy(0,2,"Height control");	89	//LCD_printfxy(0,2,"Height control");
90	//LCD_printfxy(0,3,"DISABLED");	90	//LCD_printfxy(0,3,"DISABLED");
91	}	91	}
92		92
93	break;	93	break;
94	case 2:	94	case 2:
95	LCD_printfxy(0,0,"act. bearing");	95	LCD_printfxy(0,0,"act. bearing");
96	LCD_printfxy(0,1,"Nick: %5i",IntegralNick/1024);	96	LCD_printfxy(0,1,"Nick: %5i",IntegralNick/1024);
97	LCD_printfxy(0,2,"Roll: %5i",IntegralRoll/1024);	97	LCD_printfxy(0,2,"Roll: %5i",IntegralRoll/1024);
98	LCD_printfxy(0,3,"Compass: %5i",ErsatzKompassInGrad);	98	LCD_printfxy(0,3,"Compass: %5i",ErsatzKompassInGrad);
99	break;	99	break;
100	case 3:	100	case 3:
101	for(i=0;i<8;i+=2) LCD_printfxy(0,i/2,"K%i:%4i K%i:%4i ",i,PPM_in[i+1],i+1,PPM_in[i+2]);	101	for(i=1;i<9;i+=2) LCD_printfxy(0,i/2,"K%i:%4i K%i:%4i ",i,PPM_in[i],i+1,PPM_in[i+1]);
102	break;	102	break;
103	case 4:	103	case 4:
104	LCD_printfxy(0,0,"Ni:%4i Ro:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_NICK]],PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]);	104	LCD_printfxy(0,0,"Ni:%4i Ro:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_NICK]],PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]);
105	LCD_printfxy(0,1,"Gs:%4i Gi:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_GAS]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]);	105	LCD_printfxy(0,1,"Gs:%4i Gi:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_GAS]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]);
106	LCD_printfxy(0,2,"P1:%4i P2:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]]+127);	106	LCD_printfxy(0,2,"P1:%4i P2:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]]+127);
107	LCD_printfxy(0,3,"P3:%4i P4:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]]+127);	107	LCD_printfxy(0,3,"P3:%4i P4:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]]+127);
108	break;	108	break;
109	case 5:	109	case 5:
110	LCD_printfxy(0,0,"Gyro - Sensor");	110	LCD_printfxy(0,0,"Gyro - Sensor");
111	if(PlatinenVersion == 10)	111	if(PlatinenVersion == 10)
112	{	112	{
113	LCD_printfxy(0,1,"Nick%4i (%3i.%i)",AdWertNick - AdNeutralNick/8, AdNeutralNick/8, AdNeutralNick%8);	113	LCD_printfxy(0,1,"Nick%4i (%3i.%i)",AdWertNick - AdNeutralNick/8, AdNeutralNick/8, AdNeutralNick%8);
114	LCD_printfxy(0,2,"Roll%4i (%3i.%i)",AdWertRoll - AdNeutralRoll/8, AdNeutralRoll/8, AdNeutralRoll%8);	114	LCD_printfxy(0,2,"Roll%4i (%3i.%i)",AdWertRoll - AdNeutralRoll/8, AdNeutralRoll/8, AdNeutralRoll%8);
115	LCD_printfxy(0,3,"Gier%4i (%3i)",AdNeutralGier - AdWertGier, AdNeutralGier);	115	LCD_printfxy(0,3,"Gier%4i (%3i)",AdNeutralGier - AdWertGier, AdNeutralGier);
116	}	116	}
117	else	117	else
118	if((PlatinenVersion == 11) \|\| (PlatinenVersion >= 20))	118	if((PlatinenVersion == 11) \|\| (PlatinenVersion >= 20))
119	{	119	{
120	LCD_printfxy(0,1,"Nick %4i (%3i.%x)",AdWertNick - AdNeutralNick/8, AdNeutralNick/16, (AdNeutralNick%16)/2);	120	LCD_printfxy(0,1,"Nick %4i (%3i.%x)",AdWertNick - AdNeutralNick/8, AdNeutralNick/16, (AdNeutralNick%16)/2);
121	LCD_printfxy(0,2,"Roll %4i (%3i.%x)",AdWertRoll - AdNeutralRoll/8, AdNeutralRoll/16, (AdNeutralRoll%16)/2);	121	LCD_printfxy(0,2,"Roll %4i (%3i.%x)",AdWertRoll - AdNeutralRoll/8, AdNeutralRoll/16, (AdNeutralRoll%16)/2);
122	LCD_printfxy(0,3,"Yaw %4i (%3i)",AdNeutralGier - AdWertGier, AdNeutralGier/2);	122	LCD_printfxy(0,3,"Yaw %4i (%3i)",AdNeutralGier - AdWertGier, AdNeutralGier/2);
123	}	123	}
124	else	124	else
125	if(PlatinenVersion == 13)	125	if(PlatinenVersion == 13)
126	{	126	{
127	LCD_printfxy(0,1,"Nick %4i (%3i)(%3i)",AdWertNick - AdNeutralNick/8, AdNeutralNick/16,AnalogOffsetNick);	127	LCD_printfxy(0,1,"Nick %4i (%3i)(%3i)",AdWertNick - AdNeutralNick/8, AdNeutralNick/16,AnalogOffsetNick);
128	LCD_printfxy(0,2,"Roll %4i (%3i)(%3i)",AdWertRoll - AdNeutralRoll/8, AdNeutralRoll/16,AnalogOffsetRoll);	128	LCD_printfxy(0,2,"Roll %4i (%3i)(%3i)",AdWertRoll - AdNeutralRoll/8, AdNeutralRoll/16,AnalogOffsetRoll);
129	LCD_printfxy(0,3,"Yaw %4i (%3i)(%3i)",AdNeutralGier - AdWertGier, AdNeutralGier/2,AnalogOffsetGier);	129	LCD_printfxy(0,3,"Yaw %4i (%3i)(%3i)",AdNeutralGier - AdWertGier, AdNeutralGier/2,AnalogOffsetGier);
130	}	130	}
131	break;	131	break;
132	case 6:	132	case 6:
133	LCD_printfxy(0,0,"ACC - Sensor");	133	LCD_printfxy(0,0,"ACC - Sensor");
134	LCD_printfxy(0,1,"Nick %4i (%3i)",AdWertAccNick,NeutralAccX);	134	LCD_printfxy(0,1,"Nick %4i (%3i)",AdWertAccNick,NeutralAccX);
135	LCD_printfxy(0,2,"Roll %4i (%3i)",AdWertAccRoll,NeutralAccY);	135	LCD_printfxy(0,2,"Roll %4i (%3i)",AdWertAccRoll,NeutralAccY);
136	LCD_printfxy(0,3,"Z %4i (%3i)",AdWertAccHoch,(int)NeutralAccZ);	136	LCD_printfxy(0,3,"Z %4i (%3i)",AdWertAccHoch,(int)NeutralAccZ);
137	break;	137	break;
138	case 7:	138	case 7:
139	LCD_printfxy(0,0,"Voltage: %3i.%1iV",UBat/10, UBat%10);	139	LCD_printfxy(0,0,"Voltage: %3i.%1iV",UBat/10, UBat%10);
140	LCD_printfxy(0,1,"Current: %3i.%1iA",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);	140	LCD_printfxy(0,1,"Current: %3i.%1iA",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);
141	LCD_printfxy(0,2,"Power: %4iW",Capacity.ActualPower);	141	LCD_printfxy(0,2,"Power: %4iW",Capacity.ActualPower);
142	LCD_printfxy(0,3,"Discharge: %5imAh", Capacity.UsedCapacity);	142	LCD_printfxy(0,3,"Discharge: %5imAh", Capacity.UsedCapacity);
143	break;	143	break;
144	case 8:	144	case 8:
145	LCD_printfxy(0,0,"Receiver");	145	LCD_printfxy(0,0,"Receiver");
146	LCD_printfxy(0,1,"RC-RSSI: %4i", PPM_in[0]);	146	LCD_printfxy(0,1,"RC-RSSI: %4i", PPM_in[0]);
147	LCD_printfxy(0,2,"RC-Quality: %4i", SenderOkay);	147	LCD_printfxy(0,2,"RC-Quality: %4i", SenderOkay);
148	LCD_printfxy(0,3,"RC-Channels:%4i", Channels-1);	148	LCD_printfxy(0,3,"RC-Channels:%4i", Channels-1);
149	break;	149	break;
150	case 9:	150	case 9:
151	LCD_printfxy(0,0,"Compass");	151	LCD_printfxy(0,0,"Compass");
152	LCD_printfxy(0,1,"Magnet: %5i",KompassValue);	152	LCD_printfxy(0,1,"Magnet: %5i",KompassValue);
153	LCD_printfxy(0,2,"Gyro: %5i",ErsatzKompassInGrad);	153	LCD_printfxy(0,2,"Gyro: %5i",ErsatzKompassInGrad);
154	LCD_printfxy(0,3,"Setpoint: %5i",KompassSollWert);	154	LCD_printfxy(0,3,"Setpoint: %5i",KompassSollWert);
155	break;	155	break;
156	case 10:	156	case 10:
157	for(i=0;i<4;i++) LCD_printfxy(0,i,"Poti%i: %3i",i+1,Poti[i]);	157	for(i=0;i<4;i++) LCD_printfxy(0,i,"Poti%i: %3i",i+1,Poti[i]);
158	break;	158	break;
159	case 11:	159	case 11:
160	for(i=0;i<4;i++) LCD_printfxy(0,i,"Poti%i: %3i",i+5,Poti[i+4]);	160	for(i=0;i<4;i++) LCD_printfxy(0,i,"Poti%i: %3i",i+5,Poti[i+4]);
161	break;	161	break;
162	case 12:	162	case 12:
163	LCD_printfxy(0,0,"Servo " );	163	LCD_printfxy(0,0,"Servo " );
164	LCD_printfxy(0,1,"Setpoint %3i",Parameter_ServoNickControl);	164	LCD_printfxy(0,1,"Setpoint %3i",Parameter_ServoNickControl);
165	LCD_printfxy(0,2,"Position: %3i",ServoNickValue/4);	165	LCD_printfxy(0,2,"Position: %3i",ServoNickValue/4);
166	LCD_printfxy(0,3,"Range:%3i-%3i",EE_Parameter.ServoNickMin,EE_Parameter.ServoNickMax);	166	LCD_printfxy(0,3,"Range:%3i-%3i",EE_Parameter.ServoNickMin,EE_Parameter.ServoNickMax);
167	break;	167	break;
168	/* case 13:	168	/* case 13:
169	LCD_printfxy(0,0,"ExternControl " );	169	LCD_printfxy(0,0,"ExternControl " );
170	LCD_printfxy(0,1,"Ni:%4i Ro:%4i ",ExternControl.Nick,ExternControl.Roll);	170	LCD_printfxy(0,1,"Ni:%4i Ro:%4i ",ExternControl.Nick,ExternControl.Roll);
171	LCD_printfxy(0,2,"Gs:%4i Gi:%4i ",ExternControl.Gas,ExternControl.Gier);	171	LCD_printfxy(0,2,"Gs:%4i Gi:%4i ",ExternControl.Gas,ExternControl.Gier);
172	LCD_printfxy(0,3,"Hi:%4i Cf:%4i ",ExternControl.Hight,ExternControl.Config);	172	LCD_printfxy(0,3,"Hi:%4i Cf:%4i ",ExternControl.Hight,ExternControl.Config);
173	break;	173	break;
174	*/	174	*/
175	case 13:	175	case 13:
176	LCD_printfxy(0,0,"BL-Ctrl Errors " );	176	LCD_printfxy(0,0,"BL-Ctrl Errors " );
177	for(i=0;i<3;i++)	177	for(i=0;i<3;i++)
178	{	178	{
179	LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",Motor[i4].State & MOTOR_STATE_ERROR_MASK,Motor[i4+1].State & MOTOR_STATE_ERROR_MASK,Motor[i4+2].State & MOTOR_STATE_ERROR_MASK,Motor[i4+3].State & MOTOR_STATE_ERROR_MASK);	179	LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",Motor[i4].State & MOTOR_STATE_ERROR_MASK,Motor[i4+1].State & MOTOR_STATE_ERROR_MASK,Motor[i4+2].State & MOTOR_STATE_ERROR_MASK,Motor[i4+3].State & MOTOR_STATE_ERROR_MASK);
180	// if(i*4 >= RequiredMotors) break;	180	// if(i*4 >= RequiredMotors) break;
181	}	181	}
182	break;	182	break;
183	case 14:	183	case 14:
184	LCD_printfxy(0,0,"BL Temperature" );	184	LCD_printfxy(0,0,"BL Temperature" );
185	for(i=0;i<3;i++)	185	for(i=0;i<3;i++)
186	{	186	{
187	LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",Motor[i4].Temperature,Motor[i4+1].Temperature,Motor[i4+2].Temperature,Motor[i4+3].Temperature);	187	LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",Motor[i4].Temperature,Motor[i4+1].Temperature,Motor[i4+2].Temperature,Motor[i4+3].Temperature);
188	// if(4 + i * 4 >= RequiredMotors) break;	188	// if(4 + i * 4 >= RequiredMotors) break;
189	}	189	}
190	break;	190	break;
191	case 15:	191	case 15:
192	LCD_printfxy(0,0,"BL-Ctrl found " );	192	LCD_printfxy(0,0,"BL-Ctrl found " );
193	LCD_printfxy(0,1," %c %c %c %c ",'-' + 4 * (Motor[0].State>>7),'-' + 5 * (Motor[1].State>>7),'-' + 6 * (Motor[2].State>>7),'-' + 7 * (Motor[3].State>>7));	193	LCD_printfxy(0,1," %c %c %c %c ",'-' + 4 * (Motor[0].State>>7),'-' + 5 * (Motor[1].State>>7),'-' + 6 * (Motor[2].State>>7),'-' + 7 * (Motor[3].State>>7));
194	LCD_printfxy(0,2," %c %c %c %c ",'-' + 8 * (Motor[4].State>>7),'-' + 9 * (Motor[5].State>>7),'-' + 10 * (Motor[6].State>>7),'-' + 11 * (Motor[7].State>>7));	194	LCD_printfxy(0,2," %c %c %c %c ",'-' + 8 * (Motor[4].State>>7),'-' + 9 * (Motor[5].State>>7),'-' + 10 * (Motor[6].State>>7),'-' + 11 * (Motor[7].State>>7));
195	LCD_printfxy(0,3," %c - - - ",'-' + 12 * (Motor[8].State>>7));	195	LCD_printfxy(0,3," %c - - - ",'-' + 12 * (Motor[8].State>>7));
196	if(Motor[9].State>>7) LCD_printfxy(4,3,"10");	196	if(Motor[9].State>>7) LCD_printfxy(4,3,"10");
197	if(Motor[10].State>>7) LCD_printfxy(8,3,"11");	197	if(Motor[10].State>>7) LCD_printfxy(8,3,"11");
198	if(Motor[11].State>>7) LCD_printfxy(12,3,"12");	198	if(Motor[11].State>>7) LCD_printfxy(12,3,"12");
199	break;	199	break;
200	case 16:	200	case 16:
201	LCD_printfxy(0,0,"Flight-Time " );	201	LCD_printfxy(0,0,"Flight-Time " );
202	LCD_printfxy(0,1,"Total:%5umin",FlugMinutenGesamt);	202	LCD_printfxy(0,1,"Total:%5umin",FlugMinutenGesamt);
203	LCD_printfxy(0,2,"Act: %5umin",FlugMinuten);	203	LCD_printfxy(0,2,"Act: %5umin",FlugMinuten);
204	LCD_printfxy(13,3,"(reset)");	204	LCD_printfxy(13,3,"(reset)");
205	if(RemoteKeys & KEY4)	205	if(RemoteKeys & KEY4)
206	{	206	{
207	FlugMinuten = 0;	207	FlugMinuten = 0;
208	SetParamWord(PID_FLIGHT_MINUTES, FlugMinuten);	208	SetParamWord(PID_FLIGHT_MINUTES, FlugMinuten);
209	}	209	}
210	break;	210	break;
211	default:	211	default:
212	if(MenuePunkt == MaxMenue) MaxMenue--;	212	if(MenuePunkt == MaxMenue) MaxMenue--;
213	MenuePunkt = 0;	213	MenuePunkt = 0;
214	break;	214	break;
215	}	215	}
216	RemoteKeys = 0;	216	RemoteKeys = 0;
217	}	217	}
218		218

Subversion Repositories FlightCtrl

(root)/branches/V0.86d_ACC-HH_HR_MartinR/menu.c @ 2403 - Rev 1944 → 1966