WebSVN - NaviCtrl - Blame - Rev 693

Rev	Author	Line No.	Line
1	ingob	1	/#######################################################################################/
		2	/* !!! THIS IS NOT FREE SOFTWARE !!! */
		3	/#######################################################################################/
		4	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
		5	// + Copyright (c) 2008 Ingo Busker, Holger Buss
171	ingob	6	// + Nur f�r den privaten Gebrauch / NON-COMMERCIAL USE ONLY
1	ingob	7	// + FOR NON COMMERCIAL USE ONLY
		8	// + www.MikroKopter.com
		9	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
41	ingob	10	// + Es gilt f�r das gesamte Projekt (Hardware, Software, Bin�rfiles, Sourcecode und Dokumentation),
		11	// + dass eine Nutzung (auch auszugsweise) nur f�r den privaten (nicht-kommerziellen) Gebrauch zul�ssig ist.
		12	// + Sollten direkte oder indirekte kommerzielle Absichten verfolgt werden, ist mit uns (info@mikrokopter.de) Kontakt
		13	// + bzgl. der Nutzungsbedingungen aufzunehmen.
1	ingob	14	// + Eine kommerzielle Nutzung ist z.B.Verkauf von MikroKoptern, Best�ckung und Verkauf von Platinen oder Baus�tzen,
		15	// + Verkauf von Luftbildaufnahmen, usw.
		16	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
41	ingob	17	// + Werden Teile des Quellcodes (mit oder ohne Modifikation) weiterverwendet oder ver�ffentlicht,
1	ingob	18	// + unterliegen sie auch diesen Nutzungsbedingungen und diese Nutzungsbedingungen incl. Copyright m�ssen dann beiliegen
		19	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
		20	// + Sollte die Software (auch auszugesweise) oder sonstige Informationen des MikroKopter-Projekts
		21	// + auf anderen Webseiten oder sonstigen Medien ver�ffentlicht werden, muss unsere Webseite "http://www.mikrokopter.de"
		22	// + eindeutig als Ursprung verlinkt werden
		23	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
		24	// + Keine Gew�hr auf Fehlerfreiheit, Vollst�ndigkeit oder Funktion
		25	// + Benutzung auf eigene Gefahr
		26	// + Wir �bernehmen keinerlei Haftung f�r direkte oder indirekte Personen- oder Sachsch�den
		27	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
171	ingob	28	// + Die Portierung oder Nutzung der Software (oder Teile davon) auf andere Systeme (ausser der Hardware von www.mikrokopter.de) ist nur
1	ingob	29	// + mit unserer Zustimmung zul�ssig
		30	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
		31	// + Die Funktion printf_P() unterliegt ihrer eigenen Lizenz und ist hiervon nicht betroffen
		32	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
41	ingob	33	// + Redistributions of source code (with or without modifications) must retain the above copyright notice,
1	ingob	34	// + this list of conditions and the following disclaimer.
		35	// + * Neither the name of the copyright holders nor the names of contributors may be used to endorse or promote products derived
		36	// + from this software without specific prior written permission.
41	ingob	37	// + * The use of this project (hardware, software, binary files, sources and documentation) is only permitted
1	ingob	38	// + for non-commercial use (directly or indirectly)
41	ingob	39	// + Commercial use (for excample: selling of MikroKopters, selling of PCBs, assembly, ...) is only permitted
1	ingob	40	// + with our written permission
41	ingob	41	// + * If sources or documentations are redistributet on other webpages, out webpage (http://www.MikroKopter.de) must be
		42	// + clearly linked as origin
171	ingob	43	// + * porting the sources to other systems or using the software on other systems (except hardware from www.mikrokopter.de) is not allowed
1	ingob	44	//
		45	// + THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
		46	// + AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
		47	// + IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
		48	// + ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
		49	// + LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
		50	// + CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
		51	// + SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
		52	// + INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
		53	// + CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
		54	// + ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
41	ingob	55	// + POSSIBILITY OF SUCH DAMAGE.
1	ingob	56	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
41	ingob	57	#include <stdlib.h>
		58	#include "91x_lib.h"
1	ingob	59	#include "main.h"
264	killagreg	60	#include "led.h"
41	ingob	61	#include "ubx.h"
		62	#include "GPS.h"
119	killagreg	63	#include "timer1.h"
242	killagreg	64	#include "compass.h"
41	ingob	65	#include "spi_slave.h"
		66	#include "menu.h"
		67	#include "uart1.h"
267	holgerb	68	#include "ncmag.h"
380	holgerb	69	#include "logging.h"
426	holgerb	70	#include "settings.h"
548	holgerb	71	#include "sdc.h"
677	holgerb	72	#include "analog.h"
1	ingob	73
		74	u8 DispPtr = 0;
201	killagreg	75	s8 DisplayBuff[DISPLAYBUFFSIZE];
1	ingob	76
201	killagreg	77
41	ingob	78	u8 MenuItem = 0;
688	holgerb	79	u8 MaxMenuItem = 28;
41	ingob	80
203	killagreg	81	void Menu_Putchar(char c)
		82	{
516	holgerb	83	if(DispPtr < DISPLAYBUFFSIZE) DisplayBuff[DispPtr++] = c; ;
203	killagreg	84	}
		85
201	killagreg	86	void Menu_Clear(void)
1	ingob	87	{
201	killagreg	88	u8 i;
		89	for( i = 0; i < DISPLAYBUFFSIZE; i++) DisplayBuff[i] = ' ';
1	ingob	90	}
		91
41	ingob	92	// Display with 20 characters in 4 lines
201	killagreg	93	void Menu_Update(u8 Keys)
41	ingob	94	{
516	holgerb	95	s32 i1,i2;
51	killagreg	96	u8 sign;
41	ingob	97
201	killagreg	98	if(Keys & KEY1) { if(MenuItem > 0) MenuItem--; else MenuItem = MaxMenuItem;}
		99	if(Keys & KEY2) { if(MenuItem == MaxMenuItem) MenuItem = 0; else MenuItem++;}
		100	if((Keys & KEY1) && (Keys & KEY2)) MenuItem = 0;
41	ingob	101	if(MenuItem > MaxMenuItem) MenuItem = MaxMenuItem;
201	killagreg	102	Menu_Clear();
41	ingob	103	// print menu item number in the upper right corner
516	holgerb	104	if(MenuItem < 10)
		105	{
41	ingob	106	LCD_printfxy(17,0,"[%i]",MenuItem);
		107	}
201	killagreg	108	else // Menuitem >= 10
41	ingob	109	{
		110	LCD_printfxy(16,0,"[%i]",MenuItem);
		111	}
		112
516	holgerb	113	switch(MenuItem)
		114	{
41	ingob	115	// Version Info
		116	case 0:
		117	LCD_printfxy(0,0,"++ Navi-Ctrl ++");
530	holgerb	118	LCD_printfxy(0,1,"HW V%d.%d SW V%d.%02d%c", UART_VersionInfo.HWMajor/10, UART_VersionInfo.HWMajor%10, VERSION_MAJOR, VERSION_MINOR, 'a'+ VERSION_PATCH);
617	holgerb	119	if(FC.StatusFlags3 & FC_STATUS3_REDUNDANCE_AKTIVE) LCD_printfxy(19,1,"R");
516	holgerb	120	if(ErrorCode)
264	killagreg	121	{
		122	LCD_printfxy(0,2,"Error: %d",ErrorCode);
516	holgerb	123	LCD_printfxy(0,3,"%s",ErrorMSG);
264	killagreg	124	}
489	killagreg	125	else
		126	{
693	holgerb	127	LCD_printfxy(0,2,"Set:%d %s", Parameter.ActiveSetting,EE_Parameter.Name);
		128	LCD_printfxy(0,3,"%s",ErrorMSG);
		129	// LCD_printfxy(0,3,"(c) HiSystems GmbH");
321	holgerb	130	}
574	holgerb	131	if(FC.StatusFlags3 & FC_STATUS3_BOAT) LCD_printfxy(16,2,"BOAT");
41	ingob	132	break;
		133	case 1:
		134	if (GPSData.Status == INVALID)
		135	{
		136	LCD_printfxy(0,0,"No GPS data");
		137	LCD_printfxy(0,1,"Lon: ");
		138	LCD_printfxy(0,2,"Lat: ");
		139	LCD_printfxy(0,3,"Alt: ");
		140	}
		141	else // newdata or processed
		142	{
122	killagreg	143	LCD_printfxy(0,0,"Sat:%02d ", GPSData.NumOfSats);
41	ingob	144	switch (GPSData.SatFix)
		145	{
		146	case SATFIX_NONE:
127	killagreg	147	LCD_printfxy(7,0,"NoFix");
41	ingob	148	break;
		149	case SATFIX_2D:
127	killagreg	150	LCD_printfxy(7,0,"2DFix");
41	ingob	151	break;
		152	case SATFIX_3D:
127	killagreg	153	LCD_printfxy(7,0,"3DFix");
41	ingob	154	break;
		155	default:
127	killagreg	156	LCD_printfxy(7,0,"??Fix");
41	ingob	157	break;
		158	}
121	killagreg	159	if(GPSData.Flags & FLAG_DIFFSOLN)
		160	{
127	killagreg	161	LCD_printfxy(12,0,"/DGPS");
121	killagreg	162	}
		163	else
		164	{
127	killagreg	165	LCD_printfxy(12,0," ");
121	killagreg	166	}
		167
51	killagreg	168	if(GPSData.Position.Longitude < 0) sign = '-';
		169	else sign = '+';
53	killagreg	170	i1 = abs(GPSData.Position.Longitude)/10000000L;
		171	i2 = abs(GPSData.Position.Longitude)%10000000L;
54	killagreg	172	LCD_printfxy(0,1,"Lon:%c%03ld.%07ld deg",sign, i1, i2);
51	killagreg	173	if(GPSData.Position.Latitude < 0) sign = '-';
		174	else sign = '+';
53	killagreg	175	i1 = abs(GPSData.Position.Latitude)/10000000L;
		176	i2 = abs(GPSData.Position.Latitude)%10000000L;
54	killagreg	177	LCD_printfxy(0,2,"Lat:%c%03ld.%07ld deg",sign, i1, i2);
51	killagreg	178	if(GPSData.Position.Altitude < 0) sign = '-';
		179	else sign = '+';
53	killagreg	180	i1 = abs(GPSData.Position.Altitude)/1000L;
		181	i2 = abs(GPSData.Position.Altitude)%1000L;
54	killagreg	182	LCD_printfxy(0,3,"Alt:%c%04ld.%03ld m", sign, i1, i2);
41	ingob	183	}
		184	break;
		185	case 2:
		186	if (GPSData.Status == INVALID)
		187	{
		188	LCD_printfxy(0,0,"No GPS data");
		189	LCD_printfxy(0,1,"Speed N: ");
		190	LCD_printfxy(0,2,"Speed E: ");
		191	LCD_printfxy(0,3,"Speed T: ");
		192	}
		193	else // newdata or processed
		194	{
124	killagreg	195	LCD_printfxy(0,0,"Sat:%02d ", GPSData.NumOfSats);
41	ingob	196	switch (GPSData.SatFix)
		197	{
		198	case SATFIX_NONE:
127	killagreg	199	LCD_printfxy(7,0,"NoFix");
41	ingob	200	break;
		201	case SATFIX_2D:
127	killagreg	202	LCD_printfxy(7,0,"2DFix");
41	ingob	203	break;
		204	case SATFIX_3D:
127	killagreg	205	LCD_printfxy(7,0,"3DFix");
41	ingob	206	break;
		207	default:
127	killagreg	208	LCD_printfxy(7,0,"??Fix");
41	ingob	209	break;
		210	}
124	killagreg	211	if(GPSData.Flags & FLAG_DIFFSOLN)
		212	{
127	killagreg	213	LCD_printfxy(12,0,"/DGPS");
124	killagreg	214	}
		215	else
		216	{
127	killagreg	217	LCD_printfxy(12,0," ");
124	killagreg	218	}
		219
41	ingob	220	LCD_printfxy(0,1,"Speed N: %+4ld cm/s",GPSData.Speed_North);
		221	LCD_printfxy(0,2,"Speed E: %+4ld cm/s",GPSData.Speed_East);
		222	LCD_printfxy(0,3,"Speed T: %+4ld cm/s",GPSData.Speed_Top);
		223	}
		224	break;
		225	case 3:
		226	LCD_printfxy(0,0,"GPS UTC Time");
		227	if (!SystemTime.Valid)
		228	{
		229	LCD_printfxy(0,1," ");
		230	LCD_printfxy(0,2," No time data! ");
		231	LCD_printfxy(0,3," ");
		232	}
		233	else // newdata or processed
		234	{
		235	LCD_printfxy(0,1," ");
		236	LCD_printfxy(0,2,"Date: %02i/%02i/%04i",SystemTime.Month, SystemTime.Day, SystemTime.Year);
		237	LCD_printfxy(0,3,"Time: %02i:%02i:%02i.%03i", SystemTime.Hour, SystemTime.Min, SystemTime.Sec, SystemTime.mSec);
		238	}
		239	break;
59	killagreg	240	case 4: // Navi Params 1 from FC
41	ingob	241	LCD_printfxy(0,0,"NaviMode: %3i" , Parameter.NaviGpsModeControl);
516	holgerb	242	LCD_printfxy(0,1,"G :%3i P :%3i ",Parameter.NaviGpsGain, Parameter.NaviGpsP);
		243	LCD_printfxy(0,2,"I :%3i D :%3i ",Parameter.NaviGpsI, Parameter.NaviGpsD);
		244	LCD_printfxy(0,3,"ACC:%3i SAT:%3i ",Parameter.NaviGpsACC, Parameter.NaviGpsMinSat);
41	ingob	245	break;
516	holgerb	246	case 5: // Navi Params 2 from FC
59	killagreg	247	LCD_printfxy(0,0,"Stick TS: %3i", Parameter.NaviStickThreshold);
532	holgerb	248	LCD_printfxy(0,1,"WP_Radius: %3im",MaxWP_Radius_in_m);
516	holgerb	249	LCD_printfxy(0,2,"WindCorr: %3i", Parameter.NaviWindCorrection);
		250	LCD_printfxy(0,3,"AccComp: %3i", Parameter.NaviSpeedCompensation);
59	killagreg	251	break;
		252	case 6: // Navi Params 3 from FC
		253	LCD_printfxy(0,0,"Angle-Limit: %3i", Parameter.NaviAngleLimitation);
516	holgerb	254	LCD_printfxy(0,1," P-Limit: %3i", Parameter.NaviGpsPLimit);
		255	LCD_printfxy(0,2," I-Limit: %3i", Parameter.NaviGpsILimit);
		256	LCD_printfxy(0,3," D-Limit: %3i", Parameter.NaviGpsDLimit);
59	killagreg	257	break;
351	holgerb	258	case 7: // Max Ranges
		259	LCD_printfxy(0,0,"Maximum flying ");
532	holgerb	260	LCD_printfxy(0,1,"Range: %4im ", AbsoluteFlyingRange_m);
		261	LCD_printfxy(0,2,"Descend: %4im ", AutoDescendRange_m);
516	holgerb	262	LCD_printfxy(0,3,"Altitude:%4im ", AbsoluteFlyingAltitude);
532	holgerb	263	if(!AbsoluteFlyingRange_m) LCD_printfxy(9,1,"disabled");
		264	if(!AutoDescendRange_m) LCD_printfxy(9,2,"disabled");
355	holgerb	265	if(!AbsoluteFlyingAltitude) LCD_printfxy(9,3,"disabled");
351	holgerb	266	break;
		267	case 8:
41	ingob	268	LCD_printfxy(0,0,"Home Position");
215	killagreg	269	if(NaviData.HomePosition.Status == INVALID)
41	ingob	270	{
		271	LCD_printfxy(0,1," ");
		272	LCD_printfxy(0,2," Is not set. ");
		273	LCD_printfxy(0,3," ");
		274	}
		275	else
		276	{
215	killagreg	277	if(NaviData.HomePosition.Longitude < 0) sign = '-';
51	killagreg	278	else sign = '+';
215	killagreg	279	i1 = abs(NaviData.HomePosition.Longitude)/10000000L;
		280	i2 = abs(NaviData.HomePosition.Longitude)%10000000L;
55	killagreg	281	LCD_printfxy(0,1,"Lon:%c%03ld.%07ld deg",sign, i1, i2);
215	killagreg	282	if(NaviData.HomePosition.Latitude < 0) sign = '-';
51	killagreg	283	else sign = '+';
215	killagreg	284	i1 = abs(NaviData.HomePosition.Latitude)/10000000L;
		285	i2 = abs(NaviData.HomePosition.Latitude)%10000000L;
55	killagreg	286	LCD_printfxy(0,2,"Lat:%c%03ld.%07ld deg",sign, i1, i2);
215	killagreg	287	if(NaviData.HomePosition.Altitude < 0) sign = '-';
51	killagreg	288	else sign = '+';
215	killagreg	289	i1 = abs(NaviData.HomePosition.Altitude)/1000L;
		290	i2 = abs(NaviData.HomePosition.Altitude)%1000L;
589	holgerb	291	LCD_printfxy(0,3,"Alt:%c%04ld.%1dm",sign, i1, i2/1000);
588	holgerb	292	switch(Parameter.HomeYawMode)
		293	{
		294	case NO_CHANGE: LCD_printfxy(17,3,"(-)"); break;
		295	case FRONT_TO_HOME: LCD_printfxy(17,3,"(F)"); break;
		296	case REAR_TO_HOME: LCD_printfxy(17,3,"(R)"); break;
		297	case LIKE_AT_START: LCD_printfxy(17,3,"(S)"); break;
		298	}
41	ingob	299	}
		300	break;
351	holgerb	301	case 9:
318	holgerb	302	LCD_printfxy(0,0,"Target Position");
		303	if(NaviData.TargetPosition.Status == INVALID)
		304	{
		305	LCD_printfxy(0,1," ");
		306	LCD_printfxy(0,2," Is not set. ");
		307	LCD_printfxy(0,3," ");
		308	}
		309	else
		310	{
		311	if(NaviData.TargetPosition.Longitude < 0) sign = '-';
		312	else sign = '+';
		313	i1 = abs(NaviData.TargetPosition.Longitude)/10000000L;
		314	i2 = abs(NaviData.TargetPosition.Longitude)%10000000L;
		315	LCD_printfxy(0,1,"Lon:%c%03ld.%07ld deg",sign, i1, i2);
		316	if(NaviData.TargetPosition.Latitude < 0) sign = '-';
		317	else sign = '+';
		318	i1 = abs(NaviData.TargetPosition.Latitude)/10000000L;
		319	i2 = abs(NaviData.TargetPosition.Latitude)%10000000L;
		320	LCD_printfxy(0,2,"Lat:%c%03ld.%07ld deg",sign, i1, i2);
		321	if(NaviData.HomePosition.Altitude < 0) sign = '-';
		322	else sign = '+';
		323	i1 = abs(NaviData.TargetPosition.Altitude)/1000L;
		324	i2 = abs(NaviData.TargetPosition.Altitude)%1000L;
588	holgerb	325	LCD_printfxy(0,3,"Alt:%c%04ld.%03ldm",sign, i1, i2);
318	holgerb	326	}
		327	break;
351	holgerb	328	case 10: // RC stick controls from FC
41	ingob	329	LCD_printfxy(0,0,"RC-Sticks" );
516	holgerb	330	LCD_printfxy(0,1,"Ni:%4i Ro:%4i ",FC.StickNick, FC.StickRoll);
		331	LCD_printfxy(0,2,"Gs:%4i Ya:%4i ",FC.StickGas, FC.StickYaw);
		332	LCD_printfxy(0,3,"RC-Level: %3i", FC.RC_Quality); // Remote Control Level from FC
41	ingob	333	break;
351	holgerb	334	case 11: // RC poti controls from FC
190	killagreg	335	LCD_printfxy(0,0,"RC-Potis 1" );
516	holgerb	336	LCD_printfxy(0,1,"Po1:%3i Po2:%3i ",FC.Poti[0], FC.Poti[1]);
		337	LCD_printfxy(0,2,"Po3:%3i Po4:%3i ",FC.Poti[2], FC.Poti[3]);
41	ingob	338	break;
351	holgerb	339	case 12: // RC poti controls from FC
190	killagreg	340	LCD_printfxy(0,0,"RC-Potis 2" );
516	holgerb	341	LCD_printfxy(0,1,"Po5:%3i Po6:%3i ",FC.Poti[4], FC.Poti[5]);
		342	LCD_printfxy(0,2,"Po7:%3i Po8:%3i ",FC.Poti[6], FC.Poti[7]);
190	killagreg	343	break;
351	holgerb	344	case 13: // attitude from FC
66	killagreg	345	if(FromFlightCtrl.AngleNick < 0) sign = '-';
		346	else sign = '+';
		347	i1 = abs(FromFlightCtrl.AngleNick)/10;
		348	i2 = abs(FromFlightCtrl.AngleNick)%10;
201	killagreg	349	LCD_printfxy(0,0,"GyroNick:%c%03ld.%01ld", sign, i1, i2);
66	killagreg	350	if(FromFlightCtrl.AngleRoll < 0) sign = '-';
		351	else sign = '+';
		352	i1 = abs(FromFlightCtrl.AngleRoll)/10;
		353	i2 = abs(FromFlightCtrl.AngleRoll)%10;
516	holgerb	354	LCD_printfxy(0,1,"GyroRoll:%c%03ld.%01ld", sign, i1, i2);
688	holgerb	355	if(FromFlightCtrl_AccNick < 0) sign = '-';
67	killagreg	356	else sign = '+';
688	holgerb	357	i1 = abs(FromFlightCtrl_AccNick)/10;
		358	i2 = abs(FromFlightCtrl_AccNick)%10;
201	killagreg	359	LCD_printfxy(0,2," AccNick:%c%03ld.%01ld", sign, i1, i2);
688	holgerb	360	if(FromFlightCtrl_AccRoll < 0) sign = '-';
67	killagreg	361	else sign = '+';
688	holgerb	362	i1 = abs(FromFlightCtrl_AccRoll)/10;
		363	i2 = abs(FromFlightCtrl_AccRoll)%10;
516	holgerb	364	LCD_printfxy(0,3," AccRoll:%c%03ld.%01ld", sign, i1, i2);
41	ingob	365	break;
688	holgerb	366	case 14:
		367	LCD_printfxy(0,0,"Analog inputs");
		368	LCD_printfxy(0,1,"A5:%3i ",AnalogData.Ch5);
		369	LCD_printfxy(0,2,"A6:%3i ",AnalogData.Ch6);
		370	LCD_printfxy(0,3,"A7:%3i ",AnalogData.Ch7);
41	ingob	371	break;
489	killagreg	372	case 15:
475	holgerb	373	LCD_printfxy(0,0,"Compass: %3i", FromFlightCtrl.GyroHeading / 10);
		374	LCD_printfxy(0,1,"Man.-Offset:%3i", FC.FromFC_CompassOffset / 10);
		375	if(FC.FromFC_DisableDeclination)
516	holgerb	376	{
489	killagreg	377	LCD_printfxy(0,2,"Mag.Declinat.:disabl");
475	holgerb	378	}
		379	else
		380	{
489	killagreg	381	if(GeoMagDec < 0) sign = '-';
		382	else sign = '+';
		383	LCD_printfxy(0,2,"Mag.Declinat.:%c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
475	holgerb	384	}
463	holgerb	385	LCD_printfxy(0,3,"True Compass: %3i", GyroCompassCorrected/10);
516	holgerb	386	break;
351	holgerb	387	case 16: // User Parameter
153	killagreg	388	LCD_printfxy(0,0,"UP1:%3i UP2:%3i",Parameter.User1,Parameter.User2);
		389	LCD_printfxy(0,1,"UP3:%3i UP4:%3i",Parameter.User3,Parameter.User4);
		390	LCD_printfxy(0,2,"UP5:%3i UP6:%3i",Parameter.User5,Parameter.User6);
		391	LCD_printfxy(0,3,"UP7:%3i UP8:%3i",Parameter.User7,Parameter.User8);
41	ingob	392	break;
380	holgerb	393	case 17: // User Parameter
426	holgerb	394	LCD_printfxy(0,0,"SD-Card Logs");
548	holgerb	395	if(SDCardInfo.Valid == 1)
		396	{
		397	LCD_printfxy(0,1,"GPX:%4i (%3ims) ",Logged_GPX_Counter,LogCfg.GPX_Interval);
		398	LCD_printfxy(0,2,"KML:%4i (%3ims) ",Logged_KML_Counter,LogCfg.KML_Interval);
		399	}
		400	else
		401	LCD_printfxy(0,1,"no card in slot ");
380	holgerb	402	break;
		403	case 18: // magnetic field
292	killagreg	404	if(Compass_CalState)
254	killagreg	405	{
292	killagreg	406	LCD_printfxy(0,0,"Calibration:");
		407	LCD_printfxy(0,1,"Step %d/", Compass_CalState);
516	holgerb	408	LCD_printfxy(0,2,"X %4i Y %4i Z %4i",MagVector.X,MagVector.Y,MagVector.Z);
292	killagreg	409	LCD_printfxy(9,3,"(ESC)(NEXT)");
		410	switch(Compass_CalState)
254	killagreg	411	{
292	killagreg	412	case 1:
		413	case 3:
		414	LCD_printfxy(7,1,"pause");
		415	break;
		416
		417	case 2:
		418	LCD_printfxy(7,1,"horizontal");
		419	break;
		420
		421	case 4:
		422	LCD_printfxy(7,1,"vertical");
		423	break;
		424
		425	case 5:
		426	LCD_printfxy(7,1,"data saved");
		427	LCD_printfxy(8,3," (END) ");
		428	break;
489	killagreg	429
292	killagreg	430	default:
		431	break;
254	killagreg	432	}
		433	}
292	killagreg	434	else
254	killagreg	435	{
330	holgerb	436	if(GeoMagDec < 0) sign = '-';
		437	else sign = '+';
254	killagreg	438	LCD_printfxy(0,0,"Magnetic Field");
516	holgerb	439	LCD_printfxy(0,1,"X:%5i",MagVector.X);
292	killagreg	440	LCD_printfxy(0,2,"Y:%5i",MagVector.Y);
		441	LCD_printfxy(0,3,"Z:%5i",MagVector.Z);
330	holgerb	442	LCD_printfxy(8,1,"Field:%3i",EarthMagneticField/5);
489	killagreg	443	if(Compass_I2CPort == NCMAG_PORT_EXTERN) LCD_printfxy(11,2,"Extern")
		444	else LCD_printfxy(11,2,"Intern");
338	holgerb	445	// LCD_printfxy(8,2,"Dec:%c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
		446	// LCD_printfxy(8,3,"Inc:%2i", EarthMagneticInclination);
292	killagreg	447	LCD_printfxy(15,3,"(CAL)");
		448	}
		449	if(Keys & KEY4) // next step
		450	{
		451	if(Compass_CalState <5) Compass_SetCalState(Compass_CalState+1);
		452	else Compass_SetCalState(0);
		453	}
		454	if(Keys & KEY3)Compass_SetCalState(0); // cancel
41	ingob	455	break;
489	killagreg	456	case 19:
345	holgerb	457	if(GeoMagDec < 0) sign = '-';
		458	else sign = '+';
338	holgerb	459	LCD_printfxy(0,0,"Magnetic Field");
		460	LCD_printfxy(0,1,"Field:%3i (Percent)",EarthMagneticField/5);
		461	LCD_printfxy(0,2,"Declination:%c%i.%1i ", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
		462	LCD_printfxy(0,3,"Inclination:%2i (%2i)", EarthMagneticInclination, EarthMagneticInclinationTheoretic);
		463	break;
489	killagreg	464	case 20:
426	holgerb	465	LCD_printfxy(0,0,"SD-Setting ");
		466	LCD_printfxy(0,2,"WP-Dynamic:%4i ",WaypointAcceleration);
		467	break;
489	killagreg	468	case 21:
453	holgerb	469	LCD_printfxy(0,0,"CPU Processing ");
659	holgerb	470	LCD_printfxy(0,2,"GPS-Data: %2i.%iHz ",FreqNewGpsData/10, FreqNewGpsData%10);
663	holgerb	471	LCD_printfxy(0,3,"GPS-Update:%2i.%iHz ",FreqGpsNavProcessed/10, FreqGpsNavProcessed%10);
659	holgerb	472	if(FreqNewGpsData >= 48 && FreqNewGpsData <= 52) LCD_printfxy(18,2,"OK") else LCD_printfxy(18,2,"!!");
663	holgerb	473	if(FreqGpsNavProcessed >= 350) LCD_printfxy(18,3,"OK") else LCD_printfxy(18,3,"!!");
453	holgerb	474	break;
489	killagreg	475	case 22:
		476	LCD_printfxy(0,0,"BL Current" );
		477	LCD_printfxy(11,3,"(in 0.1A)" );
		478	for(i1 = 0; i1 < 3; i1++)
		479	{
502	killagreg	480	LCD_printfxy(0,i1+1,"%3d %3d %3d %3d ",BL3_Current(i14),BL3_Current(i14+1),BL3_Current(i14+2),BL3_Current(i14+3));
		481	if(Motor[4 + i1 * 4].State == 0) break;
489	killagreg	482	}
471	holgerb	483	break;
489	killagreg	484
473	holgerb	485	case 23:
489	killagreg	486	LCD_printfxy(0,0,"Ext. Compass" );
686	holgerb	487	if(NCMAG_Compass_use_Orientation)
489	killagreg	488	{
516	holgerb	489	u8 tmp;
		490	LCD_printfxy(0,1,"ACC X Y Z");
		491	LCD_printfxy(0,2," %5d %5d %5d", AccVector.X/40, AccVector.Y/40, AccVector.Z/40);
		492	tmp = NCMAG_GetOrientationFromAcc();
		493	LCD_printfxy(0,3,"Orientat.: ");
		494	if(!tmp) LCD_printfxy(11,3,"??") else LCD_printfxy(11,3,"%2d",tmp);
		495	LCD_printfxy(15,3,"(%d)",NCMAG_Orientation);
489	killagreg	496	}
		497	else
		498	{
		499	LCD_printfxy(0,1,"Not connected");
		500	}
473	holgerb	501	break;
498	killagreg	502	case 24:
		503	{
504	holgerb	504	static u8 index = 1;
498	killagreg	505	if(Keys & KEY3) // next step
		506	{
503	holgerb	507	if(index < ToFC_MaxWpListIndex) index++;
498	killagreg	508	else index = 1;
		509	}
503	holgerb	510	if(Keys & KEY4) FromFC_LoadWP_List = index;
		511	LCD_printfxy(0,0,"Load WPL (fix)" );
498	killagreg	512	LCD_printfxy(0,1,"Name: %s", WPL_Store.Name);
		513	// 12345678901234567890
		514	LCD_printfxy(0,2,"Points Index ");
		515	LCD_printfxy(0,3," %3d %3d LOAD", PointList_GetCount(), index);
516	holgerb	516	}
498	killagreg	517	break;
504	holgerb	518	case 25:
		519	{
		520	static u8 index = 1;
516	holgerb	521	if(Keys & KEY3)
504	holgerb	522	{
		523	if(index < ToFC_MaxWpListIndex) index++;
		524	else index = 1;
		525	}
514	holgerb	526	LCD_printfxy(0,0,"Load WPL (Rel)" );
504	holgerb	527	LCD_printfxy(0,1,"Name: %s", WPL_Store.Name);
		528	// 12345678901234567890
		529	LCD_printfxy(0,2,"Points Index ");
516	holgerb	530	if(GPSData.SatFix == SATFIX_3D)
		531	{
		532	LCD_printfxy(0,3," %3d %3d LOAD", PointList_GetCount(), index);
		533	if(Keys & KEY4) FromFC_LoadWP_List = index \| 0x80;
		534	}
		535	else LCD_printfxy(0,3," No Satfix ! ", index);
514	holgerb	536
516	holgerb	537	}
504	holgerb	538	break;
514	holgerb	539	case 26:
		540	{
		541	static u8 index = 1;
516	holgerb	542	if(Keys & KEY3)
514	holgerb	543	{
		544	if(index < ToFC_MaxWpListIndex) index++;
		545	else index = 1;
		546	}
		547	if(Keys & KEY4) FromFC_Load_SinglePoint = index;
		548	LCD_printfxy(0,0,"Load Point" );
		549	LCD_printfxy(0,1,"Name: %s", WPL_Store.Name);
		550	// 12345678901234567890
		551	// LCD_printfxy(0,2,"Points Index ");
		552	LCD_printfxy(0,3,"Number: %3d (LOAD)", index);
516	holgerb	553	}
514	holgerb	554	break;
		555	case 27:
		556	{
		557	static u8 index = 1;
		558	if(Keys & KEY3)
		559	{
		560	if(index < ToFC_MaxWpListIndex) index++;
		561	else index = 1;
		562	}
		563	LCD_printfxy(0,0,"Save Point" );
		564	LCD_printfxy(0,1,"Alt: %3dm", NaviData.Altimeter/20);
		565	// 12345678901234567890
		566	LCD_printfxy(0,2,"Dir: %3d ", CompassSetpointCorrected/10);
516	holgerb	567	if(GPSData.SatFix == SATFIX_3D)
514	holgerb	568	{
		569	LCD_printfxy(0,3,"Number: %3d (SAVE)", index);
		570	if(Keys & KEY4) FromFC_Save_SinglePoint = index;
		571	}
		572	else LCD_printfxy(0,3," No Satfix ! ", index);
516	holgerb	573	}
514	holgerb	574	break;
677	holgerb	575	/* case 28:
		576	LCD_printfxy(0,0,"Analog inputs");
		577	LCD_printfxy(0,0,"A0:%3i A1:%3i",AnalogData.Ch0,AnalogData.Ch1);
		578	LCD_printfxy(0,1,"A2:%3i A3:%3i",AnalogData.Ch2,AnalogData.Ch3);
		579	LCD_printfxy(0,2,"A4:%3i A5:%3i",AnalogData.Ch4,AnalogData.Ch5);
		580	LCD_printfxy(0,3,"A6:%3i A7:%3i",AnalogData.Ch6,AnalogData.Ch7);
		581	break;
		582	*/
688	holgerb	583
		584	case 28:
		585	// LCD_printfxy(0,0,"PPM Input");
		586	/*
		587	LCD_printfxy(0,0,"%4i %4i %4i %4i",PPM_In[1],PPM_In[2],PPM_In[3],PPM_In[4]);
		588	LCD_printfxy(0,1,"%4i %4i %4i %4i",PPM_In[5],PPM_In[6],PPM_In[7],PPM_In[8]);
		589	LCD_printfxy(0,2,"%4i %4i %4i %4i",PPM_In[9],PPM_In[10],PPM_In[11],PPM_In[12]);
		590	LCD_printfxy(0,3,"%4i %4i %4i %4i",PPM_In[13],PPM_In[14],PPM_In[15],PPM_In[16]);
		591	*/
		592	LCD_printfxy(0,0,"%4i %4i %4i %4i",PPM_In[17],PPM_In[18],PPM_In[19],PPM_In[20]);
		593	LCD_printfxy(0,1,"%4i %4i %4i %4i",PPM_In[21],PPM_In[22],PPM_In[23],PPM_In[24]);
		594	LCD_printfxy(0,2,"%4i %4i %4i %4i",PPM_In[25],PPM_In[26],PPM_In[27],PPM_In[28]);
		595	LCD_printfxy(0,3,"%4i %4i %4i %4i",PPM_In[29],PPM_In[30],PPM_In[31],PPM_In[32]);
		596	break;
41	ingob	597	default:
201	killagreg	598	//MaxMenuItem = MenuItem - 1;
41	ingob	599	MenuItem = 0;
		600	break;
516	holgerb	601	}
1	ingob	602	}

Subversion Repositories NaviCtrl

(root)/tags/V2.20h/menu.c @ 896 - Rev 693