WebSVN - FlightCtrl - Blame - Rev 1675 - /branches/thjac/V1

Rev	Author	Line No.	Line
1263	thjac	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	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
		7	#include "main.h"
		8	#include "altcon.h"
		9	#include "pitch.h"
		10	#include "pitch_md.h"
		11	#include "parameter.h"
		12	#include "fc.h"
		13
		14	unsigned int TestInt = 0;
		15	#define ARRAYGROESSE 10
		16	unsigned char Array[ARRAYGROESSE] = {1,2,3,4,5,6,7,8,9,10};
		17	char DisplayBuff[80] = "Hallo Welt";
		18	unsigned char DispPtr = 0;
		19
1269	thjac	20	unsigned char MaxMenue = 15;
1263	thjac	21	unsigned char MenuePunkt = 0;
		22	unsigned char RemoteKeys = 0;
		23
		24	#define KEY1 0x01
		25	#define KEY2 0x02
		26	#define KEY3 0x04
		27	#define KEY4 0x08
		28	#define KEY5 0x10
		29
		30	void LcdClear(void)
		31	{
		32	unsigned char i;
		33	for(i=0;i<80;i++) DisplayBuff[i] = ' ';
		34	}
		35
		36	void Menu(void)
		37	{
		38
		39	if(MenuePunkt > MaxMenue) MenuePunkt = MaxMenue;
		40
		41	if(RemoteKeys & KEY1) { if(MenuePunkt) MenuePunkt--; else MenuePunkt = MaxMenue;}
		42	if(RemoteKeys & KEY2) { if(MenuePunkt == MaxMenue) MenuePunkt = 0; else MenuePunkt++;}
		43	if((RemoteKeys & KEY1) && (RemoteKeys & KEY2)) MenuePunkt = 0;
		44	LcdClear();
		45	if(MenuePunkt < 10) {LCD_printfxy(17,0,"[%i]",MenuePunkt);}
		46	else {LCD_printfxy(16,0,"[%i]",MenuePunkt);};
		47
		48
		49	switch(MenuePunkt)
		50	{
		51	case 0:
		52	LCD_printfxy(0,0,"+ MikroKopter +");
		53	LCD_printfxy(0,1,"HW:V%d.%d SW:%d.%d%c",PlatinenVersion/10,PlatinenVersion%10, VERSION_MAJOR, VERSION_MINOR, VERSION_PATCH +'a');
		54	LCD_printfxy(0,2,"Setting:%d %s",GetActiveParamSetNumber(),Mixer.Name);
		55	if(I2CTimeout < 6) LCD_printfxy(0,3,"I2C ERROR!!!")
		56	else
		57	if(MissingMotor) LCD_printfxy(0,3,"Missing BL-Ctrl:%d!!",MissingMotor)
		58	else LCD_printfxy(0,3,"(c) Holger Buss");
		59	// if(RemoteTasten & KEY3) TestInt--;
		60	// if(RemoteTasten & KEY4) TestInt++;
		61	break;
		62	case 1:
		63	if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)
		64	{
		65	LCD_printfxy(0,0,"Hoehe: %5i",HoehenWert);
		66	LCD_printfxy(0,1,"SollHoehe: %5i",SollHoehe);
		67	LCD_printfxy(0,2,"Luftdruck: %5i",MessLuftdruck);
		68	LCD_printfxy(0,3,"Off : %5i",DruckOffsetSetting);
		69	}
		70	else
		71	{
		72	LCD_printfxy(0,1,"Keine ");
		73	LCD_printfxy(0,2,"H�henregelung");
		74	}
		75
		76	break;
		77	case 2:
		78	LCD_printfxy(0,0,"akt. Lage");
		79	LCD_printfxy(0,1,"Nick: %5i",IntegralNick/1024);
		80	LCD_printfxy(0,2,"Roll: %5i",IntegralRoll/1024);
		81	LCD_printfxy(0,3,"Kompass: %5i",KompassValue);
		82	break;
		83	case 3:
		84	LCD_printfxy(0,0,"K1:%4i K2:%4i ",PPM_in[1],PPM_in[2]);
		85	LCD_printfxy(0,1,"K3:%4i K4:%4i ",PPM_in[3],PPM_in[4]);
		86	LCD_printfxy(0,2,"K5:%4i K6:%4i ",PPM_in[5],PPM_in[6]);
		87	LCD_printfxy(0,3,"K7:%4i K8:%4i ",PPM_in[7],PPM_in[8]);
		88	break;
		89	case 4:
		90	LCD_printfxy(0,0,"Ni:%4i Ro:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_NICK]],PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]);
		91	LCD_printfxy(0,1,"Gs:%4i Gi:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_GAS]],PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]);
		92	LCD_printfxy(0,2,"P1:%4i P2:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]],PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]]);
		93	LCD_printfxy(0,3,"P3:%4i P4:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]],PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]]);
		94	break;
		95	case 5:
		96	LCD_printfxy(0,0,"Gyro - Sensor");
		97	if(PlatinenVersion == 10)
		98	{
		99	LCD_printfxy(0,1,"Nick %4i (%3i.%i)",AdWertNick - AdNeutralNick/8, AdNeutralNick/8, AdNeutralNick%8);
		100	LCD_printfxy(0,2,"Roll %4i (%3i.%i)",AdWertRoll - AdNeutralRoll/8, AdNeutralRoll/8, AdNeutralRoll%8);
		101	LCD_printfxy(0,3,"Gier %4i (%3i)",AdNeutralGier - AdWertGier, AdNeutralGier);
		102	}
		103	else
		104	if((PlatinenVersion == 11) \|\| (PlatinenVersion == 20))
		105	{
		106	LCD_printfxy(0,1,"Nick %4i (%3i.%x)",AdWertNick - AdNeutralNick/8, AdNeutralNick/16, (AdNeutralNick%16)/2);
		107	LCD_printfxy(0,2,"Roll %4i (%3i.%x)",AdWertRoll - AdNeutralRoll/8, AdNeutralRoll/16, (AdNeutralRoll%16)/2);
		108	LCD_printfxy(0,3,"Gier %4i (%3i)",AdNeutralGier - AdWertGier, AdNeutralGier/2);
		109	}
		110	else
		111	if(PlatinenVersion == 13)
		112	{
		113	LCD_printfxy(0,1,"Nick %4i (%3i)(%3i)",AdWertNick - AdNeutralNick/8, AdNeutralNick/16,AnalogOffsetNick);
		114	LCD_printfxy(0,2,"Roll %4i (%3i)(%3i)",AdWertRoll - AdNeutralRoll/8, AdNeutralRoll/16,AnalogOffsetRoll);
		115	LCD_printfxy(0,3,"Gier %4i (%3i)(%3i)",AdNeutralGier - AdWertGier, AdNeutralGier/2,AnalogOffsetGier);
		116	}
		117
		118	break;
		119	case 6:
		120	LCD_printfxy(0,0,"ACC - Sensor");
		121	LCD_printfxy(0,1,"Nick %4i (%3i)",AdWertAccNick,NeutralAccX);
		122	LCD_printfxy(0,2,"Roll %4i (%3i)",AdWertAccRoll,NeutralAccY);
		123	LCD_printfxy(0,3,"Hoch %4i (%3i)",Mittelwert_AccHoch/accumulate_AccHoch / messanzahl_AccHoch/,(int)NeutralAccZ);
		124	break;
		125	case 7:
		126	LCD_printfxy(0,1,"Spannung: %5i",UBat);
		127	LCD_printfxy(0,2,"Empf.Pegel:%5i",SenderOkay);
		128	break;
		129	case 8:
		130	LCD_printfxy(0,0,"Kompass ");
		131	LCD_printfxy(0,1,"Richtung: %5i",KompassRichtung);
		132	LCD_printfxy(0,2,"Messwert: %5i",KompassValue);
		133	LCD_printfxy(0,3,"Start: %5i",KompassStartwert);
		134	break;
		135	case 9:
		136	LCD_printfxy(0,0,"Poti1: %3i",Poti1);
		137	LCD_printfxy(0,1,"Poti2: %3i",Poti2);
		138	LCD_printfxy(0,2,"Poti3: %3i",Poti3);
		139	LCD_printfxy(0,3,"Poti4: %3i",Poti4);
		140	break;
		141	case 10:
		142	LCD_printfxy(0,0,"Servo " );
		143	LCD_printfxy(0,1,"Setpoint %3i",Parameter_ServoNickControl);
		144	LCD_printfxy(0,2,"Stellung: %3i",ServoValue);
		145	LCD_printfxy(0,3,"Range:%3i-%3i",EE_Parameter.ServoNickMin,EE_Parameter.ServoNickMax);
		146	break;
		147	case 11:
		148	LCD_printfxy(0,0,"ExternControl " );
		149	LCD_printfxy(0,1,"Ni:%4i Ro:%4i ",ExternControl.Nick,ExternControl.Roll);
		150	LCD_printfxy(0,2,"Gs:%4i Gi:%4i ",ExternControl.Gas,ExternControl.Gier);
		151	LCD_printfxy(0,3,"Hi:%4i Cf:%4i ",ExternControl.Hight,ExternControl.Config);
		152	break;
		153	case 12:
		154	LCD_printfxy(0,0,"BL-Ctrl Errors " );
		155	LCD_printfxy(0,1," %3d %3d %3d %3d ",MotorError[0],MotorError[1],MotorError[2],MotorError[3]);
		156	LCD_printfxy(0,2," %3d %3d %3d %3d ",MotorError[4],MotorError[5],MotorError[6],MotorError[7]);
		157	LCD_printfxy(0,3," %3d %3d %3d %3d ",MotorError[8],MotorError[9],MotorError[10],MotorError[11]);
		158	break;
		159	case 13:
		160	LCD_printfxy(0,0,"BL-Ctrl found " );
		161	LCD_printfxy(0,1," %c %c %c %c ",MotorPresent[0] + '-',MotorPresent[1] + '-',MotorPresent[2] + '-',MotorPresent[3] + '-');
		162	LCD_printfxy(0,2," %c %c %c %c ",MotorPresent[4] + '-',MotorPresent[5] + '-',MotorPresent[6] + '-',MotorPresent[7] + '-');
		163	LCD_printfxy(0,3," %c - - -",MotorPresent[8] + '-');
		164	if(MotorPresent[9]) LCD_printfxy(4,3,"10");
		165	if(MotorPresent[10]) LCD_printfxy(8,3,"11");
		166	if(MotorPresent[11]) LCD_printfxy(12,3,"12");
		167	break;
		168	case 14:
1269	thjac	169	LCD_printfxy( 0, 0, "PitchControl 1 " );
1263	thjac	170	LCD_printfxy( 0, 1, "Modus : %2s", pitchModeStrings[ pitch_currentMode() ] );
		171
		172	// MD-Modus
		173	switch( pitch_currentMode() ) {
		174	case PARAM_PITCH_MODE_MD:
		175	LCD_printfxy( 0, 2, "Standgas (%02d): %3i", PARAM_PITCH_HOVER_PERCENT, pitch_standValue() );
		176	LCD_printfxy( 0, 3, "Schwebegas : %3i", pitch_hoverValue() );
		177	break;
		178	}
		179	break;
1269	thjac	180	case 15:
		181	LCD_printfxy( 0, 0, "PitchControl 2 " );
		182	LCD_printfxy( 0, 1, "Stick-Delta : %2d", pitch_neutralDiffMD() );
		183	break;
1263	thjac	184	default: MaxMenue = MenuePunkt - 1;
		185	MenuePunkt = 0;
		186	break;
		187	}
		188	RemoteKeys = 0;
		189	}

Subversion Repositories FlightCtrl

(root)/branches/thjac/V1_13/menu.c - Rev 1675