WebSVN - Projects - Blame - Rev 741 - /C-OSD/trunk/C-OSD AGRESSiVA mod/config.c

Rev	Author	Line No.	Line
741	agressiva	1	/****************************************************************************
		2	* Copyright (C) 2009-2010 by Claas Anders "CaScAdE" Rathje *
		3	* admiralcascade@gmail.com *
		4	* Project-URL: http://www.mylifesucks.de/oss/c-osd/ *
		5	* *
		6	* This program is free software; you can redistribute it and/or modify *
		7	* it under the terms of the GNU General Public License as published by *
		8	* the Free Software Foundation; either version 2 of the License. *
		9	* *
		10	* This program is distributed in the hope that it will be useful, *
		11	* but WITHOUT ANY WARRANTY; without even the implied warranty of *
		12	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
		13	* GNU General Public License for more details. *
		14	* *
		15	* You should have received a copy of the GNU General Public License *
		16	* along with this program; if not, write to the *
		17	* Free Software Foundation, Inc., *
		18	* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
		19	****************************************************************************/
		20
		21	#include <avr/io.h>
		22	#include <avr/eeprom.h>
		23	#include <avr/pgmspace.h>
		24	#include <avr/interrupt.h>
		25	#include <util/delay.h>
		26	#include "max7456_software_spi.h"
		27	#include "config.h"
		28	#include "main.h"
		29	#include "buttons.h"
		30	#include "usart1.h"
		31
		32	uint8_t EEMEM ee_checkbyte1 = CHECKBYTE1;
		33	uint8_t EEMEM ee_checkbyte2 = CHECKBYTE2;
		34	uint8_t EEMEM ee_COSD_FLAGS_MODES = 0;
		35	uint8_t EEMEM ee_COSD_FLAGS_CONFIG = 0;
		36	uint8_t EEMEM ee_COSD_DISPLAYMODE = 0;
		37
		38	#if !(ALLCHARSDEBUG\|(WRITECHARS != -1))
		39
		40	// video modes
		41	const char VM_PAL[] PROGMEM = "PAL ";
		42	const char VM_NTSC[] PROGMEM = "NTSC";
		43
		44
		45	const displaymode_t * mode;
		46
		47	#endif
		48
		49	const char ee_message0[] PROGMEM = "Loading Data from EEPROM";
		50	const char ee_message1[] PROGMEM = "No saved Data in EEPROM";
		51	const char* ee_msg[] PROGMEM = {ee_message0, ee_message1};
		52
		53	/**
		54	* read data saved in eeprom, print out message if <verbose> is set
		55	*/
		56	void get_eeprom(uint8_t verbose) {
		57	if (eeprom_read_byte(&ee_checkbyte1) == CHECKBYTE1 && eeprom_read_byte(&ee_checkbyte2) == CHECKBYTE2) {
		58	#if !(ALLCHARSDEBUG\|(WRITECHARS != -1))
		59	if (verbose) write_ascii_string_pgm(2, 9, ee_msg[0]); // Loading data
		60	#endif
		61	COSD_FLAGS_MODES = eeprom_read_byte(&ee_COSD_FLAGS_MODES);
		62	COSD_FLAGS_CONFIG = eeprom_read_byte(&ee_COSD_FLAGS_CONFIG);
		63	COSD_DISPLAYMODE = eeprom_read_byte(&ee_COSD_DISPLAYMODE);
		64	//if (verbose) write_ndigit_number_u(23, 11, COSD_DISPLAYMODE, 2, 0);
		65	} else {
		66	#if !(ALLCHARSDEBUG\|(WRITECHARS != -1))
		67	if (verbose) write_ascii_string_pgm(2, 9, ee_msg[1]); // Loading data
		68	#endif
		69	}
		70	}
		71
		72	#if !(ALLCHARSDEBUG\|(WRITECHARS != -1))
		73
		74	/**
		75	* save data to eeprom
		76	*/
		77	void save_eeprom() {
		78	eeprom_write_byte(&ee_checkbyte1, CHECKBYTE1);
		79	eeprom_write_byte(&ee_checkbyte2, CHECKBYTE2);
		80	eeprom_write_byte(&ee_COSD_FLAGS_MODES, COSD_FLAGS_MODES);
		81	eeprom_write_byte(&ee_COSD_FLAGS_CONFIG, COSD_FLAGS_CONFIG);
		82	eeprom_write_byte(&ee_COSD_DISPLAYMODE, COSD_DISPLAYMODE);
		83	}
		84
		85	/**
		86	* auto config some stuff on startup, currently only battery cells
		87	* TODO: this is testing stuff, strings should go progmem and so on...
		88	*/
		89	void init_cosd(uint8_t UBat) {
		90	clear();
		91	write_ascii_string_pgm(2, 1, PSTR("C-OSD AGRESSiVA MOD")); // C-OSD Initialisation
		92	#if FCONLY
		93	write_ascii_string_pgm(2, 2, PSTR("FC only Mode")); // FC only mode
		94	#else
		95	write_ascii_string_pgm(2, 2, PSTR("NaviCtrl Mode")); // NaviCtrl Mode
		96	#endif
		97	write_ascii_string_pgm(2, 3, PSTR(BUILDDATE));
		98	uint8_t cellnum = 0;
		99	if (CELL_NUM == -1) {
		100	write_ascii_string_pgm(2, 4, PSTR("Guessing Number of Cells")); // Guessing Number of Cells
		101	do {
		102	cellnum++;
		103	} while (UBat > ((cellnum * CELL_VOLT_MAX) + 23));
		104	} else {
		105	cellnum = CELL_NUM;
		106	}
		107	min_voltage = cellnum * CELL_VOLT_MIN;
		108	max_voltage = cellnum * CELL_VOLT_MAX;
		109	write_ascii_string_pgm(2, 5, PSTR("Number of Cells:")); // Number of Cells
		110	write_ndigit_number_u(21, 5, cellnum, 1, 0);
		111	write_ascii_string_pgm(2, 6, PSTR("Warn Voltage :")); // Warn Voltage
		112	write_ndigit_number_s_10th(20, 6, min_voltage, 3, 0);
		113	write_ascii_string_pgm(2, 7, PSTR("Max Voltage :")); // Max Voltage
		114	write_ndigit_number_s_10th(20, 7, max_voltage, 3, 0);
		115
		116	get_eeprom(1);
		117
		118	//write_ascii_string_pgm(23, 2, vm[COSD_FLAGS & COSD_FLAG_NTSC]);
		119	if (COSD_FLAGS_CONFIG & COSD_FLAG_NTSC) {
		120	write_ascii_string_pgm(23, 2, VM_NTSC);
		121	} else {
		122	write_ascii_string_pgm(23, 2, VM_PAL);
		123	}
		124
		125	// request version from board
		126	rxd_buffer_locked = 0;
		127	usart1_EnableTXD();
		128	#if FCONLY
		129	//usart1_request_mk_data(0, 'v', 0);
		130	write_ascii_string_pgm(2, 11, PSTR("FC VERSION: ........"));
		131	usart1_puts_pgm(PSTR(REQUEST_FC_VERSION));
		132	#else
		133	//usart1_request_mk_data(1, 'v', 0);
		134	usart1_puts_pgm(PSTR(REQUEST_NC_VERSION));
		135	write_ascii_string_pgm(2, 11, PSTR("NC VERSION: ........"));
		136	#endif
		137	usart1_DisableTXD();
		138	// wait for response
		139	while (rxd_buffer_locked == 0) {
		140	asm("nop");
		141	}
		142	Decode64();
		143	str_VersionInfo VersionInfo;
		144	VersionInfo = ((str_VersionInfo) pRxData);
		145
		146	write_ndigit_number_u(14, 11, VersionInfo.SWMajor, 3, 1);
		147	write_ndigit_number_u(18, 11, VersionInfo.SWMinor, 3, 1);
		148	write_ascii_char(22 + 11*30, 'a' + VersionInfo.SWPatch);
		149	// end version request
		150
		151
		152	#if FCONLY
		153	COSD_DISPLAYMODE %= (sizeof(fcdisplaymodes) / sizeof(displaymode_t));
		154	mode = fcdisplaymodes;
		155	mode += COSD_DISPLAYMODE;
		156	osd_fcmode = (int(*)(void)) pgm_read_word(&mode->dfun);
		157	// re-request data ever 100ms from FC;
		158	//usart1_request_mk_data(0, 'd', 100);
		159	#else
		160	COSD_DISPLAYMODE %= (sizeof(ncdisplaymodes) / sizeof(displaymode_t));
		161	mode = ncdisplaymodes;
		162	mode += COSD_DISPLAYMODE;
		163	osd_ncmode = (int(*)(void)) pgm_read_word(&mode->dfun);
		164	// re-request OSD Data from NC every 100ms
		165	//usart1_request_mk_data(1, 'o', 100);
		166	#endif
		167
		168	_delay_ms(3000);
		169	clear();
		170	// update flags to paint display again because of clear
		171	COSD_FLAGS_RUNTIME &= ~COSD_ICONS_WRITTEN;
		172	}
		173
		174	/* ##########################################################################
		175	* A simple config menu for the flags
		176	* ##########################################################################*/
		177
		178	/**
		179	* helper function for flag display
		180	*/
		181	void onoff(uint8_t line, uint8_t onoff) {
		182	if (onoff) {
		183	write_ascii_string_pgm(23, line, PSTR("ON "));
		184	} else {
		185	write_ascii_string_pgm(23, line, PSTR("OFF"));
		186	}
		187	}
		188
		189	/**
		190	* helper function for menu updating
		191	*/
		192	void config_menu_drawings(uint8_t chosen) {
		193	uint8_t line = 2;
		194
		195	// clear prevoius _cursor_
		196	//write_char_xy(3, line + ((chosen + 11) % 12), 0x00);
		197	for (uint8_t x = 2; x < 28; x++) {
		198	write_char_att_xy(x, line + ((chosen + 11) % 12), 0);
		199	write_char_att_xy(x, line + chosen, BLACKBG \| INVERT);
		200	};
		201	// draw current _cursor_
		202	//write_char_xy(3, line + chosen, 0xD9);
		203
		204
		205	write_ascii_string_pgm(4, line, PSTR("Video Mode"));
		206	if (COSD_FLAGS_CONFIG & COSD_FLAG_NTSC) {
		207	write_ascii_string_pgm(23, line, VM_NTSC);
		208	} else {
		209	write_ascii_string_pgm(23, line, VM_PAL);
		210	}
		211
		212	write_ascii_string_pgm(4, ++line, PSTR("Full HUD"));
		213	onoff(line, COSD_FLAGS_MODES & COSD_FLAG_HUD);
		214
		215	write_ascii_string_pgm(4, ++line, PSTR("Art Horizon in HUD"));
		216	onoff(line, COSD_FLAGS_MODES & COSD_FLAG_ARTHORIZON);
		217
		218	write_ascii_string_pgm(4, ++line, PSTR("Big Vario bar"));
		219	onoff(line, COSD_FLAGS_MODES & COSD_FLAG_BIGVARIO);
		220
		221	write_ascii_string_pgm(4, ++line, PSTR("Statistics"));
		222	onoff(line, COSD_FLAGS_MODES & COSD_FLAG_STATS);
		223
		224	write_ascii_string_pgm(4, ++line, PSTR("Current by FC"));
		225	onoff(line, COSD_FLAGS_MODES & COSD_FLAG_FCCURRENT);
		226
		227	write_ascii_string_pgm(4, ++line, PSTR("Voltage by C-Strom"));
		228	onoff(line, COSD_FLAGS_MODES & COSD_FLAG_STROMVOLT);
		229
		230	write_ascii_string_pgm(4, ++line, PSTR("Reset uptime"));
		231
		232	write_ascii_string_pgm(4, ++line, PSTR("Display Mode"));
		233	write_ascii_string_pgm(18, line, (const char *) (pgm_read_word(&(mode->desc))));
		234
		235	write_ascii_string_pgm(4, ++line, PSTR("Height by"));
		236	if (COSD_FLAGS_CONFIG & COSD_FLAG_GPSHEIGHT) {
		237	write_ascii_string_pgm(20, line, PSTR(" GPS"));
		238	} else {
		239	write_ascii_string_pgm(20, line, PSTR("BARO"));
		240	}
		241
		242	write_ascii_string_pgm(4, ++line, PSTR("Save config"));
		243	write_ascii_string_pgm(4, ++line, PSTR("EXIT"));
		244	}
		245
		246	/**
		247	* some sort of clicking response in the menu
		248	*/
		249	void config_menu_doclick(uint8_t chosen) {
		250	write_ascii_string_pgm(4, chosen + 2, PSTR("DONE "));
		251	_delay_ms(500);
		252	config_menu_drawings(chosen);
		253	}
		254
		255	/**
		256	* a simple config menu tryout
		257	*/
		258	void config_menu(void) {
		259	// disable interrupts (makes the menu more smoothely)
		260	cli();
		261
		262	// clear screen
		263	clear();
		264
		265	uint8_t chosen = 0;
		266	uint8_t inmenu = 1;
		267	write_ascii_string_pgm(6, 1, PSTR("C-OSD Config Menu"));
		268
		269	// wait a bit before doing stuff so user has chance to release button
		270	_delay_ms(250);
		271
		272	config_menu_drawings(chosen);
		273
		274	while (inmenu) {
		275	if (s2_pressed()) {
		276	chosen = (chosen + 1) % 12;
		277	config_menu_drawings(chosen);
		278	_delay_ms(500);
		279	} else if (s1_pressed()) {
		280	switch (chosen) {
		281	case 0: // NTSC or PAL
		282	COSD_FLAGS_CONFIG ^= COSD_FLAG_NTSC;
		283	// Setup Video Mode
		284	if (COSD_FLAGS_CONFIG & COSD_FLAG_NTSC) {
		285	// NTSC + enable display immediately (VM0)
		286	spi_send_byte(0x00, 0b00001000);
		287
		288	bottom_line = 12;
		289	} else {
		290	// PAL + enable display immediately (VM0)
		291	spi_send_byte(0x00, 0b01001000);
		292
		293	bottom_line = 14;
		294	}
		295	config_menu_drawings(chosen);
		296	break;
		297	case 1: // full HUD
		298	COSD_FLAGS_MODES ^= COSD_FLAG_HUD;
		299	config_menu_drawings(chosen);
		300	break;
		301	case 2: // art horizon
		302	COSD_FLAGS_MODES ^= COSD_FLAG_ARTHORIZON;
		303	config_menu_drawings(chosen);
		304	break;
		305	case 3: // big vario
		306	COSD_FLAGS_MODES ^= COSD_FLAG_BIGVARIO;
		307	config_menu_drawings(chosen);
		308	break;
		309	case 4: // statistics
		310	COSD_FLAGS_MODES ^= COSD_FLAG_STATS;
		311	config_menu_drawings(chosen);
		312	break;
		313	/*case 5: // warnings
		314	COSD_FLAGS_MODES ^= COSD_FLAG_WARNINGS;
		315	config_menu_drawings(chosen);
		316	break;*/
		317	case 5: // current by fc
		318	COSD_FLAGS_MODES ^= COSD_FLAG_FCCURRENT;
		319	config_menu_drawings(chosen);
		320	break;
		321	case 6: // 2nd voltage by c-strom
		322	COSD_FLAGS_MODES ^= COSD_FLAG_STROMVOLT;
		323	config_menu_drawings(chosen);
		324	break;
		325	case 7: // reset uptime
		326	uptime = 0;
		327	config_menu_doclick(chosen);
		328	break;
		329	case 8: // change mode
		330	#if FCONLY
		331	COSD_DISPLAYMODE = (COSD_DISPLAYMODE + 1) % (sizeof(fcdisplaymodes) / sizeof(displaymode_t));
		332	mode = fcdisplaymodes;
		333	mode += COSD_DISPLAYMODE;
		334	osd_fcmode = (int(*)(void)) pgm_read_word(&mode->dfun);
		335	#else
		336	COSD_DISPLAYMODE = (COSD_DISPLAYMODE + 1) % (sizeof(ncdisplaymodes) / sizeof(displaymode_t));
		337	mode = ncdisplaymodes;
		338	mode += COSD_DISPLAYMODE;
		339	osd_ncmode = (int(*)(void)) pgm_read_word(&mode->dfun);
		340	#endif
		341	config_menu_drawings(chosen);
		342	break;
		343	case 9: // GPS or BARO height
		344	COSD_FLAGS_CONFIG ^= COSD_FLAG_GPSHEIGHT;
		345	config_menu_drawings(chosen);
		346	break;
		347	case 10: // save
		348	save_eeprom();
		349	config_menu_doclick(chosen);
		350	break;
		351	case 11: // exit
		352	inmenu = 0;
		353	break;
		354	}
		355	_delay_ms(250);
		356	}
		357	}
		358
		359	// clear screen up again
		360	clear();
		361
		362	// update flags to paint display again if needed
		363	COSD_FLAGS_RUNTIME &= ~COSD_ICONS_WRITTEN;
		364
		365	// enable interrupts again
		366	sei();
		367	}
		368
		369	#endif

Subversion Repositories Projects

(root)/C-OSD/trunk/C-OSD AGRESSiVA mod/config.c - Rev 741