WebSVN - Projects - Diff - Rev 489 and 497


/****************************************************************************
 *   Copyright (C) 2009 by Claas Anders "CaScAdE" Rathje                    *
 *   admiralcascade@gmail.com                                               *
 *   Project-URL: http://www.mylifesucks.de/oss/c-osd/                      *
 *                                                                          *
 *   This program is free software; you can redistribute it and/or modify   *
 *   it under the terms of the GNU General Public License as published by   *
 *   the Free Software Foundation; either version 2 of the License.         *
 *                                                                          *
 *   This program is distributed in the hope that it will be useful,        *
 *   but WITHOUT ANY WARRANTY; without even the implied warranty of         *
 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the          *
 *   GNU General Public License for more details.                           *
 *                                                                          *
 *   You should have received a copy of the GNU General Public License      *
 *   along with this program; if not, write to the                          *
 *   Free Software Foundation, Inc.,                                        *
 *   59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.              *
 ****************************************************************************/
 
#include <avr/io.h>
#include <avr/eeprom.h>
#include <avr/pgmspace.h>
#include <avr/interrupt.h>
#include <util/delay.h>
#include "max7456_software_spi.h"
#include "config.h"
#include "main.h"
#include "buttons.h"
#include "usart1.h"
 
#if !(ALLCHARSDEBUG|(WRITECHARS != -1))
 
// store more fixed strings in progmen
char ON[] PROGMEM = "ON ";
char OFF[] PROGMEM = "OFF";
 
uint8_t EEMEM ee_checkbyte1 = CHECKBYTE1;
uint8_t EEMEM ee_checkbyte2 = CHECKBYTE2;
uint16_t EEMEM ee_cal_ampere = 512;
uint8_t EEMEM ee_sensor = 50;
uint8_t EEMEM ee_COSD_FLAGS;
uint8_t EEMEM ee_COSD_DISPLAYMODE = 0;
 
// store init strings in progmem
const char init_0[] PROGMEM = "C-OSD Initialisation";
const char init_1[] PROGMEM = "FC only Mode";
const char init_2[] PROGMEM = "NaviCtrl Mode";
const char init_3[] PROGMEM = "Guessing Number of Cells";
const char init_4[] PROGMEM = "Number of Cells:";
const char init_5[] PROGMEM = "Warn Voltage   :";
const char init_6[] PROGMEM = "Max Voltage    :";
const char* init_point[] PROGMEM = {init_0, init_1, init_2, init_3, init_4, init_5, init_6};
 
const char ee_message0[] PROGMEM = "Loading Data from EEPROM";
const char ee_message1[] PROGMEM = "No saved Data in EEPROM";
const char* ee_msg[] PROGMEM = {ee_message0, ee_message1};
 
// video modes
const char VM_PAL[] PROGMEM = "PAL ";
const char VM_NTSC[] PROGMEM = "NTSC";
 
// menu strings to progmem
const char menu_item0[] PROGMEM = "Video Mode";
const char menu_item1[] PROGMEM = "Full HUD";
const char menu_item2[] PROGMEM = "Art.Horizon in HUD";
const char menu_item3[] PROGMEM = "Big Vario bar";
const char menu_item4[] PROGMEM = "Statistics";
const char menu_item5[] PROGMEM = "Warnings"; // TODO: do it!
const char menu_item6[] PROGMEM = "Reset uptime";
const char menu_item7[] PROGMEM = "Request OSD-data";
const char menu_item8[] PROGMEM = "Display Mode";
const char menu_item9[] PROGMEM = "Save config";
const char menu_item10[] PROGMEM = "EXIT";
const char* menu[] = {menu_item0, menu_item1, menu_item2, menu_item3, menu_item4,
        menu_item5, menu_item6, menu_item7, menu_item8, menu_item9, menu_item10};
 
const displaymode_t * mode;
 
/**
 * read data saved in eeprom, print out message if <verbose> is set
 */
void get_eeprom(uint8_t verbose) {
        if (eeprom_read_byte(&ee_checkbyte1) == CHECKBYTE1 && eeprom_read_byte(&ee_checkbyte2) == CHECKBYTE2) {
                if (verbose) write_ascii_string_pgm(2, 9, ee_msg[0]); // Loading data
                COSD_FLAGS = eeprom_read_byte(&ee_COSD_FLAGS);
                COSD_DISPLAYMODE = eeprom_read_byte(&ee_COSD_DISPLAYMODE);
                //if (verbose) write_ndigit_number_u(23, 11, COSD_DISPLAYMODE, 10, 0);
        } else {
                if (verbose) write_ascii_string_pgm(2, 9, ee_msg[1]); // No data found
        }
}
 
/**
 * save data to eeprom
 */
void save_eeprom() {
        eeprom_write_byte(&ee_checkbyte1, CHECKBYTE1);
        eeprom_write_byte(&ee_checkbyte2, CHECKBYTE2);
        eeprom_write_byte(&ee_COSD_FLAGS, COSD_FLAGS);
        eeprom_write_byte(&ee_COSD_DISPLAYMODE, COSD_DISPLAYMODE);
}
 
/**
 * auto config some stuff on startup, currently only battery cells
 * TODO: this is testing stuff, strings should go progmem and so on...
 */
void init_cosd(uint8_t UBat) {
    clear();
        write_ascii_string_pgm(2, 1, init_point[0]); // C-OSD Initialisation
    //write_ascii_string(2, 1, "C-OSD Initialisation");
#if FCONLY
        write_ascii_string_pgm(2, 2, init_point[1]); // FC only mode
    //write_ascii_string(2, 2, "FC only Mode");
#else
        write_ascii_string_pgm(2, 2, init_point[2]); // NaviCtrl Mode
    //write_ascii_string(2, 2, "NaviCtrl Mode");
#endif
    write_ascii_string(2, 3, BUILDDATE);
    uint8_t cellnum = 0;
    if (CELL_NUM == -1) {
                write_ascii_string_pgm(2, 4, init_point[3]); // Guessing Number of Cells
        //write_ascii_string(2, 6, "Guessing Number of Cells");
        do {
            cellnum++;
        } while (UBat > ((cellnum * CELL_VOLT_MAX) + 23));
    } else {
        cellnum = CELL_NUM;
    }
    min_voltage = cellnum * CELL_VOLT_MIN;
    max_voltage = cellnum * CELL_VOLT_MAX;
        write_ascii_string_pgm(2, 5, init_point[4]); // Number of Cells
    //write_ascii_string(2, 5, "Number of Cells:");
    write_ndigit_number_u(21, 5, cellnum, 1, 0);
        write_ascii_string_pgm(2, 6, init_point[5]); // Warn Voltage
    //write_ascii_string(2, 6, "Warn Voltage   :");
    write_ndigit_number_s_10th(20, 6, min_voltage, 100, 0);
        write_ascii_string_pgm(2, 7, init_point[6]); // Max Voltage
    //write_ascii_string(2, 7, "Max Voltage    :");
    write_ndigit_number_s_10th(20, 7, max_voltage, 100, 0);
 
        get_eeprom(1);
 
    //write_ascii_string_pgm(23, 2, vm[COSD_FLAGS & COSD_FLAG_NTSC]);
        if (COSD_FLAGS & COSD_FLAG_NTSC) {
                write_ascii_string_pgm(23, 2, VM_NTSC);
        } else {
                write_ascii_string_pgm(23, 2, VM_PAL);
        }
 
 
        #if FCONLY
        COSD_DISPLAYMODE %= (sizeof(fcdisplaymodes) / sizeof(displaymode_t));
        mode = fcdisplaymodes;
        mode += COSD_DISPLAYMODE;
        osd_fcmode = (int(*)(void)) pgm_read_word(&mode->dfun);
        #else
        COSD_DISPLAYMODE %= (sizeof(ncdisplaymodes) / sizeof(displaymode_t));
        mode = ncdisplaymodes;
        mode += COSD_DISPLAYMODE;
        osd_ncmode = (int(*)(void)) pgm_read_word(&mode->dfun);
        #endif
 
    _delay_ms(200);
    clear();
    // update flags to paint display again because of clear
    COSD_FLAGS2 &= ~COSD_ICONS_WRITTEN;
}
 
/* ##########################################################################
 * A simple config menu for the flags
 * ##########################################################################*/
 
/**
 * helper function for menu updating
 */
void config_menu_drawings(uint8_t chosen) {
    // clear prevoius _cursor_
    write_ascii_string(3, (chosen + 2) % 10, " ");
    // draw current _cursor_
    write_ascii_string(3, chosen + 2, ">");
 
        if (COSD_FLAGS & COSD_FLAG_NTSC) {
                write_ascii_string_pgm(23, 2, VM_NTSC);
        } else {
                write_ascii_string_pgm(23, 2, VM_PAL);
        }
         
    if (COSD_FLAGS & COSD_FLAG_HUD) {
        write_ascii_string_pgm(23, 3, ON);
    } else {
        write_ascii_string_pgm(23, 3, OFF);
    }
    if (COSD_FLAGS & COSD_FLAG_ARTHORIZON) {
        write_ascii_string_pgm(23, 4, ON);
    } else {
        write_ascii_string_pgm(23, 4, OFF);
    }
    if (COSD_FLAGS & COSD_FLAG_BIGVARIO) {
        write_ascii_string_pgm(23, 5, ON);
    } else {
        write_ascii_string_pgm(23, 5, OFF);
    }
    if (COSD_FLAGS & COSD_FLAG_STATS) {
        write_ascii_string_pgm(23, 6, ON);
    } else {
        write_ascii_string_pgm(23, 6, OFF);
    }
    if (COSD_FLAGS & COSD_FLAG_WARNINGS) {
        write_ascii_string_pgm(23, 7, ON);
    } else {
        write_ascii_string_pgm(23, 7, OFF);
    }
        //write_ndigit_number_u(23, 10, COSD_DISPLAYMODE, 10, 0);
        write_ascii_string_pgm(18, 10, (const char *) (pgm_read_word(&(mode->desc))));
       
}
 
/**
 * some sort of clicking response in the menu
 */
void config_menu_doclick(uint8_t chosen, const char* menu[]) {
    write_ascii_string(4, chosen + 2, "DONE              ");
    _delay_ms(500);
    write_ascii_string_pgm(4, chosen + 2, menu[chosen]);
}
 
/**
 * a simple config menu tryout
 */
void config_menu(void) {
    // disable interrupts (makes the menu more smoothely)
    cli();
 
    // clear screen
    clear();
 
    uint8_t inmenu = 1;
    uint8_t chosen = 0;
    write_ascii_string(6, 1, "C-OSD Config Menu");
 
    // wait a bit before doing stuff so user has chance to release button
    _delay_ms(250);
 
        write_ascii_string_pgm(4, 2, menu[0]);
    write_ascii_string_pgm(4, 3, menu[1]);
    write_ascii_string_pgm(4, 4, menu[2]);
    write_ascii_string_pgm(4, 5, menu[3]);
    write_ascii_string_pgm(4, 6, menu[4]);
    write_ascii_string_pgm(4, 7, menu[5]);
    write_ascii_string_pgm(4, 8, menu[6]);
    write_ascii_string_pgm(4, 9, menu[7]);
    write_ascii_string_pgm(4, 10, menu[8]);
    write_ascii_string_pgm(4, 11, menu[9]);
        write_ascii_string_pgm(4, 12, menu[10]);
 
    config_menu_drawings(chosen);
 
    while (inmenu) {
        if (s2_pressed()) {
            write_ascii_string(3, chosen + 2, " ");
            chosen = (chosen + 1) % 11;
            write_ascii_string(3, chosen + 2, ">");
            _delay_ms(500);
        } else if (s1_pressed()) {
            switch (chosen) {
                case 0: // full HUD
                    COSD_FLAGS ^= COSD_FLAG_NTSC;
                                        // Setup Video Mode
                                        if (COSD_FLAGS & COSD_FLAG_NTSC) {
                                            // NTSC + enable display immediately (VM0)
                                            spi_send_byte(0x00, 0b00001000);
 
                                                bottom_line = 12;
                                        } else {
                                            // PAL + enable display immediately (VM0)
                                            spi_send_byte(0x00, 0b01001000);
 
                                                bottom_line = 14;
                                        }
                    config_menu_drawings(chosen);
                    break;
                case 1: // full HUD
                    COSD_FLAGS ^= COSD_FLAG_HUD;
                    config_menu_drawings(chosen);
                    break;
                case 2: // art horizon
                    COSD_FLAGS ^= COSD_FLAG_ARTHORIZON;
                    config_menu_drawings(chosen);
                    break;
                case 3: // big vario
                    COSD_FLAGS ^= COSD_FLAG_BIGVARIO;
                    config_menu_drawings(chosen);
                    break;
                case 4: // statistics
                    COSD_FLAGS ^= COSD_FLAG_STATS;
                    config_menu_drawings(chosen);
                    break;
                case 5: // warnings
                    COSD_FLAGS ^= COSD_FLAG_WARNINGS;
                    config_menu_drawings(chosen);
                    break;
                case 6: // reset uptime
                    uptime = 0;
                    config_menu_doclick(chosen, menu);
                    break;
                case 7: // re-request OSD data
#if FCONLY
                    // request data ever 100ms from FC;
                    usart1_request_mk_data(0, 'd', 100);
#else
                    // request OSD Data from NC every 100ms
                    usart1_request_mk_data(1, 'o', 100);
 
                    // and disable debug...
                    usart1_request_mk_data(0, 'd', 0);
#endif
                    config_menu_doclick(chosen, menu);
                    break;
                case 8: // change mode
                                        #if FCONLY
                                        COSD_DISPLAYMODE = (COSD_DISPLAYMODE + 1) % (sizeof(fcdisplaymodes) / sizeof(displaymode_t));
                                        mode = fcdisplaymodes;
                                        mode += COSD_DISPLAYMODE;
                                        osd_fcmode = (int(*)(void)) pgm_read_word(&mode->dfun);
                                        #else
                                        COSD_DISPLAYMODE = (COSD_DISPLAYMODE + 1) % (sizeof(ncdisplaymodes) / sizeof(displaymode_t));
                                        mode = ncdisplaymodes;
                                        mode += COSD_DISPLAYMODE;
                                        osd_ncmode = (int(*)(void)) pgm_read_word(&mode->dfun);
                                        #endif
                                        config_menu_drawings(chosen);
                    break;
                case 9: // save
                    save_eeprom();
                    config_menu_doclick(chosen, menu);
                    break;
                case 10: // exit
                    inmenu = 0;
                    break;
            }
            _delay_ms(250);
        }
    }
 
    // clear screen up again
    clear();
 
    // update flags to paint display again if needed
    COSD_FLAGS2 &= ~COSD_ICONS_WRITTEN;
 
    // enable interrupts again
    sei();
}
 
#endif
 

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

Subversion Repositories Projects

(root)/C-OSD/trunk/config.c @ 489 - Rev 489 → 497