WebSVN - Projects - Blame - Rev 1932 - /Transportables_Koptertool/branch/PKT/branch/GPL_PKT_V3_6_7f

Rev	Author	Line No.	Line
1932	-	1	/*****************************************************************************
		2	* Copyright (C) 2008 Thomas Kaiser, thomas@ft-fanpage.de *
		3	* Copyright (C) 2009 Peter "woggle" Mack, mac@denich.net *
		4	* Copyright (C) 2011 Christian "Cebra" Brandtner, brandtner@brandtner.net *
		5	* Copyright (C) 2011 Harald Bongartz *
		6	* *
		7	* This program is free software; you can redistribute it and/or modify *
		8	* it under the terms of the GNU General Public License as published by *
		9	* the Free Software Foundation; either version 2 of the License. *
		10	* *
		11	* This program is distributed in the hope that it will be useful, *
		12	* but WITHOUT ANY WARRANTY; without even the implied warranty of *
		13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
		14	* GNU General Public License for more details. *
		15	* *
		16	* You should have received a copy of the GNU General Public License *
		17	* along with this program; if not, write to the *
		18	* Free Software Foundation, Inc., *
		19	* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
		20	* *
		21	* *
		22	* Credits to: *
		23	* Holger Buss & Ingo Busker from mikrokopter.de for the MK project + SVN *
		24	* http://www.mikrokopter.de *
		25	* Gregor "killagreg" Stobrawa for his version of the MK code *
		26	* Thomas Kaiser "thkais" for the original project. See *
		27	* http://www.ft-fanpage.de/mikrokopter/ *
		28	* http://forum.mikrokopter.de/topic-4061-1.html *
		29	* Claas Anders "CaScAdE" Rathje for providing the font and his C-OSD code *
		30	* http://www.mylifesucks.de/oss/c-osd/ *
		31	* Harald Bongartz "HaraldB" for providing his Ideas and Code for usibility*
		32	*****************************************************************************/
		33
		34
		35	//############################################################################
		36	//# HISTORY setup.c
		37	//#
		38	//# 04.03.2013 Cebra
		39	//# - del: OSD-Sreenmode ,is no longer necessary, last OSD-Screen is saved at shutdown
		40	//############################################################################
		41
		42
		43	//bt_connect
		44	#include "../cpu.h"
		45	#include <avr/io.h>
		46	#include <avr/interrupt.h>
		47	#include <avr/pgmspace.h>
		48	#include <string.h>
		49	#include <util/delay.h>
		50	#include "../main.h"
		51	#include "../setup/setup.h"
		52	#include "../lcd/lcd.h"
		53	#include "../eeprom/eeprom.h"
		54	#include "../timer/timer.h"
		55	#include "../menu.h"
		56	#include "../wi232/Wi232.h"
		57	#include "../bluetooth/bluetooth.h"
		58	#include "../connect.h"
		59	#include "../lipo/lipo.h"
		60	#include "../messages.h"
		61	#include "../eeprom/eeprom.h"
		62	#include "../tracking/tracking.h"
		63	#include "../uart/uart1.h"
		64	#include "../osd/osd.h"
		65	#include "../sound/pwmsine8bit.h"
		66	#include "../tracking/servo_setup.h"
		67	#include "../bluetooth/error.h"
		68	#include "../stick/stick_setup.h"
		69
		70
		71
		72	uint8_t spalte;
		73	uint8_t mmode;
		74	uint8_t edit;
		75	uint8_t LCD_Orientation;
		76	uint8_t edit = 0;
		77	uint8_t LCD_Change = 0;
		78	uint8_t PKT_Change = 0;
		79	uint16_t Pre;
		80	uint16_t Pre16;
		81	char EditString[21];
		82	uint8_t bt_name_len;
		83	uint8_t length_tmp;
		84	uint8_t CheckGPS=false;
		85	uint8_t Old_Baudrate = 0; //Merkzelle f�r alte Baudrate
		86
		87	//--------------------------------------------------------------
		88	#define ITEMS_PKT 13
		89
		90	const prog_char param_menuitems_pkt[ITEMS_PKT][NUM_LANG][18]= // zeilen,zeichen+1
		91	// German, English, French, Dutch
		92	{
		93	{"Verbindung zum MK","connection to MK ","Aansluiting op MK"},
		94	{"PKT allgemein \x1d","PKT global \x1d","PKT global \x1d"},
		95	{"Wi.232 \x1d","Wi.232 \x1d","Wi.232 \x1d"},
		96	{"BTM-222 \x1d","BTM-222 \x1d","BTM-222 \x1d"},
		97	{"Servo Men� \x1d","servo menu \x1d","servo menu \x1d"},
		98	{"OSD Anzeige \x1d","OSD screen \x1d","OSD screen \x1d"},
		99	{"GPS \x1d","GPS \x1d","GPS \x1d"},
		100	{"Follow Me \x1d","Follow Me \x1d","Follow Me \x1d"},
		101	{"Joystick \x1d","joystick \x1d","joystick \x1d"},
		102	{"PKT-Akku \x1d","PKT-Accu \x1d","PKT-Accu \x1d"},
		103	{"PKT Update ","PKT Update ","PKT Update "},
		104	{"Debug PKT ","Debug PKT ","Debug PKT "},
		105	{"EEProm Reset ","EEProm Reset ","EEProm Reset "},
		106	};
		107
		108	#define ITEMS_LCD 11
		109
		110	const prog_char param_menuitems_lcd[ITEMS_LCD][NUM_LANG][18]= // zeilen,zeichen+1
		111	// German, English, French, Dutch
		112	{
		113	{"Infos beim Start ","info at startup ","info bij opstart "},
		114	{"OSD Empfangsausf.","OSD receive Error","OSD receive Error"},
		115	{"Sprache ","language ","taal "},
		116	{"Licht aus nach...","light off after ","licht uit na "},
		117	{"Helligkeit ","brightness ","helderheid "},
		118	{"Kontrast ","contrast ","contrast "},
		119	{"Normal/Invers ","normal/inverted ","Normal/inverted "},
		120	{"Orientierung ","orientation ","orientatie "},
		121	{"Vario Ton Erw. ","Vario Sound Ext. ","Vario Sound Ext. "},
		122	{"Hardware Beeper ","Hardware Beeper ","Hardware Beeper "},
		123	{"Lautst�rke Ton ","Volume ","Volume "},
		124	};
		125
		126	#define ITEMS_WI 9
		127
		128	const prog_char param_menuitems_wi[ITEMS_WI][NUM_LANG][18]= // zeilen,zeichen+1
		129	// German, English, French, Dutch
		130	{
		131	{"Modul eingebaut? ","module built in? ","Module geinstal.?"},
		132	{"TX/RX Kanal ","TX/RX Channel ","TX/RX Channel "},
		133	{"NetW. Gruppe ","NetW. Group ","NetW. Group "},
		134	{"NetW. Mode ","NetW. Mode ","NetW. Mode "},
		135	{"TX Timeout ","TX Timeout ","TX Timeout "},
		136	{"TX MTU ","TX MTU ","TX MTU "},
		137	{"Baudrate Wi232/BT","Baudrate Wi232/BT","Baudrate Wi232/BT"},
		138	{"Initialisieren ","initialize ","Initialize "},
		139	{"Konfig. mit PC ","config. with PC ","Config. met PC "},
		140	};
		141
		142
		143	#define ITEMS_BT 7
		144
		145	const prog_char param_menuitems_bt[ITEMS_BT][NUM_LANG][18]= // zeilen,zeichen+1
		146	// German, English, Dutch
		147	{
		148	{"Modul eingebaut? ","module built in? ","module geinstall?"},
		149	{"Name ","name ","Naam "},
		150	{"Pin ","pin ","Pin "},
		151	{"Initialisieren ","initialize ","Initialize "},
		152	{"Bluetooth MAC-Adr","Bluetooth MAC-Adr","Bluetooth MAC-Adr"},
		153	{"RE-ID ","RE-ID ","RE-ID "},
		154	{"Konfig. mit PC ","config. with PC ","Config. met PC "},
		155	};
		156
		157	#define ITEMS_Accu 2
		158
		159	const prog_char param_menuitems_Accu[ITEMS_Accu][NUM_LANG][18]= // zeilen,zeichen+1
		160	// German, English, French, Dutch
		161	{
		162	{"PKT-Akkutyp ","PKT-Accutyp ","PKT-batterij type"},
		163	{"PKT Akku Messung ","PKT AccuMeasure ","PKT batt. meting "},
		164	};
		165
		166	#define ITEMS_GPS 6
		167
		168	const prog_char param_menuitems_GPS[ITEMS_GPS][NUM_LANG][18]= // zeilen,zeichen+1
		169	// German, English, French, Dutch
		170	{
		171	{"w�hle GPS Maus ","select GPS mouse ","select GPS mouse "},
		172	{"Suche GPS Maus ","search GPS mouse ","search GPS mouse "},
		173	{"GPS Maus Typ ","GPS mouse typ ","GPS mouse typ "},
		174	{"GPS Maus aktiv? ","GPS mouse activ? ","GPS mouse activ? "},
		175	{"Zeige GPS Device ","show GPS device ","show GPS device "},
		176	{"GPS Daten ","GPS data ","GPS data "},
		177
		178	};
		179
		180	#define ITEMS_FOLLOWME 3
		181
		182	const prog_char param_menuitems_FOLLOWME[ITEMS_GPS][NUM_LANG][18]= // zeilen,zeichen+1
		183	// German, English, French, Dutch
		184	{
		185	{"FollowMe Refresh","FollowMe Refresh","FollowMe Refresh"},
		186	{"FollowMe Speed ","FollowMe Speed ","FollowMe Speed "},
		187	{"Toleranz Radius ","Tolerance Radius","Tolerance Radius"},
		188
		189
		190	};
		191
		192
		193
		194	#define ITEMS_OSD 9
		195
		196	const prog_char param_menuitems_OSD[ITEMS_OSD][NUM_LANG][18]= // zeilen,zeichen+1
		197	// German, English, French, Dutch
		198	{
		199	{"OUT1/2 Format ","OUT1/2 format ","OUT1/2 format "},
		200	{"OUT1/2 Polarit�t ","OUT1/2 polarity ","OUT1/2 polarity "},
		201	{"Navi Daten an SV2","Navi data to SV2 ","Navi data to SV2 "},
		202	{"Max. Sinkrate m/s","max fallspeed m/s","max fallspeed m/s"},
		203	{"Variometer Beep ","Variometer beep ","Variometer beep "},
		204	{"Home aus MK Sicht","home from MK view","home from MK view"},
		205	{"MK LowBat Warnung","MK LowBat warning","MK LoBat alarm "},
		206	{"MK mAh Warnung","MK mAh warning ","MK mAh alarm "},
		207	{"MK Volt Balken","MK volt bargraph ","MK volt bargraph "},
		208	};
		209
		210	//--------------------------------------------------------------
		211	void Show_Error_HW12(void)
		212	{
		213	lcd_cls();
		214	lcd_printp_at (0,3,PSTR(" Mit Hardware 1.x "), 2);
		215	lcd_printp_at (0,4,PSTR(" nicht m�glich "), 2);
		216	_delay_ms(1000);
		217
		218	}
		219
		220	void Edit_printout(uint16_t Value,uint16_t min,uint16_t max, uint8_t what)
		221	{
		222
		223	switch (what)
		224	{
		225	case Show_uint3: write_ndigit_number_u (16, 2,Value, 3, 0,0);break;
		226	case Show_uint5: write_ndigit_number_u (16, 2,Value, 5, 0,0);break;
		227	case Show_uint10th: write_ndigit_number_u_10th (16, 2,Value, 3, 0,0); break;
		228	case GPSMOUSE:
		229	switch(Value)
		230	{
		231	case GPS_Bluetoothmouse1: lcd_printp_at (12, 2, PSTR("BT-Mouse1"), 0);break;
		232	case GPS_Mikrokopter: lcd_printp_at (12, 2, PSTR("Mikrokopt"), 0);break;
		233	lcd_printp_at (12, 2, PSTR("unknown"), 0);
		234	break;
		235
		236	}
		237	break;
		238
		239	case Wi_Netmode:
		240	switch (Value)
		241	{
		242	case false :lcd_puts_at(15, 2, strGet(SLAVE), 0);
		243	break;
		244	case true :lcd_puts_at(15, 2, strGet(NORMAL), 0);
		245	break;
		246	break;
		247	}
		248	break;
		249
		250	case OnOff:
		251	switch (Value)
		252
		253	{
		254	case false :lcd_puts_at(17, 2, strGet(OFF), 0);
		255	break;
		256	case true :lcd_puts_at(17, 2, strGet(ON), 0);
		257	break;
		258	break;
		259	}
		260	break;
		261
		262	case YesNo:
		263	switch (Value)
		264
		265	{
		266	case false :lcd_puts_at(17, 2, strGet(NOO), 0);
		267	break;
		268	case true :lcd_puts_at(17, 2, strGet(YES), 0);
		269	break;
		270	break;
		271	}
		272	break;
		273
		274	case NormRev:
		275	switch (Value)
		276	{
		277	case false :lcd_puts_at(14, 2, strGet(NORMAL), 0);
		278	break;
		279	case true :lcd_puts_at(14, 2, strGet(REVERSE), 0);
		280	break;
		281	break;
		282	}
		283	break;
		284
		285
		286
		287	case Kontrast: {
		288	write_ndigit_number_u (16, 2,Value, 3, 0,0);
		289	if (Value >= max)
		290	{
		291	Value = max;
		292	set_beep ( 200, 0x0080, BeepNormal);
		293	write_ndigit_number_u (16, 2,Value, 3, 0,0);
		294	}
		295	else
		296	{
		297	write_ndigit_number_u (16, 2,Value, 3, 0,0);
		298	cli();
		299	clr_A0 ();
		300	send_byte (0x81);
		301	send_byte (Value); // Daten zum LCD senden
		302	set_A0 ();
		303	sei();
		304	}
		305
		306	// break;
		307
		308	if (Value == min)
		309	{
		310	write_ndigit_number_u (16, 2,Value, 3, 0,0);
		311	Value = min;
		312	set_beep ( 200, 0x0080, BeepNormal);
		313	}
		314	else
		315	{
		316	write_ndigit_number_u (16, 2,Value, 3, 0,0);
		317	cli();
		318	clr_A0 ();
		319	send_byte (0x81);
		320	send_byte (Value); // Daten zum LCD senden
		321	set_A0 ();
		322	sei();
		323	}
		324
		325	}
		326	break;
		327
		328
		329	case Baudrate:
		330	switch (Value)
		331
		332	{
		333	case 0x0 : lcd_printp_at(15, 2, PSTR("2400 "), 0);
		334	break;
		335	case 0x1 : lcd_printp_at(15, 2, PSTR("9600 "), 0);
		336	break;
		337	case 0x2 : lcd_printp_at(15, 2, PSTR("19200 "), 0);
		338	break;
		339	case 0x3 : lcd_printp_at(15, 2, PSTR("38400 "), 0);
		340	break;
		341	case 0x4 : lcd_printp_at(15, 2, PSTR("57600 "), 0);
		342	break;
		343	case 0x5 : lcd_printp_at(15, 2, PSTR("115200"), 0);
		344	break;
		345	case 0x6 : lcd_printp_at(15, 2, PSTR("4800 "), 0);
		346	break;
		347	break;
		348	}
		349	break;
		350	case Language:
		351	switch (Value)
		352	{
		353	case
		354	0x0 : lcd_puts_at(10, 2, strGet(DEUTSCH), 0);//lcd_printp_at (14, 2, PSTR("Deutsch"), 0);
		355	break;
		356	case 0x1 : lcd_puts_at(10, 2, strGet(ENGLISCH), 0);//lcd_printp_at (14, 2, PSTR("English"), 0);
		357	break;
		358	case 0x2 : lcd_puts_at(10, 2, strGet(NETHERL), 0);//lcd_printp_at (14, 2, PSTR("Netherl"), 0);
		359	break;
		360	break;
		361	}
		362	break;
		363	case Sticktype:
		364	switch (Value)
		365
		366	{
		367	case false :lcd_puts_at(14, 2, strGet(POTI), 0);
		368	break;
		369	case true :lcd_puts_at(14, 2, strGet(TASTER), 0);
		370	break;
		371	break;
		372	}
		373	break;
		374
		375
		376
		377	break;
		378	}
		379
		380	}
		381
		382	uint16_t Edit_generic(uint16_t Value, uint16_t min, uint16_t max,uint8_t Text, uint8_t what)
		383	{
		384	Pre = Value;
		385
		386	lcd_cls();
		387	lcd_puts_at(0, 2, strGet(Text), 0);
		388	Edit_printout(Value,min,max, what);
		389	lcd_puts_at(0, 7, strGet(KEYLINE2), 0);
		390
		391	do
		392	{
		393	if ((get_key_press (1 << KEY_PLUS) \|\| get_key_long_rpt_sp ((1 << KEY_PLUS), 2)) && (Value < max))
		394	{
		395	edit = 1;
		396	Value++;
		397	Edit_printout(Value,min,max, what);
		398	playTone(500,20,Config.Volume);
		399	}
		400	if ((get_key_press (1 << KEY_MINUS) \|\| get_key_long_rpt_sp ((1 << KEY_MINUS), 2)) && (Value > min))
		401	{
		402	edit = 1;
		403	Value--;
		404	Edit_printout(Value,min,max, what);
		405	playTone(500,20,Config.Volume);
		406	}
		407
		408	if (get_key_press (1 << KEY_ENTER))
		409	{
		410
		411	return Value;
		412	}
		413	}
		414	while (!get_key_press (1 << KEY_ESC));
		415
		416	get_key_press(KEY_ALL);
		417	edit = 0;
		418	return Pre;
		419
		420	}
		421
		422	//--------------------------------------------------------------
		423	uint8_t ChangeWi_SV2(uint8_t Value)
		424	{
		425	Pre = Value;
		426	lcd_cls();
		427
		428	lcd_puts_at(0, 1, strGet(CONNECT1), 0);
		429	lcd_puts_at(0, 2, strGet(CONNECT2), 0);
		430
		431	if(Config.UseWi == false)
		432	{
		433	lcd_puts_at(0, 1, strGet(CONNECT1), 0);
		434	lcd_puts_at(0, 2, strGet(CONNECT4), 0);
		435	lcd_puts_at(0, 1, strGet(CONNECT5), 0);
		436	lcd_puts_at(0, 2, strGet(CONNECT6), 0);
		437	lcd_puts_at(0, 1, strGet(CONNECT7), 0);
		438	lcd_puts_at(0, 2, strGet(CONNECT8), 0);
		439	lcd_puts_at(0, 1, strGet(CONNECT9), 0);
		440
		441
		442	// lcd_printp_at (12, 7, PSTR("Ende"), 0);
		443	lcd_puts_at(12, 7, strGet(ENDE), 0);
		444	while (!get_key_press (1 << KEY_ESC));
		445	get_key_press(KEY_ALL);
		446	edit = 0;
		447	return Pre;
		448	}
		449	else
		450	{
		451	switch (Value)
		452	{
		453	case 0x0 :lcd_printp_at (14, 2, PSTR("Wi232"), 0);
		454	break;
		455	case 0x1 : lcd_puts_at(14, 2, strGet(KABEL), 0);
		456
		457	//lcd_printp_at (14, 2, PSTR("Kabel"), 0);
		458
		459	break;
		460	break;
		461	}
		462	// lcd_printp_at (0, 7, PSTR(KEY_LINE_2), 0);
		463	lcd_puts_at(0, 7, strGet(KEYLINE2), 0);
		464
		465	do
		466	{
		467	if(Config.UseWi == true)
		468	{
		469	if ((get_key_press (1 << KEY_PLUS)) && (Value == 0))
		470	{
		471	edit = 1;
		472	Value = 1;
		473	// lcd_printp_at (14, 2, PSTR("Kabel"), 0);
		474	lcd_puts_at(14, 2, strGet(KABEL), 0);
		475	Change_Output(Uart02FC);
		476	}
		477
		478	if ((get_key_press (1 << KEY_MINUS)) && (Value == 1))
		479	{
		480	edit = 1;
		481	Value = 0;
		482	lcd_printp_at (14, 2, PSTR("Wi232"), 0);
		483	Change_Output(Uart02Wi);
		484	}
		485
		486	if (get_key_press (1 << KEY_ENTER))
		487	{
		488	// lcd_printp_at (0, 4, PSTR("Sie m�ssen das PKT"), 0);
		489	// lcd_printp_at (0, 5, PSTR("jetzt neu starten!"), 0);
		490	lcd_puts_at(0, 4, strGet(CONNECT10), 0);
		491	lcd_puts_at(0, 5, strGet(CONNECT11), 0);
		492	lcd_cls_line (0, 7, 18);
		493	while (!get_key_press (1 << KEY_ENTER));
		494	return Value;
		495	}
		496	}
		497	}
		498	while (!get_key_press (1 << KEY_ESC));
		499	}
		500	get_key_press(KEY_ALL);
		501	edit = 0;
		502	return Pre;
		503	}
		504
		505
		506	//--------------------------------------------------------------
		507	uint8_t Edit_DisplayHelligkeit(uint8_t Value, uint8_t min, uint8_t max, uint8_t Text)
		508	{
		509	float ValCorr = 2.55; // (Value * ValCorr) maximal 255
		510	Pre = Value;
		511	OCR2A = Value * ValCorr;
		512
		513	lcd_cls();
		514	// lcd_printp_at (0, 2, Text, 0);
		515	lcd_puts_at(0, 2, strGet(Text), 0);
		516	write_ndigit_number_u (16, 2, Value, 3, 0,0);
		517	lcd_printp_at (17, 2, PSTR("%"), 0);
		518	// lcd_printp_at (0, 7, PSTR(KEY_LINE_2), 0);
		519	lcd_puts_at(0, 7, strGet(KEYLINE2), 0);
		520
		521	do
		522	{
		523	write_ndigit_number_u (16, 2,Value, 3, 0,0);
		524	lcd_frect ((80), (84), (Value * (16*8) / 100), 6, 1);
		525
		526	if ((get_key_press (1 << KEY_PLUS) \|\| get_key_long_rpt_sp ((1 << KEY_PLUS), 3)) && (Value < max))
		527	{
		528	Value++;
		529
		530	if (Value >= max)
		531	{
		532	Value = max;
		533	set_beep ( 200, 0x0080, BeepNormal);
		534	}
		535	else
		536	OCR2A = Value * ValCorr;
		537
		538	}
		539
		540	if ((get_key_press (1 << KEY_MINUS) \|\| get_key_long_rpt_sp ((1 << KEY_MINUS), 3)) && (Value > min))
		541	{
		542	lcd_frect (((Value - 1) * (168) / 100), (84), (16*8), 6, 0);
		543	Value--;
		544
		545	if (Value == min)
		546	{
		547	Value = min;
		548	set_beep ( 200, 0x0080, BeepNormal);
		549	}
		550	else
		551	OCR2A = Value * ValCorr;
		552
		553	}
		554
		555	if (get_key_press (1 << KEY_ENTER))
		556	{
		557	edit = 1;
		558	OCR2A = Value * ValCorr;
		559	Config.LCD_Helligkeit = Value;
		560	// WriteParameter();
		561	edit = 0;
		562	return Value;
		563	}
		564	}
		565
		566	while (!get_key_press (1 << KEY_ESC));
		567	{
		568	get_key_press(KEY_ALL);
		569	edit = 0;
		570	OCR2A = Pre * ValCorr;
		571	Config.LCD_Helligkeit = Pre;
		572	// WriteParameter();
		573	return Pre;
		574	}
		575	}
		576
		577
		578	//--------------------------------------------------------------
		579	void Reset_EEprom(void)
		580	{
		581	lcd_cls();
		582	get_key_press(KEY_ALL);
		583	// lcd_printp_at (0, 2, PSTR(" EEProm wirklich"), 0);
		584	// lcd_printp_at (0, 3, PSTR(" l�schen?"), 0);
		585	// lcd_printp_at (12, 7, PSTR("Ende OK"), 0);
		586	lcd_puts_at(0, 2, strGet(EEPROM1), 0);
		587	lcd_puts_at(0, 3, strGet(EEPROM2), 0);
		588	lcd_puts_at(12, 7, strGet(ENDOK), 0);
		589
		590
		591	do
		592	{
		593
		594	if (get_key_press (1 << KEY_ENTER))
		595	{
		596	Delete_EEPROM();
		597	clr_V_On();
		598	return;
		599	}
		600	}
		601	while (!get_key_press (1 << KEY_ESC));
		602	get_key_press(KEY_ALL);
		603	}
		604
		605
		606	//--------------------------------------------------------------
		607	void PKT_Setup (void)
		608	{
		609	// uint8_t ii = 0;
		610	// uint8_t Offset = 0;
		611	// uint8_t size = 0;
		612
		613	// uint8_t dmode = 0;
		614	uint8_t target_pos=1;
		615	// uint8_t val;
		616
		617	lcd_cls ();
		618	mmode = 0;
		619	edit= 0;
		620	val = 0;
		621
		622	while(1)
		623	{
		624	size = ITEMS_PKT;
		625	lcd_cls ();
		626	lcd_printp_at (0, 0, PSTR(" PKT-Setup "), 2);
		627	// lcd_printp_at (0, 7, PSTR(KEY_LINE_1), 0);
		628	lcd_puts_at(0, 7, strGet(KEYLINE1), 0);
		629
		630	// while(1)
		631	// {
		632	// ii = 0;
		633	//
		634	// if(Offset > 0)
		635	// lcd_printp_at(1,1, PSTR("\x12"), 0);
		636	//
		637	// for(ii = 0;ii < 6 ; ii++)
		638	// {
		639	// if((ii+Offset) < size)
		640	// lcd_printp_at(3,ii+1,param_menuitems_pkt[ii+Offset][Config.DisplayLanguage], 0);
		641	//
		642	// if((ii == 5)&&(ii+Offset < (size-1)))
		643	// lcd_printp_at(1,6, PSTR("\x13"), 0);
		644	//
		645	// }
		646	//
		647	// if(dmode == 0)
		648	// {
		649	// if(Offset == 0)
		650	// {
		651	// if(size > 6)
		652	// val = menu_choose2 (1, 5, target_pos,0,1);
		653	// else
		654	// val = menu_choose2 (1, size, target_pos,0,0);
		655	//
		656	// }
		657	// else
		658	// val = menu_choose2 (2, 5, target_pos,1,1);
		659	//
		660	// }
		661	//
		662	// if(dmode == 1)
		663	// {
		664	// if(Offset+7 > size)
		665	// val = menu_choose2 (2, 6, target_pos,1,0);
		666	// else
		667	// val = menu_choose2 (2, 5, target_pos,1,1);
		668	//
		669	// }
		670	//
		671	// if(val == 254)
		672	// {
		673	// Offset++;
		674	// dmode = 1;
		675	// target_pos = 5;
		676	// }
		677	// else if(val == 253)
		678	// {
		679	// Offset--;
		680	// dmode = 0;
		681	// target_pos = 2;
		682	// }
		683	// else if(val == 255)
		684	// { // Ende mit ESC, speichern
		685	// if (edit == 1)
		686	// {
		687	// WriteParameter();
		688	// edit = 0;
		689	// return;
		690	// }
		691	// return;
		692	// }
		693	// else
		694	// break;
		695	// }
		696
		697	val = menu_select(param_menuitems_pkt,size,target_pos);
		698	if (val==255) break;
		699	target_pos = val;
		700
		701	//
		702	// {"Verbindung zum MK","connection to MK "," connexion a MK " ,"Aansluiting op MK"},
		703	// {"MK LowBat Warnung","MK LowBat warning","MK LowBat Attent", "MK LoBat alarm "},
		704	// {"Anzeige \x1d","Display \x1d","d'affichage \x1d","Display \x1d"},
		705	// {"Wi.232 \x1d","Wi.232 \x1d","Wi.232 \x1d","Wi.232 \x1d"},
		706	// {"BTM-222 \x1d","BTM-222 \x1d","BTM-222 \x1d","BTM-222 \x1d"},
		707	// {"Antennen Track. \x1d","antenna tracking\x1d","antenna tracking\x1d","antenna tracking\x1d"},
		708	// {"OSD \x1d","OSD \x1d","OSD \x1d","OSD \x1d"},
		709	// {"GPS \x1d","GPS \x1d","GPS \x1d","GPS \x1d"},
		710	// "Follow Me \x1d"
		711	// {"PKT-Akku \x1d","PKT-Accu \x1d","PKT-Accu \x1d","PKT-Accu \x1d"},
		712	// {"PKT Update ","PKT Update ","PKT Mise a jour ","PKT Update "},
		713	// {"Debug PKT ","Debug PKT ","Debug PKT ","Debug PKT "},
		714	// {"EEProm Reset ","EEProm Reset ","EEProm Reinitiali","EEProm Reset "},
		715
		716
		717
		718	if((val + offset) == 1)
		719	{
		720	#ifdef HWVERSION3_9
		721	Config.U02SV2 = ChangeWi_SV2(Config.U02SV2);
		722
		723	if (edit == 1)
		724	PKT_Change = 1;
		725
		726	#else
		727	Show_Error_HW12();
		728	#endif
		729	}
		730
		731
		732	if((val + offset) == 2) Display_Setup();
		733
		734	if((val + offset) == 3)
		735	{
		736	#if defined HWVERSION3_9 \|\| defined HWVERSION1_2W \|\| defined HWVERSION1_3W
		737	if(Config.UseWi == false)
		738	// Wi_Use();
		739	{
		740	Config.UseWi = Edit_generic(Config.UseWi,0,1,WI2321,YesNo);
		741	if (edit==1)
		742	if (Config.UseWi== true) InitWi232(Config.PKT_Baudrate);
		743	}
		744
		745	else
		746	Wi_Setup();
		747	#else
		748	Show_Error_HW12();
		749	#endif
		750	}
		751
		752	if((val + offset) == 4)
		753	{
		754	#ifdef HWVERSION3_9
		755	if(Config.UseBT == 0)
		756	{
		757	Config.UseBT = Edit_generic(Config.UseBT,0,1,BT1,YesNo);
		758	if (edit==1)
		759	if (Config.UseBT == 1)
		760	{
		761	if (bt_init()) Config.BTIsSet = true; else Config.BTIsSet = false;
		762	// WriteParameter();
		763	edit = 0;
		764	}
		765	}
		766	else
		767	BT_Setup();
		768	#else
		769	Show_Error_HW12();
		770	#endif
		771	}
		772
		773	if((val + offset) == 5) servo_menu();
		774	if((val + offset) == 6) OSD_Setup();
		775	#ifdef HWVERSION3_9
		776	if((val + offset) == 7) GPS_Setup();
		777
		778	if((val + offset) == 8) FollowMe_Setup();
		779	if((val + offset) == 9) Joysticks_Setup();
		780
		781	if((val + offset) == 10) Accu_Setup();
		782	#else
		783	Show_Error_HW12();
		784	#endif
		785	if((val + offset) == 11) Update_PKT();
		786
		787	if((val + offset) == 12) Config.Debug = Edit_generic(Config.Debug,0,1,DEBUGPKT,Show_uint3);
		788
		789	if((val + offset) == 13) Reset_EEprom();
		790
		791
		792	}
		793	}
		794
		795
		796	//--------------------------------------------------------------
		797	void Display_Setup (void)
		798	{
		799	// uint8_t ii = 0;
		800	// uint8_t Offset = 0;
		801	// uint8_t size = 0;
		802
		803	// uint8_t dmode = 0;
		804	uint8_t target_pos = 1;
		805	// uint8_t val;
		806
		807	lcd_cls ();
		808	mmode = 0;
		809	edit= 0;
		810	LCD_Change = 0;
		811	// val = 0;
		812
		813	while(1)
		814	{
		815	size = ITEMS_LCD;
		816	lcd_cls ();
		817	lcd_puts_at(0, 0, strGet(DISPLAY1), 2);
		818	lcd_puts_at(0, 7, strGet(KEYLINE1), 0);
		819
		820	// while(1)
		821	// {
		822	// ii = 0;
		823	//
		824	// if(Offset > 0)
		825	// lcd_printp_at(1, 1, PSTR("\x12"), 0);
		826	//
		827	// for(ii = 0; ii < 6 ; ii++)
		828	// {
		829	// if((ii + Offset) < size)
		830	// lcd_printp_at(3, ii + 1, param_menuitems_lcd[ii + Offset][Config.DisplayLanguage], 0);
		831	//
		832	// if((ii == 5)&&(ii+Offset < (size - 1)))
		833	// lcd_printp_at(1,6, PSTR("\x13"), 0);
		834	//
		835	// }
		836	//
		837	// if(dmode == 0)
		838	// {
		839	// if(Offset == 0)
		840	// {
		841	// if(size > 6)
		842	// val = menu_choose2 (1, 5, target_pos,0,1);
		843	// else
		844	// val = menu_choose2 (1, size, target_pos,0,0);
		845	//
		846	// }
		847	// else
		848	// val = menu_choose2 (2, 5, target_pos,1,1);
		849	//
		850	// }
		851	//
		852	// if(dmode == 1)
		853	// {
		854	// if(Offset + 7 > size)
		855	// val = menu_choose2 (2, 6, target_pos,1,0);
		856	// else
		857	// val = menu_choose2 (2, 5, target_pos,1,1);
		858	//
		859	// }
		860	//
		861	// if(val == 254)
		862	// {
		863	// Offset++;
		864	// dmode = 1;
		865	// target_pos = 5;
		866	// }
		867	// else if(val == 253)
		868	// {
		869	// Offset--;
		870	// dmode = 0;
		871	// target_pos = 2;
		872	// }
		873	// else if(val == 255)
		874	// { // Ende mit ESC, speichern
		875	// if (edit == 1)
		876	// {
		877	// WriteParameter();
		878	// edit = 0;
		879	// return;
		880	// }
		881	// return;
		882	// }
		883	// else
		884	// break;
		885	// }
		886
		887	val = menu_select(param_menuitems_lcd,size,target_pos);
		888	if (val==255) break;
		889	target_pos = val;
		890
		891	if((val + offset) == 1)
		892	Config.PKT_StartInfo = Edit_generic(Config.PKT_StartInfo,0,2,DISPLAY2,OnOff);
		893	if((val + offset) == 2)
		894	Config.OSD_RCErrorbeep = Edit_generic(Config.OSD_RCErrorbeep,0,2,DISPLAY9,OnOff);
		895
		896	if((val + offset) == 3)
		897	Config.DisplayLanguage = Edit_generic(Config.DisplayLanguage,0,2,DISPLAY3,Language);
		898
		899
		900	if((val + offset) == 4)
		901	Config.DisplayTimeout = Edit_generic(Config.DisplayTimeout,0,254,DISPLAY4,Show_uint3);
		902
		903	if((val + offset) == 5)
		904	{
		905	if (Config.HWSound==0)
		906	{
		907	Config.LCD_Helligkeit = Edit_DisplayHelligkeit(Config.LCD_Helligkeit,0,100,DISPLAY5);
		908	if (edit == 1)
		909	if(!LCD_Change)
		910	LCD_Change =1;
		911	}
		912
		913
		914	}
		915
		916
		917	if((val + offset) == 6)
		918	Config.LCD_Kontrast = Edit_generic(Config.LCD_Kontrast,0,63,DISPLAY6,Kontrast);
		919	if (edit == 1)
		920	if(!LCD_Change)
		921	LCD_Change =1;
		922
		923	if((val + offset) == 7)
		924	{
		925	Config.LCD_DisplayMode = Edit_generic(Config.LCD_DisplayMode,0,4,DISPLAY7,NormRev);
		926	if (edit == 1)
		927	if(!LCD_Change)
		928	LCD_Change =1;
		929	}
		930
		931	if((val + offset) == 8)
		932	{
		933	Config.LCD_ORIENTATION = Edit_generic(Config.LCD_ORIENTATION,0,4,DISPLAY8,NormRev);
		934	if (edit == 1)
		935	if(!LCD_Change)
		936	LCD_Change =1;
		937	}
		938	if((val + offset) == 9)
		939	{
		940	Config.HWSound = Edit_generic(Config.HWSound,0,1,HWSOUND,YesNo);
		941
		942	}
		943	if((val + offset) == 10)
		944	{
		945	Config.HWBeeper = Edit_generic(Config.HWBeeper,0,1,HWBEEPER,YesNo);
		946
		947	}
		948	if((val + offset) == 11)
		949	Config.Volume = Edit_generic(Config.Volume,0,50,VOLUME,Show_uint3);
		950
		951
		952	}
		953	}
		954
		955
		956	//--------------------------------------------------------------
		957	void Wi_Setup (void)
		958	{
		959	// uint8_t ii = 0;
		960	// uint8_t Offset = 0;
		961	// uint8_t size = 0;
		962
		963	// uint8_t dmode = 0;
		964	uint8_t target_pos = 1;
		965	// uint8_t val = 0;
		966
		967	mmode = 0;
		968	edit = 0;
		969	// WiIsSet = true;
		970
		971	lcd_cls ();
		972
		973	while(1)
		974	{
		975	size = ITEMS_WI;
		976	lcd_cls ();
		977	lcd_printp_at (0, 0, PSTR(" Wi.232 Setup "), 2);
		978	lcd_puts_at(0, 7, strGet(KEYLINE1), 0);
		979
		980	// while(1)
		981	// {
		982	// ii = 0;
		983	//
		984	// if(Offset > 0)
		985	// lcd_printp_at(1, 1, PSTR("\x12"), 0);
		986	//
		987	// for(ii = 0; ii < 6; ii++)
		988	// {
		989	// if((ii + Offset) < size)
		990	// lcd_printp_at(3, ii+1, param_menuitems_wi[ii+Offset][Config.DisplayLanguage], 0);
		991	//
		992	// if((ii == 5)&&(ii + Offset < (size - 1)))
		993	// lcd_printp_at(1, 6, PSTR("\x13"), 0);
		994	//
		995	// }
		996	//
		997	// if(dmode == 0)
		998	// {
		999	// if(Offset == 0)
		1000	// {
		1001	// if(size > 6)
		1002	// val = menu_choose2 (1, 5, target_pos,0,1);
		1003	// else
		1004	// val = menu_choose2 (1, size, target_pos,0,0);
		1005	//
		1006	// }
		1007	// else
		1008	// val = menu_choose2 (2, 5, target_pos,1,1);
		1009	//
		1010	// }
		1011	//
		1012	// if(dmode == 1)
		1013	// {
		1014	// if(Offset + 7 > size)
		1015	// val = menu_choose2 (2, 6, target_pos, 1, 0);
		1016	// else
		1017	// val = menu_choose2 (2, 5, target_pos, 1, 1);
		1018	//
		1019	// }
		1020	//
		1021	// if(val == 254)
		1022	// {
		1023	// Offset++;
		1024	// dmode = 1;
		1025	// target_pos = 5;
		1026	// }
		1027	// else if(val == 253)
		1028	// {
		1029	// Offset--;
		1030	// dmode = 0;
		1031	// target_pos = 2;
		1032	// }
		1033	// else if(val == 255)
		1034	// { // Ende mit ESC, speichern
		1035	// if (edit == 1)
		1036	// {
		1037	// if (Config.UseWi==true) InitWi232(Config.PKT_Baudrate);
		1038	// //Old_Baudrate = PKT_Baudrate;
		1039	// WriteParameter();
		1040	// edit = 0;
		1041	// }
		1042	//
		1043	// return;
		1044	// }
		1045	// else
		1046	//
		1047	// break;
		1048	// }
		1049
		1050	val = menu_select(param_menuitems_wi,size,target_pos);
		1051	if (val==255)
		1052	{
		1053	if (edit == 1)
		1054	{
		1055	if (Config.UseWi==true) InitWi232(Config.PKT_Baudrate);
		1056	//Old_Baudrate = PKT_Baudrate;
		1057	// WriteParameter();
		1058	edit = 0;
		1059	}
		1060	break;
		1061	}
		1062
		1063	target_pos = val;
		1064
		1065	if((val + offset) == 1)
		1066	{
		1067	Config.UseWi = Edit_generic(Config.UseWi,0,1,WI2321,YesNo);
		1068	}
		1069
		1070	if((val + offset) == 2)
		1071	{
		1072	Config.WiTXRXChannel = Edit_generic(Config.WiTXRXChannel, 0, 5,WITXRX,Show_uint3);
		1073
		1074	}
		1075
		1076	if((val + offset) == 3)
		1077	{
		1078	Config.WiNetworkGroup = Edit_generic(Config.WiNetworkGroup, 0, 127, WINETWG,Show_uint3);
		1079
		1080
		1081	}
		1082
		1083	if((val + offset) == 4)
		1084	{
		1085	Config.WiNetworkMode = Edit_generic(Config.WiNetworkMode,0,1,WINETWM,Wi_Netmode);
		1086
		1087
		1088	}
		1089
		1090	if((val + offset) == 5)
		1091	{
		1092	Config.WiTXTO = Edit_generic(Config.WiTXTO,0,127,WITIMEOUT,Show_uint3);
		1093
		1094
		1095	}
		1096
		1097	if((val + offset) == 6)
		1098	{
		1099	Config.WiUartMTU = Edit_generic(Config.WiUartMTU,0,127,WIUART,Show_uint3);
		1100
		1101
		1102	}
		1103
		1104	if((val + offset) == 7)
		1105	{
		1106	Old_Baudrate = Config.PKT_Baudrate;
		1107	Config.PKT_Baudrate = Edit_generic(Config.PKT_Baudrate,1,6,PKT_BAUDRATE,Baudrate);
		1108	Wi232_New_Baudrate = Config.PKT_Baudrate;
		1109	BT_New_Baudrate = Config.PKT_Baudrate;
		1110	if (edit==1)
		1111	{ if (Config.UseBT==true) { set_BTOn(); bt_setbaud(BT_New_Baudrate); set_BTOff();}
		1112	if (Config.UseWi==true) InitWi232(Wi232_New_Baudrate);
		1113	// WriteParameter();
		1114	Old_Baudrate = Config.PKT_Baudrate;
		1115	edit = 0;
		1116	}
		1117
		1118
		1119	}
		1120
		1121
		1122
		1123	if((val + offset) == 8)
		1124	InitWi232(Config.PKT_Baudrate);
		1125	if((val + offset) == 9)
		1126	Port_USB2CFG_Wi();
		1127	}
		1128	}
		1129
		1130
		1131
		1132
		1133	uint8_t Edit_String(const char data, const uint8_t length, uint8_t type, const char Text)
		1134	{
		1135	uint8_t y = 1;
		1136	uint8_t x = 1;
		1137	uint8_t I = 0;
		1138
		1139	lcd_cls();
		1140	lcd_printp_at (0, 0, Text, 2);
		1141
		1142	for (uint8_t i = 0; i < length; i++)
		1143	{
		1144	lcd_putc (y++, 3, data[i], 0);
		1145	lcd_printp_at (y++, 3, PSTR(" "), 0);
		1146
		1147	EditString[i] = data[i];
		1148	}
		1149
		1150	lcd_rect ((x6)-3, (83)-2, 10, 10, 1);
		1151	lcd_printp_at (0, 6, PSTR(" C"), 0);
		1152	lcd_printp_at (0, 7, PSTR(" \x17 \x16 \x19 OK"), 0);
		1153
		1154	do
		1155	{
		1156	if (type == 1) // Name
		1157	{
		1158	for (uint8_t i = bt_name_length; i > 0; i--)
		1159	{
		1160	if (EditString[i - 1] != ' ')
		1161	{
		1162	bt_name_len = i;
		1163	break;
		1164	}
		1165	}
		1166
		1167	if ((get_key_press (1 << KEY_PLUS) \|\| get_key_long_rpt_sp ((1 << KEY_PLUS), 2)) && EditString[I] < 'z')
		1168	{
		1169	EditString[I]++;
		1170
		1171	if (EditString[I] >= 0x00 && EditString[I] < ' ')
		1172	EditString[I] = ' ';
		1173
		1174	if (EditString[I] > ' ' && EditString[I] < '0')
		1175	EditString[I] = '0';
		1176
		1177	if (EditString[I] > '9' && EditString[I] < 'A')
		1178	EditString[I] = 'A';
		1179
		1180	if (EditString[I] > 'Z' && EditString[I] < 'a')
		1181	EditString[I] = 'a';
		1182
		1183	lcd_putc (x, 3, EditString[I], 0);
		1184	edit = 1;
		1185	}
		1186
		1187	if ((get_key_press (1 << KEY_MINUS) \|\| get_key_long_rpt_sp ((1 << KEY_MINUS), 2)) && EditString[I] > ' ')
		1188	{
		1189	EditString[I]--;
		1190
		1191	if (EditString[I] < 'a' && EditString[I] > 'Z')
		1192	EditString[I] = 'Z';
		1193
		1194	if (EditString[I] < 'A' && EditString[I] > '9')
		1195	EditString[I] = '9';
		1196
		1197	if (EditString[I] < '0' && EditString[I] > ' ')
		1198	EditString[I] = ' ';
		1199
		1200	lcd_putc (x, 3, EditString[I], 0);
		1201	edit = 1;
		1202	}
		1203	}
		1204	else if (type == 2) // PIN
		1205	{
		1206	if ((get_key_press (1 << KEY_PLUS) \|\| get_key_long_rpt_sp ((1 << KEY_PLUS), 1)) && (EditString[I] < '9'))
		1207	{
		1208	EditString[I]++;
		1209
		1210	if (EditString[I] >= 0x00 && EditString[I] < ' ')
		1211	EditString[I] = ' ';
		1212
		1213	if (EditString[I] > ' ' && EditString[I] < '0')
		1214	EditString[I] = '0';
		1215
		1216	lcd_putc (x, 3, EditString[I], 0);
		1217	edit = 1;
		1218	}
		1219
		1220	if ((get_key_press (1 << KEY_MINUS) \|\| get_key_long_rpt_sp ((1 << KEY_MINUS), 1)) && (EditString[I] > '0'))
		1221	{
		1222	EditString[I]--;
		1223
		1224	if (EditString[I] < 'A' && EditString[I] > '9')
		1225	EditString[I] = '9';
		1226
		1227	lcd_putc (x, 3, EditString[I], 0);
		1228	edit = 1;
		1229	}
		1230	}
		1231
		1232	if (get_key_long (1 << KEY_ESC))
		1233	{
		1234	if (type == 1) // Name
		1235	EditString[I] = ' '; // Zeichen l�schen
		1236	else if (type == 2) // Pin
		1237	EditString[I] = '0'; // Zeichen setzen
		1238	lcd_putc (x, 3, EditString[I], 0);
		1239	edit = 1;
		1240	}
		1241
		1242	if (get_key_short (1 << KEY_ESC))
		1243	{
		1244	if (type == 1)
		1245	length_tmp = bt_name_length;
		1246	else if (type == 2)
		1247	length_tmp = bt_pin_length;
		1248
		1249	if ((x / 2) + 2 > length_tmp)
		1250	{
		1251	lcd_rect ((x6)-3, (83)-2, 10, 10, 0);
		1252	x = 1;
		1253	lcd_rect ((x6)-3, (83)-2, 10, 10, 1);
		1254	I = 0;
		1255	}
		1256	else
		1257	{
		1258	lcd_rect ((x6)-3, (83)-2, 10, 10, 0);
		1259	x++;
		1260	x++;
		1261	lcd_rect ((x6)-3, (83)-2, 10, 10, 1);
		1262	I++; //Zeiger auf Zeichen
		1263	}
		1264	}
		1265	}
		1266	while (!get_key_press (1 << KEY_ENTER));
		1267	{
		1268	return 1;
		1269	}
		1270	}
		1271
		1272
		1273	void BT_SelectDevice (void)
		1274	{
		1275	uint8_t ii = 0;
		1276	uint8_t Offset = 0;
		1277	uint8_t size = 0;
		1278
		1279
		1280	uint8_t dmode = 0;
		1281	uint8_t target_pos = 1;
		1282	uint8_t val = 0;
		1283
		1284	mmode = 0;
		1285	edit = 0;
		1286
		1287
		1288	lcd_cls ();
		1289
		1290	while(1)
		1291	{
		1292	size = bt_devicecount;
		1293	lcd_cls ();
		1294	lcd_printp_at (0, 0, PSTR(" BT select Device "), 2);
		1295	lcd_puts_at(0, 7, strGet(KEYLINE1), 0);
		1296
		1297	while(1)
		1298	{
		1299	ii = 0;
		1300
		1301	if(Offset > 0)
		1302	lcd_printp_at(1, 1, PSTR("\x12"), 0);
		1303
		1304	for(ii = 0; ii < 6; ii++)
		1305	{
		1306	if((ii + Offset) < size)
		1307	{
		1308	if (strncmp (device_list[ii + Offset].mac, Config.gps_UsedMac, 14) == 0)
		1309	{
		1310	lcd_puts_at(3, ii+1, device_list[ii + Offset].DevName, 2);
		1311	// lcd_puts_at(3, 4, strGet(KEYLINE1), 0);
		1312	}
		1313	else
		1314	{
		1315	lcd_puts_at(3, ii+1, device_list[ii + Offset].DevName, 0);
		1316	// lcd_puts_at(3, 5, strGet(KEYLINE1), 0);
		1317	}
		1318	}
		1319
		1320	if((ii == 5)&&(ii + Offset < (size - 1)))
		1321	lcd_printp_at(1, 6, PSTR("\x13"), 0);
		1322
		1323	}
		1324
		1325	if(dmode == 0)
		1326	{
		1327	if(Offset == 0)
		1328	{
		1329	if(size > 6)
		1330	val = menu_choose2 (1, 5, target_pos,0,1);
		1331	else
		1332	val = menu_choose2 (1, size, target_pos,0,0);
		1333
		1334	}
		1335	else
		1336	val = menu_choose2 (2, 5, target_pos,1,1);
		1337
		1338	}
		1339
		1340	if(dmode == 1)
		1341	{
		1342	if(Offset + 7 > size)
		1343	val = menu_choose2 (2, 6, target_pos, 1, 0);
		1344	else
		1345	val = menu_choose2 (2, 5, target_pos, 1, 1);
		1346
		1347	}
		1348
		1349	if(val == 254)
		1350	{
		1351	Offset++;
		1352	dmode = 1;
		1353	target_pos = 5;
		1354	}
		1355	else if(val == 253)
		1356	{
		1357	Offset--;
		1358	dmode = 0;
		1359	target_pos = 2;
		1360	}
		1361	else if(val == 255)
		1362	{ // Ende mit ESC, speichern
		1363	if (edit == 1)
		1364	{
		1365	// WriteParameter();
		1366	edit = 0;
		1367	}
		1368
		1369	return;
		1370	}
		1371	else
		1372
		1373	break;
		1374	}
		1375	target_pos = val;
		1376
		1377	if(val > 0 )
		1378	{
		1379	for(uint8_t i = 0; i < 14; i++)
		1380	{
		1381	Config.gps_UsedMac[i] = device_list[val-1].mac[i];
		1382	}
		1383	for(uint8_t i = 0; i < 20; i++)
		1384	{
		1385	Config.gps_UsedDevName[i] = device_list[val-1].DevName[i];
		1386	}
		1387	edit = 1;
		1388	}
		1389	}
		1390	}
		1391
		1392
		1393	//--------------------------------------------------------------
		1394	//
		1395	void BT_Setup (void)
		1396	{
		1397	// uint8_t ii = 0;
		1398	uint8_t z = 0;
		1399	// uint8_t Offset = 0;
		1400	// uint8_t size = 0;
		1401
		1402	// uint8_t dmode = 0;
		1403	uint8_t target_pos = 1;
		1404	// uint8_t val;
		1405	char string[20];
		1406
		1407	mmode = 0;
		1408	edit = 0;
		1409	// val = 0;
		1410	// BTIsSet = true;
		1411
		1412	lcd_cls ();
		1413
		1414	while(1)
		1415	{
		1416	size = ITEMS_BT;
		1417	lcd_cls ();
		1418	lcd_puts_at(0, 0, strGet(BT1), 2);
		1419	lcd_puts_at(0, 7, strGet(KEYLINE1), 0);
		1420
		1421	// while(1)
		1422	// {
		1423	// ii = 0;
		1424	//
		1425	// if(Offset > 0)
		1426	// lcd_printp_at(1,1, PSTR("\x12"), 0);
		1427	//
		1428	// for(ii = 0; ii < 6; ii++)
		1429	// {
		1430	// if((ii + Offset) < size)
		1431	// {
		1432	// lcd_printp_at(3, ii + 1, param_menuitems_bt[ii+Offset][Config.DisplayLanguage], 0);
		1433	// if ((ii+Offset)==5)
		1434	// {
		1435	// for (uint8_t i = 0; i < RE_ID_length; i++)
		1436	// {
		1437	// lcd_putc (10+i, ii+1, Config.RE_ID[i], 0);
		1438	//
		1439	// }
		1440	// }
		1441	// }
		1442	//
		1443	//
		1444	// if((ii == 5) && (ii + Offset < (size - 1)))
		1445	// lcd_printp_at(1,6, PSTR("\x13"), 0);
		1446	//
		1447	// }
		1448	//
		1449	// if(dmode == 0)
		1450	// {
		1451	// if(Offset == 0)
		1452	// {
		1453	// if(size > 6)
		1454	// val = menu_choose2 (1, 5, target_pos, 0, 1);
		1455	// else
		1456	// val = menu_choose2 (1, size, target_pos, 0, 0);
		1457	//
		1458	// }
		1459	// else
		1460	// val = menu_choose2 (2, 5, target_pos, 1, 1);
		1461	//
		1462	// }
		1463	//
		1464	// if(dmode == 1)
		1465	// {
		1466	// if(Offset + 7 > size)
		1467	// val = menu_choose2 (2, 6, target_pos, 1, 0);
		1468	// else
		1469	// val = menu_choose2 (2, 5, target_pos, 1, 1);
		1470	// }
		1471	//
		1472	// if(val == 254)
		1473	// {
		1474	// Offset++;
		1475	// dmode = 1;
		1476	// target_pos = 5;
		1477	// }
		1478	// else if(val == 253)
		1479	// {
		1480	// Offset--;
		1481	// dmode = 0;
		1482	// target_pos = 2;
		1483	// }
		1484	// else if(val == 255)
		1485	// { // Ende mit ESC, speichern
		1486	// if (edit == 1)
		1487	// {
		1488	// if (Config.UseBT == 1);
		1489	// if (bt_init()) Config.BTIsSet = true; else Config.BTIsSet = false;
		1490	// WriteParameter();
		1491	// return;
		1492	// }
		1493	// return;
		1494	// }
		1495	// else
		1496	// break;
		1497	// }
		1498	val = menu_select(param_menuitems_bt,size,target_pos);
		1499	if (val==255)
		1500	{
		1501	if (edit == 1)
		1502	{
		1503	if (Config.UseBT == 1);
		1504	if (bt_init()) Config.BTIsSet = true; else Config.BTIsSet = false;
		1505	}
		1506	break;
		1507	}
		1508	target_pos = val;
		1509	if((val + offset) == 1)
		1510
		1511	Config.UseBT = Edit_generic(Config.UseBT,0,1,BT4,YesNo);
		1512
		1513	if((val + offset) == 2)
		1514	{
		1515	for (uint8_t i = 0; i < bt_name_length; i++)
		1516	{
		1517	string[i] = Config.bt_name[i];
		1518	}
		1519	string[bt_name_length] = 0;
		1520	Edit_String(string, bt_name_length, 1, PSTR(" Bluetooth Name "));
		1521	if (edit == 1)
		1522	{
		1523	for (uint8_t i = 0; i < bt_name_len; i++)
		1524	{
		1525	Config.bt_name[i] = EditString[i];
		1526	// WriteParameter();
		1527	}
		1528
		1529	if (bt_name_len < 10)
		1530	{
		1531	for (uint8_t i = bt_name_len; i < 10; i++)
		1532	{
		1533	Config.bt_name[i] = ' ';
		1534	// WriteParameter();
		1535	}
		1536	}
		1537	}
		1538	}
		1539
		1540	if((val + offset) == 3)
		1541	{
		1542	for (uint8_t i = 0; i < bt_pin_length; i++)
		1543	{
		1544	string[i] = Config.bt_pin[i];
		1545	}
		1546	string[bt_pin_length] = 0;
		1547	Edit_String(string, bt_pin_length, 2, PSTR(" Bluetooth Pin "));
		1548	if (edit == 1)
		1549	{
		1550	for (uint8_t i = 0; i < bt_pin_length; i++)
		1551	{
		1552	Config.bt_pin[i] = EditString[i];
		1553	// WriteParameter();
		1554	}
		1555	}
		1556	}
		1557
		1558	if((val + offset) == 4)
		1559	{
		1560	// if (edit == 1)
		1561	// if(BTIsSet)
		1562	// BTIsSet = false;
		1563
		1564	if (bt_init() == true)
		1565	{
		1566	lcd_printp_at (0, 3, PSTR("BT Init ok"), 0);
		1567	WriteBTInitFlag();
		1568	}
		1569	else
		1570	{
		1571	lcd_printp_at (0, 3, PSTR("BT Init Error"), 0);
		1572	Config.BTIsSet = false;
		1573	set_beep ( 1000, 0x0040, BeepNormal);
		1574
		1575	}
		1576	}
		1577
		1578
		1579	if((val + offset) == 5)
		1580	{
		1581	lcd_cls ();
		1582	lcd_printp_at (0, 0, PSTR(" BTM-222 MAC-Adresse "), 2);
		1583	lcd_puts_at(18, 7, strGet(OK), 0);
		1584	lcd_printp_at (0, 4, PSTR("MAC:"), 0);
		1585	z = 0;
		1586	for(uint8_t i = 0; i < 13; i++)
		1587	{
		1588	lcd_putc (z, 5, Config.bt_Mac[i],0);
		1589	if ((i%2==1)&&(i<11))
		1590	{
		1591	z++;
		1592	lcd_printp_at(z, 5, PSTR(":"),0);
		1593	}
		1594	z++;
		1595	}
		1596
		1597	while (!get_key_press (1 << KEY_ENTER));
		1598
		1599	}
		1600
		1601	if((val + offset) == 6)
		1602	{
		1603	for (uint8_t i = 0; i < RE_ID_length; i++)
		1604	{
		1605	string[i] = Config.RE_ID[i];
		1606	}
		1607	string[RE_ID_length] = 0;
		1608	Edit_String(string, RE_ID_length, 2, PSTR(" RE-ID Notiz "));
		1609	if (edit == 1)
		1610	{
		1611	for (uint8_t i = 0; i < RE_ID_length; i++)
		1612	{
		1613	Config.RE_ID[i] = EditString[i];
		1614	// WriteParameter();
		1615	}
		1616	}
		1617	}
		1618
		1619
		1620
		1621
		1622
		1623	if((val + offset) == 7)
		1624	Port_FC2CFG_BT();
		1625
		1626
		1627	}
		1628	}
		1629
		1630
		1631	void GPS_Setup (void)
		1632	{
		1633	// uint8_t ii = 0;
		1634	// uint8_t Offset = 0;
		1635	// uint8_t size = 0;
		1636
		1637	// uint8_t dmode = 0;
		1638	uint8_t target_pos = 1;
		1639	// uint8_t val;
		1640	uint8_t BT_WhasOn = 0;
		1641	uint8_t status;
		1642	// uint16_t uart_bytes;
		1643
		1644	mmode = 0;
		1645	edit = 0;
		1646	val = 0;
		1647	lcd_cls ();
		1648
		1649	while(1)
		1650	{
		1651	size = ITEMS_GPS;
		1652	lcd_cls ();
		1653	lcd_puts_at(0, 0, strGet(GPS1), 2);
		1654	lcd_puts_at(0, 7, strGet(KEYLINE1), 0);
		1655
		1656	// while(1)
		1657	// {
		1658	// ii = 0;
		1659	//
		1660	// if(Offset > 0)
		1661	// lcd_printp_at(1,1, PSTR("\x12"), 0);
		1662	//
		1663	// for(ii = 0; ii < 6; ii++)
		1664	// {
		1665	// if((ii + Offset) < size)
		1666	// lcd_printp_at(3, ii + 1, param_menuitems_GPS[ii+Offset][Config.DisplayLanguage], 0);
		1667	//
		1668	// if((ii == 5) && (ii + Offset < (size - 1)))
		1669	// lcd_printp_at(1,6, PSTR("\x13"), 0);
		1670	//
		1671	// }
		1672	//
		1673	// if(dmode == 0)
		1674	// {
		1675	// if(Offset == 0)
		1676	// {
		1677	// if(size > 6)
		1678	// val = menu_choose2 (1, 5, target_pos, 0, 1);
		1679	// else
		1680	// val = menu_choose2 (1, size, target_pos, 0, 0);
		1681	//
		1682	// }
		1683	// else
		1684	// val = menu_choose2 (2, 5, target_pos, 1, 1);
		1685	//
		1686	// }
		1687	//
		1688	// if(dmode == 1)
		1689	// {
		1690	// if(Offset + 7 > size)
		1691	// val = menu_choose2 (2, 6, target_pos, 1, 0);
		1692	// else
		1693	// val = menu_choose2 (2, 5, target_pos, 1, 1);
		1694	// }
		1695	//
		1696	// if(val == 254)
		1697	// {
		1698	// Offset++;
		1699	// dmode = 1;
		1700	// target_pos = 5;
		1701	// }
		1702	// else if(val == 253)
		1703	// {
		1704	// Offset--;
		1705	// dmode = 0;
		1706	// target_pos = 2;
		1707	// }
		1708	// else if(val == 255)
		1709	// { // Ende mit ESC, speichern
		1710	// if (edit == 1)
		1711	// {
		1712	// WriteParameter();
		1713	// if (BT_WhasOn)
		1714	// {
		1715	// set_BTOn();
		1716	//// bt_set_mode(SLAVE);
		1717	// bt_init();
		1718	// set_BTOff();
		1719	// }
		1720	//
		1721	// return;
		1722	// }
		1723	// return;
		1724	// }
		1725	// else
		1726	// break;
		1727	// }
		1728
		1729	val = menu_select(param_menuitems_GPS,size,target_pos);
		1730	if (val==255)
		1731	{
		1732	if (edit == 1)
		1733	{
		1734	// WriteParameter();
		1735	if (BT_WhasOn)
		1736	{
		1737	set_BTOn();
		1738	// bt_set_mode(SLAVE);
		1739	bt_init();
		1740	set_BTOff();
		1741	}
		1742	}
		1743	break;
		1744	}
		1745
		1746	target_pos = val;
		1747	//
		1748	// {"Suche GPS Maus ","search GPS mouse ","search GPS mouse ","search GPS mouse "},
		1749	// {"GPS Maus Typ ","GPS mouse typ ","GPS mouse typ ","GPS mouse typ "},
		1750	// {"GPS Maus aktiv? ","GPS mouse activ? ","GPS mouse activ? ","GPS mouse activ? "},
		1751	// {"Zeige GPS Device ","show GPS device ","show GPS device ","show GPS device "},
		1752	//
		1753
		1754	if((val + offset) == 1)
		1755	{
		1756	if (bt_devicecount ==0)
		1757	{
		1758	lcd_cls ();
		1759	lcd_printp_at (0, 0, PSTR("w�hle BT Device"), 0);
		1760	set_BTOn();
		1761	BT_WhasOn = true;
		1762	// _delay_ms(2000);
		1763	bt_downlink_init();
		1764	bt_searchDevice();
		1765	set_BTOff();
		1766	BT_SelectDevice();
		1767	}
		1768	else
		1769	BT_SelectDevice();
		1770	// if (edit == 1) WriteParameter();
		1771	}
		1772
		1773
		1774
		1775
		1776
		1777	if((val + offset) == 2)
		1778	{
		1779	lcd_cls ();
		1780	lcd_printp_at (0, 0, PSTR("suche BT Device"), 0);
		1781	set_BTOn();
		1782	BT_WhasOn = true;
		1783	bt_downlink_init();
		1784	bt_searchDevice();
		1785	set_BTOff();
		1786	BT_SelectDevice();
		1787	}
		1788
		1789
		1790	if((val + offset) == 3)
		1791	{
		1792	Config.gps_UsedGPSMouse = Edit_generic(Config.gps_UsedGPSMouse,0,1,GPS_MOUSETYP,GPSMOUSE);
		1793	if (edit == 1) {
		1794	// WriteParameter();
		1795	edit = 0;
		1796	}
		1797
		1798	}
		1799
		1800
		1801
		1802	if((val + offset) == 4)
		1803	{
		1804	Config.gps_UseGPS = Edit_generic(Config.gps_UseGPS,0,1,GPS3,YesNo);
		1805	if (edit == 1) {
		1806	// WriteParameter();
		1807	edit = 0;
		1808	}
		1809	}
		1810
		1811	if((val + offset) == 5)
		1812	{
		1813	lcd_cls ();
		1814	lcd_puts_at(0, 0, strGet(GPS2), 2);
		1815	lcd_puts_at(18, 7, strGet(OK), 0);
		1816	lcd_printp_at (0, 1, PSTR("Device:"), 0);
		1817	lcd_printp_at (0, 4, PSTR("MAC:"), 0);
		1818
		1819	lcd_puts_at (0, 2,Config.gps_UsedDevName, 0);
		1820
		1821	for(uint8_t i = 0; i < 12; i++)
		1822	{
		1823	lcd_putc (i, 5, Config.gps_UsedMac[i],0);
		1824	}
		1825
		1826	while (!get_key_press (1 << KEY_ENTER));
		1827
		1828	}
		1829
		1830
		1831	if((val + offset) == 6)
		1832	{
		1833	get_key_press(KEY_ALL);
		1834	lcd_cls ();
		1835	lcd_puts_at(18, 7, strGet(OK), 0);
		1836	lcd_puts_at (0, 0,Config.gps_UsedDevName, 2);
		1837	set_BTOn();
		1838	BT_WhasOn = true;
		1839	if (Config.BTIsSlave==true)
		1840	{
		1841	bt_downlink_init();
		1842	}
		1843	lcd_printp_at (0, 1, PSTR("try to connect"), 0);
		1844	status = bt_connect(Config.gps_UsedMac);
		1845
		1846	lcd_printp_at (0, 2, PSTR("connect status"), 0);
		1847	write_ndigit_number_u (14, 2, status, 2, 0,0);
		1848
		1849
		1850
		1851
		1852	if (status==true)
		1853	{
		1854	lcd_printp_at (0, 1, PSTR("connected "), 0);
		1855	receiveNMEA = true;
		1856	}
		1857	else
		1858	{
		1859	lcd_printp_at (0, 2, PSTR("connect Error"), 0);
		1860	write_ndigit_number_u (14, 2, status, 2, 0,0);
		1861
		1862	}
		1863	//---OG:BEGIN---
		1864	if (receiveNMEA==true)
		1865	{
		1866	lcd_cls();
		1867
		1868	// BT-Device Name
		1869	lcd_puts_at(0, 0,Config.gps_UsedDevName, 2);
		1870
		1871	// Labels
		1872	lcd_printp_at( 0, 1, PSTR("Sat: "), 0);
		1873	lcd_printp_at(11, 1, PSTR("XErr: "), 0);
		1874
		1875	lcd_printp_at( 0, 2, PSTR("Fix: "), 0);
		1876	lcd_printp_at(11, 2, PSTR("HDOP: "), 0);
		1877
		1878	lcd_printp_at( 0, 3, PSTR(" Latitude Longitude"), 2);
		1879
		1880	lcd_printp_at( 0, 6, PSTR("Alt: "), 0);
		1881
		1882	// Bottom-Line: OK
		1883	lcd_puts_at(18, 7, strGet(OK), 0);
		1884
		1885	bt_rx_ready = 0;
		1886	do
		1887	{
		1888	CheckGPS = true;
		1889	if (!bt_receiveNMEA()){ receiveNMEA = false; break;}
		1890
		1891	Tracking_NMEA();
		1892
		1893	//---------------------------------------------------------------------
		1894
		1895	// Line 1 L: Sat-Anzahl
		1896	write_ndigit_number_u (5, 1, NMEAsatsInUse, 2, 0,0);
		1897
		1898	// Line 1 R: BT RX Error's
		1899	write_ndigit_number_u (17, 1, bt_rxerror, 4, 0,0);
		1900
		1901	//---------------------------------------------------------------------
		1902
		1903	// Line 2 L: Fix
		1904	write_ndigit_number_u (5, 2, posfix, 2, 0,0);
		1905
		1906	// Line 2 R: HDOP
		1907	if( HDOP == 0 )
		1908	lcd_printp_at(16, 2, PSTR(" ---"), 0);
		1909	else
		1910	write_ndigit_number_u_10th (16, 2, HDOP, 4, 0,0);
		1911
		1912	//---------------------------------------------------------------------
		1913
		1914	// Line 4 L: Latitude
		1915	write_ndigit_number_u (1, 4, (uint16_t)(NMEAlatitude/10000000), 2, 0,0);
		1916	lcd_printp_at (3, 4, PSTR("."), 0);
		1917	write_ndigit_number_u (4, 4, (uint16_t)((NMEAlatitude/1000) % 10000), 4, 1,0);
		1918	write_ndigit_number_u (8, 4, (uint16_t)((NMEAlatitude/10) % 100), 2, 1,0);
		1919
		1920	// Line 4 R: Longitude
		1921	write_ndigit_number_u (12, 4, (uint16_t)(NMEAlongitude/10000000), 2, 0,0);
		1922	lcd_printp_at (14, 4, PSTR("."), 0);
		1923	write_ndigit_number_u (15, 4, (uint16_t)((NMEAlongitude/1000) % 10000), 4, 1,0);
		1924	write_ndigit_number_u (19, 4, (uint16_t)((NMEAlongitude/10) % 100), 2, 1,0);
		1925
		1926	//---------------------------------------------------------------------
		1927
		1928	// Line 6 L: Altitude
		1929	write_ndigit_number_u_10th (5, 6, NMEAaltitude, 5, 0,0);
		1930	lcd_printp_at (11, 6, PSTR("m"), 0);
		1931
		1932	// Line 6 R: GPS Time
		1933	lcd_puts_at (13, 6, NMEAtime, 0);
		1934
		1935	//---------------------------------------------------------------------
		1936
		1937	} while (!get_key_press (1 << KEY_ENTER) \|\| !receiveNMEA==true);
		1938
		1939	CheckGPS = false;
		1940
		1941	lcd_cls();
		1942
		1943	if (!receiveNMEA) {
		1944	lcd_printp_at (0, 1, PSTR("lost BT data"), 0);
		1945	set_beep ( 400, 0x0080, BeepNormal);
		1946	}
		1947	lcd_printp_at (0, 3, PSTR("GPS trennen"), 0);
		1948	lcd_printp_at (0, 4, PSTR("bitte warten..."), 0);
		1949	}
		1950	else
		1951	{
		1952	lcd_printp_at (0, 3, PSTR("Error connecting!"), 0);
		1953	while (!get_key_press (1 << KEY_ENTER));
		1954	}
		1955	receiveNMEA = false;
		1956	CheckGPS = false;
		1957	if (!bt_disconnect()) lcd_printp_at (0, 3, PSTR("Error disconnecting!"), 0);
		1958	//---OG:END---
		1959
		1960	// if (receiveNMEA==true)
		1961	// {
		1962	// lcd_printp_at (0, 3, PSTR(" Latitude Longitude"), 2);
		1963	// bt_rx_ready = 0;
		1964	// do
		1965	// {
		1966	// CheckGPS = true;
		1967	// if (!bt_receiveNMEA()){ receiveNMEA = false; break;}
		1968	//
		1969	//
		1970	// Tracking_NMEA();
		1971	//
		1972	//
		1973	// write_ndigit_number_u (1, 4, (uint16_t)(NMEAlatitude/10000000), 2, 0,0);
		1974	// lcd_printp_at (3, 4, PSTR("."), 0);
		1975	// write_ndigit_number_u (4, 4, (uint16_t)((NMEAlatitude/1000) % 10000), 4, 1,0);
		1976	// write_ndigit_number_u (8, 4, (uint16_t)((NMEAlatitude/10) % 100), 2, 1,0);
		1977	//
		1978	//
		1979	// write_ndigit_number_u (12, 4, (uint16_t)(NMEAlongitude/10000000), 2, 0,0);
		1980	// lcd_printp_at (14, 4, PSTR("."), 0);
		1981	// write_ndigit_number_u (15, 4, (uint16_t)((NMEAlongitude/1000) % 10000), 4, 1,0);
		1982	// write_ndigit_number_u (19, 4, (uint16_t)((NMEAlongitude/10) % 100), 2, 1,0);
		1983	// lcd_printp_at (0, 2, PSTR("GPS Time: "), 0);
		1984	// lcd_puts_at (10, 2, NMEAtime, 0);
		1985	// lcd_printp_at (0, 6, PSTR("Satellite: "), 0);
		1986	// write_ndigit_number_u (11, 6, NMEAsatsInUse, 2, 1,0);
		1987	// lcd_printp_at (0, 5, PSTR("Fix: "), 0);
		1988	// write_ndigit_number_u (5, 5, posfix, 1, 1,0);
		1989	// lcd_printp_at (8, 5, PSTR("HDOP: "), 0);
		1990	// write_ndigit_number_u_10th (14, 5, HDOP, 4, 0,0);
		1991	// lcd_printp_at (0, 7, PSTR("Alitude: "), 0);
		1992	// write_ndigit_number_u_10th (9, 7, NMEAaltitude, 5, 0,0);
		1993	// lcd_printp_at (15, 7, PSTR("m"), 0);
		1994	// lcd_printp_at (0, 1, PSTR(" BT RX Error: "), 0);
		1995	// write_ndigit_number_u (13, 1, bt_rxerror, 3, 1,0);
		1996	//// write_ndigit_number_u (13, 1, UART1_RxError, 5, 1,0);
		1997	//
		1998	//// uart_bytes = uart1_available();
		1999	//// lcd_printp_at (0, 1, PSTR(" UartAvail: "), 0);
		2000	//// write_ndigit_number_u (13, 1,uart_bytes , 4, 1,0);
		2001	// }
		2002	//
		2003	//
		2004	// while (!get_key_press (1 << KEY_ENTER) \|\| !receiveNMEA==true);
		2005	//
		2006	// CheckGPS = false;
		2007	// lcd_cls_line(0,1,21);
		2008	// lcd_cls_line(0,2,21);
		2009	// lcd_cls_line(0,3,21);
		2010	// lcd_cls_line(0,4,21);
		2011	// lcd_cls_line(0,5,21);
		2012	// lcd_cls_line(0,6,21);
		2013	// lcd_cls_line(0,7,21);
		2014	// if (!receiveNMEA) lcd_printp_at (0, 2, PSTR("lost BT data"), 0);
		2015	// lcd_printp_at (0, 3, PSTR("GPS trennen"), 0);
		2016	// lcd_printp_at (0, 4, PSTR("bitte warten"), 0);
		2017	// }
		2018	// else
		2019	// {
		2020	// lcd_printp_at (0, 4, PSTR("Error at connecting"), 0);
		2021	// while (!get_key_press (1 << KEY_ENTER));
		2022	// }
		2023	// receiveNMEA = false;
		2024	// CheckGPS = false;
		2025	// if (!bt_disconnect()) lcd_printp_at (0, 3, PSTR("Fehler beim Trennen"), 0);
		2026
		2027	set_BTOff();
		2028
		2029	}
		2030
		2031
		2032	}
		2033	}
		2034
		2035
		2036
		2037
		2038	//--------------------------------------------------------------
		2039	uint8_t Edit_PKT_Accu(uint8_t Value, uint8_t min, uint8_t max)
		2040	{
		2041	Pre = Value;
		2042	lcd_cls();
		2043	// lcd_printp_at (0, 2, Text, 0);
		2044	lcd_puts_at(0, 2, strGet(LIPO2), 0);
		2045	switch (Value)
		2046	{
		2047	case false :lcd_printp_at (15, 2, PSTR("LiIo"), 0);
		2048	break;
		2049	case true :lcd_printp_at (15, 2, PSTR("LiPo"), 0);
		2050	break;
		2051	break;
		2052	}
		2053
		2054	lcd_puts_at(0, 7, strGet(KEYLINE2), 0);
		2055
		2056	do
		2057	{
		2058	if ((get_key_press (1 << KEY_PLUS)) && (Value == 0))
		2059	{
		2060	Value = 1;
		2061	lcd_printp_at (15, 2, PSTR("LiPo"), 0);
		2062	}
		2063
		2064	if ((get_key_press (1 << KEY_MINUS)) && (Value == 1))
		2065	{
		2066	Value = 0;
		2067	lcd_printp_at (15, 2, PSTR("LiIo"), 0);
		2068	}
		2069
		2070	if (get_key_press (1 << KEY_ENTER))
		2071	{
		2072	edit = 1;
		2073
		2074	Config.PKT_Accutyp = Value;
		2075
		2076
		2077	return Value;
		2078	}
		2079	}
		2080
		2081	while (!get_key_press (1 << KEY_ESC));
		2082	{
		2083	get_key_press(KEY_ALL);
		2084	edit = 0;
		2085	Config.PKT_Accutyp = Pre;
		2086	return Pre;
		2087	}
		2088
		2089	}
		2090
		2091	//--------------------------------------------------------------
		2092	uint16_t Edit_LipoOffset(uint16_t Value, uint16_t min, uint16_t max)
		2093	{
		2094	lcd_cls();
		2095	lcd_puts_at(0, 2, strGet(LIPO3), 0);
		2096	lcd_puts_at(0, 5, strGet(LIPO5), 0);
		2097	lcd_puts_at(0, 6, strGet(LIPO6), 0);
		2098	Pre16 = Value;
		2099	write_ndigit_number_u (16, 2, Value, 4, 0,0);
		2100	lcd_puts_at(0, 7, strGet(KEYLINE2), 0);
		2101
		2102	do
		2103	{
		2104	if ((get_key_press (1 << KEY_PLUS) \|\| get_key_long_rpt_sp ((1 << KEY_PLUS), 2)) && (Value < max-10))
		2105	{
		2106	edit = 1;
		2107	Value = Value +10;
		2108	Config.Lipo_UOffset = Value;
		2109	write_ndigit_number_u (16, 2,Value, 4, 0,0);
		2110
		2111	}
		2112
		2113	if ((get_key_press (1 << KEY_MINUS) \|\| get_key_long_rpt_sp ((1 << KEY_MINUS), 2)) && (Value > min))
		2114	{
		2115	edit = 1;
		2116	Value=Value -10;
		2117	Config.Lipo_UOffset = Value;
		2118	write_ndigit_number_u (16, 2,Value, 4, 0,0);
		2119	}
		2120
		2121	if (get_key_press (1 << KEY_ENTER))
		2122	return Value;
		2123	show_Lipo();
		2124	write_ndigit_number_u_100th(8, 3, volt_avg, 0, 0);
		2125	lcd_printp_at(3, 3, PSTR("Volt"), 0);
		2126
		2127	}
		2128	while (!get_key_press (1 << KEY_ESC));
		2129	{
		2130	get_key_press(KEY_ALL);
		2131	edit = 0;
		2132	Config.Lipo_UOffset = Pre16;
		2133	return Pre16;
		2134	}
		2135	}
		2136
		2137	//--------------------------------------------------------------
		2138	void Accu_Setup (void)
		2139	{
		2140	// uint8_t ii = 0;
		2141	// uint8_t Offset = 0;
		2142	// uint8_t size = 0;
		2143
		2144	// uint8_t dmode = 0;
		2145	uint8_t target_pos = 1;
		2146	// uint8_t val;
		2147
		2148	mmode = 0;
		2149	edit = 0;
		2150	val = 0;
		2151	lcd_cls ();
		2152
		2153	while(1)
		2154	{
		2155	size = ITEMS_Accu;
		2156	lcd_cls ();
		2157	lcd_puts_at(0, 0, strGet(LIPO1), 2);
		2158	lcd_puts_at(0, 7, strGet(KEYLINE1), 0);
		2159
		2160	// while(1)
		2161	// {
		2162	// ii = 0;
		2163	//
		2164	// if(Offset > 0)
		2165	// lcd_printp_at(1,1, PSTR("\x12"), 0);
		2166	//
		2167	// for(ii = 0; ii < 6; ii++)
		2168	// {
		2169	// if((ii + Offset) < size)
		2170	// lcd_printp_at(3, ii + 1, param_menuitems_Accu[ii+Offset][Config.DisplayLanguage], 0);
		2171	//
		2172	// if((ii == 5) && (ii + Offset < (size - 1)))
		2173	// lcd_printp_at(1,6, PSTR("\x13"), 0);
		2174	//
		2175	// }
		2176	//
		2177	// if(dmode == 0)
		2178	// {
		2179	// if(Offset == 0)
		2180	// {
		2181	// if(size > 6)
		2182	// val = menu_choose2 (1, 5, target_pos, 0, 1);
		2183	// else
		2184	// val = menu_choose2 (1, size, target_pos, 0, 0);
		2185	//
		2186	// }
		2187	// else
		2188	// val = menu_choose2 (2, 5, target_pos, 1, 1);
		2189	//
		2190	// }
		2191	//
		2192	// if(dmode == 1)
		2193	// {
		2194	// if(Offset + 7 > size)
		2195	// val = menu_choose2 (2, 6, target_pos, 1, 0);
		2196	// else
		2197	// val = menu_choose2 (2, 5, target_pos, 1, 1);
		2198	// }
		2199	//
		2200	// if(val == 254)
		2201	// {
		2202	// Offset++;
		2203	// dmode = 1;
		2204	// target_pos = 5;
		2205	// }
		2206	// else if(val == 253)
		2207	// {
		2208	// Offset--;
		2209	// dmode = 0;
		2210	// target_pos = 2;
		2211	// }
		2212	// else if(val == 255)
		2213	// { // Ende mit ESC, speichern
		2214	// if (edit == 1)
		2215	// {
		2216	// WriteParameter();
		2217	// edit = 0;
		2218	// return;
		2219	// }
		2220	// return;
		2221	// }
		2222	// else
		2223	// break;
		2224	// }
		2225	val = menu_select(param_menuitems_Accu,size,target_pos);
		2226	if (val==255) break;
		2227	target_pos = val;
		2228	if((val + offset) == 1)
		2229	{
		2230	Config.PKT_Accutyp= Edit_PKT_Accu(Config.PKT_Accutyp,0,1);
		2231	if (edit == 1) {
		2232	// WriteParameter();
		2233	edit = 0;
		2234	}
		2235	}
		2236
		2237	if((val + offset) == 2)
		2238	{
		2239	Config.Lipo_UOffset = Edit_LipoOffset(Config.Lipo_UOffset,0,9999);
		2240	if (edit == 1) {
		2241	// WriteParameter();
		2242	edit = 0;
		2243	}
		2244	}
		2245
		2246	}
		2247	}
		2248
		2249
		2250	//--------------------------------------------------------------
		2251	uint8_t Edit_LED_Form (uint8_t Value, uint8_t min, uint8_t max, uint8_t Text)
		2252	{
		2253	Pre = Value;
		2254	lcd_cls();
		2255	lcd_puts_at(0, 2, strGet(Text), 0);
		2256
		2257	switch (Value)
		2258	{
		2259	case 0x1:
		2260	lcd_circle (14 * 6 + 5, 2 * 8 + 3, 3, 1); // kreis
		2261
		2262	lcd_fcircle (16 * 6 + 5, 2 * 8 + 3, 3, 0); // l�schen
		2263	lcd_circle (16 * 6 + 5, 2 * 8 + 3, 3, 1); // kreis
		2264	lcd_fcircle (16 * 6 + 5, 2 * 8 + 3, 1, 1); // plus
		2265	break;
		2266	case 0x3 :
		2267	lcd_circle (14 * 6 + 5, 2 * 8 + 3, 3, 1); // kreis
		2268
		2269	lcd_fcircle (16 * 6 + 5, 2 * 8 + 3, 3, 1); // schwarz
		2270	break;
		2271	break;
		2272	}
		2273
		2274	lcd_puts_at(0, 7, strGet(KEYLINE2), 0);
		2275
		2276	do
		2277	{
		2278	if ((get_key_press (1 << KEY_PLUS)) && (Value == 1))
		2279	{
		2280	Value = 3;
		2281	lcd_circle (14 * 6 + 5, 2 * 8 + 3, 3, 1); // kreis
		2282
		2283	lcd_fcircle (16 * 6 + 5, 2 * 8 + 3, 3, 1); // schwarz
		2284	}
		2285
		2286	if ((get_key_press (1 << KEY_MINUS)) && (Value == 3))
		2287	{
		2288	Value = 1;
		2289	lcd_circle (14 * 6 + 5, 2 * 8 + 3, 3, 1); // kreis
		2290
		2291	lcd_fcircle (16 * 6 + 5, 2 * 8 + 3, 3, 0); // l�schen
		2292	lcd_circle (16 * 6 + 5, 2 * 8 + 3, 3, 1); // kreis
		2293	lcd_fcircle (16 * 6 + 5, 2 * 8 + 3, 1, 1); // plus
		2294	}
		2295
		2296	if (get_key_press (1 << KEY_ENTER))
		2297	{
		2298	edit = 1;
		2299	Config.OSD_LEDform = Value;
		2300	// WriteParameter();
		2301	edit = 0;
		2302	return Value;
		2303	}
		2304	}
		2305
		2306	while (!get_key_press (1 << KEY_ESC));
		2307	{
		2308	get_key_press(KEY_ALL);
		2309	edit = 0;
		2310	Config.OSD_LEDform = Pre;
		2311	return Pre;
		2312	}
		2313	}
		2314
		2315
		2316	//--------------------------------------------------------------
		2317	void OSD_Setup (void)
		2318	{
		2319	// uint8_t ii = 0;
		2320	// uint8_t Offset = 0;
		2321	// uint8_t size = 0;
		2322
		2323	// uint8_t dmode = 0;
		2324	uint8_t target_pos = 1;
		2325	// uint8_t val;
		2326
		2327	mmode = 0;
		2328	edit = 0;
		2329	val = 0;
		2330	lcd_cls ();
		2331
		2332	while(1)
		2333	{
		2334	size = ITEMS_OSD;
		2335	lcd_cls ();
		2336	lcd_puts_at(0, 0, strGet(OSD_Screen), 2);
		2337	lcd_puts_at(0, 7, strGet(KEYLINE1), 0);
		2338
		2339	// while(1)
		2340	// {
		2341	// ii = 0;
		2342	//
		2343	// if(Offset > 0)
		2344	// lcd_printp_at(1,1, PSTR("\x12"), 0);
		2345	//
		2346	// for(ii = 0; ii < 6; ii++)
		2347	// {
		2348	// if((ii + Offset) < size)
		2349	// lcd_printp_at(3, ii + 1, param_menuitems_OSD[ii+Offset][Config.DisplayLanguage], 0);
		2350	//
		2351	// if((ii == 5) && (ii + Offset < (size - 1)))
		2352	// lcd_printp_at(1,6, PSTR("\x13"), 0);
		2353	//
		2354	// }
		2355	//
		2356	// if(dmode == 0)
		2357	// {
		2358	// if(Offset == 0)
		2359	// {
		2360	// if(size > 6)
		2361	// val = menu_choose2 (1, 5, target_pos, 0, 1);
		2362	// else
		2363	// val = menu_choose2 (1, size, target_pos, 0, 0);
		2364	//
		2365	// }
		2366	// else
		2367	// val = menu_choose2 (2, 5, target_pos, 1, 1);
		2368	//
		2369	// }
		2370	//
		2371	// if(dmode == 1)
		2372	// {
		2373	// if(Offset + 7 > size)
		2374	// val = menu_choose2 (2, 6, target_pos, 1, 0);
		2375	// else
		2376	// val = menu_choose2 (2, 5, target_pos, 1, 1);
		2377	// }
		2378	//
		2379	// if(val == 254)
		2380	// {
		2381	// Offset++;
		2382	// dmode = 1;
		2383	// target_pos = 5;
		2384	// }
		2385	// else if(val == 253)
		2386	// {
		2387	// Offset--;
		2388	// dmode = 0;
		2389	// target_pos = 2;
		2390	// }
		2391	// else if(val == 255)
		2392	// { // Ende mit ESC, speichern
		2393	// if (edit == 1)
		2394	// {
		2395	// WriteParameter();
		2396	// edit = 0;
		2397	// return;
		2398	// }
		2399	// return;
		2400	// }
		2401	// else
		2402	// break;
		2403	// }
		2404	val = menu_select(param_menuitems_OSD,size,target_pos);
		2405	if (val==255) break;
		2406	target_pos = val;
		2407	//4.3.13 CB if((val + Offset) == 1) Config.OSD_ScreenMode = Edit_generic(Config.OSD_ScreenMode, 0, OSD_MaxScreen, OSD_SCREENMODE,Show_uint);
		2408	if((val + offset) == 1) Config.OSD_LEDform = Edit_LED_Form(Config.OSD_LEDform, 1, 3, OSD_LED_Form);
		2409	if((val + offset) == 2) Config.OSD_InvertOut = Edit_generic(Config.OSD_InvertOut, 0, 1, OSD_Invert_Out,YesNo);
		2410	if((val + offset) == 3) Config.OSD_SendOSD = Edit_generic(Config.OSD_SendOSD, 0, 1,OSD_Send_OSD ,YesNo);
		2411	if((val + offset) == 4) Config.OSD_Fallspeed = Edit_generic(Config.OSD_Fallspeed,0,247,FALLSPEED,Show_uint10th);
		2412	if((val + offset) == 5) Config.OSD_VarioBeep = Edit_generic(Config.OSD_VarioBeep,0,1,OSD_VARIOBEEP,YesNo);
		2413	if((val + offset) == 6) Config.OSD_HomeMKView = Edit_generic(Config.OSD_HomeMKView,0,1,OSD_HOMEMKVIEW,YesNo);
		2414	if((val + offset) == 7) Config.MK_LowBat = Edit_generic(Config.MK_LowBat,32,247,LOWBAT,Show_uint10th);
		2415	if((val + offset) == 8) Config.OSD_mAh_Warning = Edit_generic(Config.OSD_mAh_Warning,0,30000,OSD_MAHWARNING, Show_uint5);
		2416	if((val + offset) == 9)Config.OSD_LipoBar = Edit_generic(Config.OSD_LipoBar, 0, 1, OSD_LIPOBAR,YesNo);
		2417
		2418
		2419	}
		2420	}
		2421	//--------------------------------------------------------------
		2422	void FollowMe_Setup (void)
		2423	{
		2424	// uint8_t ii = 0;
		2425	// uint8_t Offset = 0;
		2426	// uint8_t size = 0;
		2427	// uint8_t dmode = 0;
		2428	uint8_t target_pos = 1;
		2429	// uint8_t val;
		2430
		2431	mmode = 0;
		2432	edit = 0;
		2433	val = 0;
		2434	lcd_cls ();
		2435
		2436	while(1)
		2437	{
		2438	size = ITEMS_FOLLOWME;
		2439	lcd_cls ();
		2440	lcd_puts_at(0, 0, strGet(FOLLOWME_0), 2);
		2441	lcd_puts_at(0, 7, strGet(KEYLINE1), 0);
		2442
		2443	// while(1)
		2444	// {
		2445	// ii = 0;
		2446	//
		2447	// if(Offset > 0)
		2448	// lcd_printp_at(1,1, PSTR("\x12"), 0);
		2449	//
		2450	// for(ii = 0; ii < 6; ii++)
		2451	// {
		2452	// if((ii + Offset) < size)
		2453	// lcd_printp_at(3, ii + 1, param_menuitems_FOLLOWME[ii+Offset][Config.DisplayLanguage], 0);
		2454	//
		2455	// if((ii == 5) && (ii + Offset < (size - 1)))
		2456	// lcd_printp_at(1,6, PSTR("\x13"), 0);
		2457	//
		2458	// }
		2459	//
		2460	// if(dmode == 0)
		2461	// {
		2462	// if(Offset == 0)
		2463	// {
		2464	// if(size > 6)
		2465	// val = menu_choose2 (1, 5, target_pos, 0, 1);
		2466	// else
		2467	// val = menu_choose2 (1, size, target_pos, 0, 0);
		2468	//
		2469	// }
		2470	// else
		2471	// val = menu_choose2 (2, 5, target_pos, 1, 1);
		2472	//
		2473	// }
		2474	//
		2475	// if(dmode == 1)
		2476	// {
		2477	// if(Offset + 7 > size)
		2478	// val = menu_choose2 (2, 6, target_pos, 1, 0);
		2479	// else
		2480	// val = menu_choose2 (2, 5, target_pos, 1, 1);
		2481	// }
		2482	//
		2483	// if(val == 254)
		2484	// {
		2485	// Offset++;
		2486	// dmode = 1;
		2487	// target_pos = 5;
		2488	// }
		2489	// else if(val == 253)
		2490	// {
		2491	// Offset--;
		2492	// dmode = 0;
		2493	// target_pos = 2;
		2494	// }
		2495	// else if(val == 255)
		2496	// { // Ende mit ESC, speichern
		2497	// if (edit == 1)
		2498	// {
		2499	// WriteParameter();
		2500	// edit = 0;
		2501	// return;
		2502	// }
		2503	// return;
		2504	// }
		2505	// else
		2506	// break;
		2507	// }
		2508	val = menu_select(param_menuitems_FOLLOWME,size,target_pos);
		2509	if (val==255) break;
		2510	target_pos = val;
		2511	if((val + offset) == 1) Config.FM_Refresh = Edit_generic(Config.FM_Refresh, 250, 60000, FOLLOWME_1, Show_uint3);
		2512	if((val + offset) == 2) Config.FM_Speed = Edit_generic(Config.FM_Speed, 0, 100, FOLLOWME_2, Show_uint3);
		2513	if((val + offset) == 3) Config.FM_Radius = Edit_generic(Config.FM_Radius, 1,20, FOLLOWME_3, Show_uint3);
		2514
		2515	}
		2516	}
		2517
		2518

Subversion Repositories Projects

(root)/Transportables_Koptertool/branch/PKT/branch/GPL_PKT_V3_6_7f_FC090b/setup/setup.c - Rev 1932