WebSVN - Projects - Diff - Rev 507 and 519 - /C-OSD/trunk/osd_ncmode


/****************************************************************************
 *   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 "main.h"
#include "max7456_software_spi.h"
#include "osd_helpers.h"
#include "osd_ncmode_default.h"
 
#if !(ALLCHARSDEBUG|(WRITECHARS != -1))
 
int osd_ncmode_default() {
        if (COSD_FLAGS & COSD_FLAG_HUD) {
                // write icons at init or after menu/mode-switch
                if (!(COSD_FLAGS2 & COSD_ICONS_WRITTEN)) {
                    write_char_xy(5, top_line, 0xCB); // km/h
                    write_char_xy(10, top_line, 0xCA); // RC-transmitter
                    write_char_xy(16, top_line, 0xD0); // degree symbol
                    write_char_xy(27, top_line, 0xCC); // small meters m height
                    write_char_xy(20, top_line + 1, 0xB0); // left circle
                    write_char_xy(22, top_line + 1, 0xB2); // right circle
                    write_char_xy(27, top_line + 1, 0xCC); // small meters m home
                    write_char_xy(7, bottom_line, 0x9E); // small V
                        if (COSD_FLAGS2 & COSD_FLAG_STROMREC) {
                                write_char_xy(7, bottom_line - 1, 0x9F); // small A
                                write_char_xy(14, bottom_line - 1, 0xB5); // mah
                                if (COSD_FLAGS & COSD_FLAG_STROMVOLT) {
                                        write_char_xy(21, bottom_line - 1, 0x9E); // small V
                                }
                        }
                    write_char_xy(14, bottom_line, 0xD1); // on clock
                    write_char_xy(21, bottom_line, 0xD2); // fly clock
                    write_char_xy(26, bottom_line, 0xC8); // sat1
                    write_char_xy(27, bottom_line, 0xC9); // sat2
                        COSD_FLAGS2 |= COSD_ICONS_WRITTEN;
                }
 
                // first line
                write_ndigit_number_u(2, top_line, (uint16_t) (((uint32_t) naviData.GroundSpeed * (uint32_t) 9) / (uint32_t) 250), 3, 0);
 
                write_ndigit_number_u(7, top_line, naviData.RC_Quality, 3, 0);
                if (naviData.RC_Quality <= RCLVL_WRN && last_RC_Quality > RCLVL_WRN) {
                    for (uint8_t x = 0; x < 4; x++)
                        write_char_att_xy(7 + x, top_line, BLINK);
                } else if (naviData.RC_Quality > RCLVL_WRN && last_RC_Quality <= RCLVL_WRN) {
                    for (uint8_t x = 0; x < 4; x++)
                        write_char_att_xy(7 + x, top_line, 0);
                }
       
 
                if (naviData.NCFlags & NC_FLAG_NOSERIALLINK) {
                    write_char_xy(11, top_line, 0); // clear
                } else {
                    write_char_xy(11, top_line, 0xC6); // PC icon
                }
 
                write_ndigit_number_u(13, top_line, naviData.CompassHeading, 3, 0);
 
                write_ascii_string_pgm(17, top_line, (const char *) (pgm_read_word ( &(directions[heading_conv(naviData.CompassHeading)]))));
 
                draw_variometer(21, top_line, naviData.Variometer);
 
                //note:lephisto:according to several sources it's /30
                if (naviData.Altimeter > 300 || naviData.Altimeter < -300) {
                    // above 10m only write full meters
                    write_ndigit_number_s(23, top_line, naviData.Altimeter / 30, 4, 0);
                } else {
                    // up to 10m write meters.dm
                    //write_number_u_10th(21, top_line, naviData.Altimeter / 3);
                    write_ndigit_number_s_10th(23, top_line, naviData.Altimeter / 3, 3, 0);
                }
 
                // GPS HIGHT
                //write_ndigit_number_s(23, top_line-1, (int16_t) (naviData.CurrentPosition.Altitude / 1000), 4, 0);
 
                // seccond line
                draw_compass(11, top_line + 1, naviData.CompassHeading);
 
                // TODO: verify correctness
                uint16_t heading_home = (naviData.HomePositionDeviation.Bearing + 360 - naviData.CompassHeading) % 360;
                //write_char_xy(21, top_line + 1, arrowdir[heading_conv(heading_home)]);
                // finer resolution, 0xa0 is first character and we add the index 0 <= index < 16
                write_char_xy(21, top_line + 1, 0xa0 + heading_fine_conv(heading_home));
 
                write_ndigit_number_u(24, top_line + 1, naviData.HomePositionDeviation.Distance / 10, 3, 0);
 
                // center
                if (naviData.MKFlags & FLAG_MOTOR_RUN) { // should be engines running
                    if (!(old_MKFlags & FLAG_MOTOR_RUN)) { // motors just started, clear middle
                        clear();
                        // update flags to paint display again if needed
                        COSD_FLAGS2 &= ~COSD_ICONS_WRITTEN;
                    }
                    if (COSD_FLAGS & COSD_FLAG_ARTHORIZON) {
                                if (COSD_FLAGS2 & COSD_FLAG_STROMREC) {
                                draw_artificial_horizon(top_line + 2, bottom_line - 2, naviData.AngleNick, naviData.AngleRoll);
                                } else {
                                draw_artificial_horizon(top_line + 2, bottom_line - 1, naviData.AngleNick, naviData.AngleRoll);
                                }
                    }
                    // motors are on, assume we were/are flying
                    COSD_FLAGS2 |= COSD_WASFLYING;
                } else {
                    // stats
                    if ((COSD_FLAGS2 & COSD_WASFLYING) && (COSD_FLAGS & COSD_FLAG_STATS)) {
                                uint8_t line = 3;
                        write_ascii_string_pgm(2, line, (const char *) (pgm_read_word(&(stats_item_pointers[0])))); // max Altitude
                        write_ndigit_number_s(18, line, max_Altimeter / 30, 4, 0);
                        write_char_xy(22, line, 204); // small meters m
                        write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[1])))); // max Speed
                        write_ndigit_number_u(19, line, (uint16_t) (((uint32_t) max_GroundSpeed * (uint32_t) 9) / (uint32_t) 250), 3, 0);
                        write_char_xy(22, line, 203); // km/h
                        write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[2])))); // max Distance
                        write_ndigit_number_u(19, line, max_Distance / 10, 3, 0);
                        write_char_xy(22, line, 204); // small meters m
                        write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[3])))); // min voltage
                        write_ndigit_number_u_10th(18, line, min_UBat, 3, 0);
                        write_char_xy(22, line, 0x9E); // small V
                                if (COSD_FLAGS2 & COSD_FLAG_STROMREC) {
                                        write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[7])))); // ampere
                                        write_ndigit_number_u_10th(18, line, max_ampere / 10, 3, 0);
                                        write_char_xy(22, line, 0x9F); // small A
                                }
                        write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[4])))); // max time
                        write_time(16, line, max_FlyingTime);
                        write_char_xy(22, line, 210); // fly clock
                        write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[5])))); // longitude
                        write_gps_pos(15, line, naviData.CurrentPosition.Longitude);
                        write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[6])))); // latitude
                        write_gps_pos(15, line, naviData.CurrentPosition.Latitude);
                    } else if (COSD_FLAGS & COSD_FLAG_ARTHORIZON) { // if no stats there is space horizon
                                if (COSD_FLAGS2 & COSD_FLAG_STROMREC) {
                                draw_artificial_horizon(top_line + 2, bottom_line - 2, naviData.AngleNick, naviData.AngleRoll);
                                } else {
                                draw_artificial_horizon(top_line + 2, bottom_line - 1, naviData.AngleNick, naviData.AngleRoll);
                                }
                    }
                }
                if (COSD_FLAGS & COSD_FLAG_BIGVARIO) {
                    draw_big_variometer(27, 8, naviData.Variometer);
                }
 
                // pre-bottom line
                if (COSD_FLAGS2 & COSD_FLAG_STROMREC) {
                        //write_ndigit_number_s(3, bottom_line - 1, ampere, 4, 0);
                        write_ndigit_number_u_10th(3, bottom_line - 1, ampere / 10, 3, 0);
                        write_ndigit_number_s(10, bottom_line - 1, ampere_wasted / 10, 4, 0);
                        if (COSD_FLAGS & COSD_FLAG_STROMVOLT) {
                                write_ndigit_number_u_10th(17, bottom_line - 1, s_volt, 3, 0);
                        }
                }
 
                // bottom line
                draw_battery(2, bottom_line, min_voltage, naviData.UBat, max_voltage);
                write_ndigit_number_u_10th(3, bottom_line, naviData.UBat, 3, 0);
                if (naviData.UBat <= min_voltage && last_UBat > min_voltage) {
                    for (uint8_t x = 2; x < 8; x++)
                        write_char_att_xy(x, bottom_line, BLINK);
                } else if (naviData.UBat > min_voltage && last_UBat < min_voltage) {
                    for (uint8_t x = 2; x < 8; x++)
                        write_char_att_xy(x, bottom_line, 0);
                }
 
                write_time(8, bottom_line, uptime);
                write_time(15, bottom_line, naviData.FlyingTime);
 
                write_ndigit_number_u(24, bottom_line, naviData.SatsInUse, 2, 0);
 
                if (naviData.NCFlags & NC_FLAG_MANUAL_CONTROL) {
                    write_char_xy(23, bottom_line, 0xB3); // rc transmitter
                } else {
                    write_char_xy(23, bottom_line, 0); // clear
                }
 
                if (naviData.NCFlags & NC_FLAG_CH) {
                    write_char_xy(27, bottom_line, 231); // gps ch
                } else if (naviData.NCFlags & NC_FLAG_PH) {
                    write_char_xy(27, bottom_line, 230); // gps ph
                } else { // (naviData.NCFlags & NC_FLAG_FREE)
                    write_char_xy(27, bottom_line, 201); // sat2 (free)
                }
        }
 
        //write_number_s(8, 5, RxDataLen);
        //write_number_s(16, 5, setsReceived++);
 
        // remember statistics (only when engines running)
        if (naviData.MKFlags & FLAG_MOTOR_RUN) {
            if (naviData.Altimeter > max_Altimeter) max_Altimeter = naviData.Altimeter;
            if (naviData.GroundSpeed > max_GroundSpeed) max_GroundSpeed = naviData.GroundSpeed;
            if (naviData.HomePositionDeviation.Distance > max_Distance) {
                max_Distance = naviData.HomePositionDeviation.Distance;
            }
            if (naviData.UBat < min_UBat) min_UBat = naviData.UBat;
            if (naviData.FlyingTime > max_FlyingTime) max_FlyingTime = naviData.FlyingTime;
                if (ampere > max_ampere) max_ampere = ampere;
        }
 
        // remember last values
        last_RC_Quality = naviData.RC_Quality;
        last_UBat = naviData.UBat;
        old_MKFlags = naviData.MKFlags;
        seconds_since_last_data = 0;
 
        return 0;
}
 
#endif
 

Subversion Repositories Projects

(root)/C-OSD/trunk/osd_ncmode_default.c - Rev 507 → 519

Rev 507		Rev 519
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 "main.h"	21	#include "main.h"
22	#include "max7456_software_spi.h"	22	#include "max7456_software_spi.h"
23	#include "osd_helpers.h"	23	#include "osd_helpers.h"
24	#include "osd_ncmode_default.h"	24	#include "osd_ncmode_default.h"
25		25
26	#if !(ALLCHARSDEBUG\|(WRITECHARS != -1))	26	#if !(ALLCHARSDEBUG\|(WRITECHARS != -1))
27		27
28	int osd_ncmode_default() {	28	int osd_ncmode_default() {
29	if (COSD_FLAGS & COSD_FLAG_HUD) {	29	if (COSD_FLAGS & COSD_FLAG_HUD) {
30	// write icons at init or after menu/mode-switch	30	// write icons at init or after menu/mode-switch
31	if (!(COSD_FLAGS2 & COSD_ICONS_WRITTEN)) {	31	if (!(COSD_FLAGS2 & COSD_ICONS_WRITTEN)) {
32	write_char_xy(5, top_line, 0xCB); // km/h	32	write_char_xy(5, top_line, 0xCB); // km/h
33	write_char_xy(10, top_line, 0xCA); // RC-transmitter	33	write_char_xy(10, top_line, 0xCA); // RC-transmitter
34	write_char_xy(16, top_line, 0xD0); // degree symbol	34	write_char_xy(16, top_line, 0xD0); // degree symbol
35	write_char_xy(27, top_line, 0xCC); // small meters m height	35	write_char_xy(27, top_line, 0xCC); // small meters m height
36	write_char_xy(20, top_line + 1, 0xB0); // left circle	36	write_char_xy(20, top_line + 1, 0xB0); // left circle
37	write_char_xy(22, top_line + 1, 0xB2); // right circle	37	write_char_xy(22, top_line + 1, 0xB2); // right circle
38	write_char_xy(27, top_line + 1, 0xCC); // small meters m home	38	write_char_xy(27, top_line + 1, 0xCC); // small meters m home
39	write_char_xy(7, bottom_line, 0x9E); // small V	39	write_char_xy(7, bottom_line, 0x9E); // small V
40	if (COSD_FLAGS2 & COSD_FLAG_STROMREC) {	40	if (COSD_FLAGS2 & COSD_FLAG_STROMREC) {
41	write_char_xy(7, bottom_line - 1, 0x9F); // small A	41	write_char_xy(7, bottom_line - 1, 0x9F); // small A
42	write_char_xy(14, bottom_line - 1, 0xB5); // mah	42	write_char_xy(14, bottom_line - 1, 0xB5); // mah
43	if (COSD_FLAGS & COSD_FLAG_STROMVOLT) {	43	if (COSD_FLAGS & COSD_FLAG_STROMVOLT) {
44	write_char_xy(21, bottom_line - 1, 0x9E); // small V	44	write_char_xy(21, bottom_line - 1, 0x9E); // small V
45	}	45	}
46	}	46	}
47	write_char_xy(14, bottom_line, 0xD1); // on clock	47	write_char_xy(14, bottom_line, 0xD1); // on clock
48	write_char_xy(21, bottom_line, 0xD2); // fly clock	48	write_char_xy(21, bottom_line, 0xD2); // fly clock
49	write_char_xy(26, bottom_line, 0xC8); // sat1	49	write_char_xy(26, bottom_line, 0xC8); // sat1
50	write_char_xy(27, bottom_line, 0xC9); // sat2	50	write_char_xy(27, bottom_line, 0xC9); // sat2
51	COSD_FLAGS2 \|= COSD_ICONS_WRITTEN;	51	COSD_FLAGS2 \|= COSD_ICONS_WRITTEN;
52	}	52	}
53		53
54	// first line	54	// first line
55	write_ndigit_number_u(2, top_line, (uint16_t) (((uint32_t) naviData.GroundSpeed * (uint32_t) 9) / (uint32_t) 250), 100, 0);	55	write_ndigit_number_u(2, top_line, (uint16_t) (((uint32_t) naviData.GroundSpeed * (uint32_t) 9) / (uint32_t) 250), 3, 0);
56		56
57	write_ndigit_number_u(7, top_line, naviData.RC_Quality, 100, 0);	57	write_ndigit_number_u(7, top_line, naviData.RC_Quality, 3, 0);
58	if (naviData.RC_Quality <= RCLVL_WRN && last_RC_Quality > RCLVL_WRN) {	58	if (naviData.RC_Quality <= RCLVL_WRN && last_RC_Quality > RCLVL_WRN) {
59	for (uint8_t x = 0; x < 4; x++)	59	for (uint8_t x = 0; x < 4; x++)
60	write_char_att_xy(7 + x, top_line, BLINK);	60	write_char_att_xy(7 + x, top_line, BLINK);
61	} else if (naviData.RC_Quality > RCLVL_WRN && last_RC_Quality <= RCLVL_WRN) {	61	} else if (naviData.RC_Quality > RCLVL_WRN && last_RC_Quality <= RCLVL_WRN) {
62	for (uint8_t x = 0; x < 4; x++)	62	for (uint8_t x = 0; x < 4; x++)
63	write_char_att_xy(7 + x, top_line, 0);	63	write_char_att_xy(7 + x, top_line, 0);
64	}	64	}
65		65
66		66
67	if (naviData.NCFlags & NC_FLAG_NOSERIALLINK) {	67	if (naviData.NCFlags & NC_FLAG_NOSERIALLINK) {
68	write_char_xy(11, top_line, 0); // clear	68	write_char_xy(11, top_line, 0); // clear
69	} else {	69	} else {
70	write_char_xy(11, top_line, 0xC6); // PC icon	70	write_char_xy(11, top_line, 0xC6); // PC icon
71	}	71	}
72		72
73	write_ndigit_number_u(13, top_line, naviData.CompassHeading, 100, 0);	73	write_ndigit_number_u(13, top_line, naviData.CompassHeading, 3, 0);
74		74
75	write_ascii_string_pgm(17, top_line, (const char *) (pgm_read_word ( &(directions[heading_conv(naviData.CompassHeading)]))));	75	write_ascii_string_pgm(17, top_line, (const char *) (pgm_read_word ( &(directions[heading_conv(naviData.CompassHeading)]))));
76		76
77	draw_variometer(21, top_line, naviData.Variometer);	77	draw_variometer(21, top_line, naviData.Variometer);
78		78
79	//note:lephisto:according to several sources it's /30	79	//note:lephisto:according to several sources it's /30
80	if (naviData.Altimeter > 300 \|\| naviData.Altimeter < -300) {	80	if (naviData.Altimeter > 300 \|\| naviData.Altimeter < -300) {
81	// above 10m only write full meters	81	// above 10m only write full meters
82	write_ndigit_number_s(23, top_line, naviData.Altimeter / 30, 1000, 0);	82	write_ndigit_number_s(23, top_line, naviData.Altimeter / 30, 4, 0);
83	} else {	83	} else {
84	// up to 10m write meters.dm	84	// up to 10m write meters.dm
85	//write_number_u_10th(21, top_line, naviData.Altimeter / 3);	85	//write_number_u_10th(21, top_line, naviData.Altimeter / 3);
86	write_ndigit_number_s_10th(23, top_line, naviData.Altimeter / 3, 100, 0);	86	write_ndigit_number_s_10th(23, top_line, naviData.Altimeter / 3, 3, 0);
87	}	87	}
-		88
-		89	// GPS HIGHT
-		90	//write_ndigit_number_s(23, top_line-1, (int16_t) (naviData.CurrentPosition.Altitude / 1000), 4, 0);
88		91
89	// seccond line	92	// seccond line
90	draw_compass(11, top_line + 1, naviData.CompassHeading);	93	draw_compass(11, top_line + 1, naviData.CompassHeading);
91		94
92	// TODO: verify correctness	95	// TODO: verify correctness
93	uint16_t heading_home = (naviData.HomePositionDeviation.Bearing + 360 - naviData.CompassHeading) % 360;	96	uint16_t heading_home = (naviData.HomePositionDeviation.Bearing + 360 - naviData.CompassHeading) % 360;
94	//write_char_xy(21, top_line + 1, arrowdir[heading_conv(heading_home)]);	97	//write_char_xy(21, top_line + 1, arrowdir[heading_conv(heading_home)]);
95	// finer resolution, 0xa0 is first character and we add the index 0 <= index < 16	98	// finer resolution, 0xa0 is first character and we add the index 0 <= index < 16
96	write_char_xy(21, top_line + 1, 0xa0 + heading_fine_conv(heading_home));	99	write_char_xy(21, top_line + 1, 0xa0 + heading_fine_conv(heading_home));
97		100
98	write_ndigit_number_u(24, top_line + 1, naviData.HomePositionDeviation.Distance / 10, 100, 0);	101	write_ndigit_number_u(24, top_line + 1, naviData.HomePositionDeviation.Distance / 10, 3, 0);
99		102
100	// center	103	// center
101	if (naviData.MKFlags & FLAG_MOTOR_RUN) { // should be engines running	104	if (naviData.MKFlags & FLAG_MOTOR_RUN) { // should be engines running
102	if (!(old_MKFlags & FLAG_MOTOR_RUN)) { // motors just started, clear middle	105	if (!(old_MKFlags & FLAG_MOTOR_RUN)) { // motors just started, clear middle
103	clear();	106	clear();
104	// update flags to paint display again if needed	107	// update flags to paint display again if needed
105	COSD_FLAGS2 &= ~COSD_ICONS_WRITTEN;	108	COSD_FLAGS2 &= ~COSD_ICONS_WRITTEN;
106	}	109	}
107	if (COSD_FLAGS & COSD_FLAG_ARTHORIZON) {	110	if (COSD_FLAGS & COSD_FLAG_ARTHORIZON) {
108	if (COSD_FLAGS2 & COSD_FLAG_STROMREC) {	111	if (COSD_FLAGS2 & COSD_FLAG_STROMREC) {
109	draw_artificial_horizon(top_line + 2, bottom_line - 2, naviData.AngleNick, naviData.AngleRoll);	112	draw_artificial_horizon(top_line + 2, bottom_line - 2, naviData.AngleNick, naviData.AngleRoll);
110	} else {	113	} else {
111	draw_artificial_horizon(top_line + 2, bottom_line - 1, naviData.AngleNick, naviData.AngleRoll);	114	draw_artificial_horizon(top_line + 2, bottom_line - 1, naviData.AngleNick, naviData.AngleRoll);
112	}	115	}
113	}	116	}
114	// motors are on, assume we were/are flying	117	// motors are on, assume we were/are flying
115	COSD_FLAGS2 \|= COSD_WASFLYING;	118	COSD_FLAGS2 \|= COSD_WASFLYING;
116	} else {	119	} else {
117	// stats	120	// stats
118	if ((COSD_FLAGS2 & COSD_WASFLYING) && (COSD_FLAGS & COSD_FLAG_STATS)) {	121	if ((COSD_FLAGS2 & COSD_WASFLYING) && (COSD_FLAGS & COSD_FLAG_STATS)) {
119	uint8_t line = 3;	122	uint8_t line = 3;
120	write_ascii_string_pgm(2, line, (const char *) (pgm_read_word(&(stats_item_pointers[0])))); // max Altitude	123	write_ascii_string_pgm(2, line, (const char *) (pgm_read_word(&(stats_item_pointers[0])))); // max Altitude
121	write_ndigit_number_s(18, line, max_Altimeter / 30, 1000, 0);	124	write_ndigit_number_s(18, line, max_Altimeter / 30, 4, 0);
122	write_char_xy(22, line, 204); // small meters m	125	write_char_xy(22, line, 204); // small meters m
123	write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[1])))); // max Speed	126	write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[1])))); // max Speed
124	write_ndigit_number_u(19, line, (uint16_t) (((uint32_t) max_GroundSpeed * (uint32_t) 9) / (uint32_t) 250), 100, 0);	127	write_ndigit_number_u(19, line, (uint16_t) (((uint32_t) max_GroundSpeed * (uint32_t) 9) / (uint32_t) 250), 3, 0);
125	write_char_xy(22, line, 203); // km/h	128	write_char_xy(22, line, 203); // km/h
126	write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[2])))); // max Distance	129	write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[2])))); // max Distance
127	write_ndigit_number_u(19, line, max_Distance / 10, 100, 0);	130	write_ndigit_number_u(19, line, max_Distance / 10, 3, 0);
128	write_char_xy(22, line, 204); // small meters m	131	write_char_xy(22, line, 204); // small meters m
129	write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[3])))); // min voltage	132	write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[3])))); // min voltage
130	write_ndigit_number_u_10th(18, line, min_UBat, 100, 0);	133	write_ndigit_number_u_10th(18, line, min_UBat, 3, 0);
131	write_char_xy(22, line, 0x9E); // small V	134	write_char_xy(22, line, 0x9E); // small V
132	if (COSD_FLAGS2 & COSD_FLAG_STROMREC) {	135	if (COSD_FLAGS2 & COSD_FLAG_STROMREC) {
133	write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[7])))); // ampere	136	write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[7])))); // ampere
134	write_ndigit_number_u_10th(18, line, max_ampere / 10, 100, 0);	137	write_ndigit_number_u_10th(18, line, max_ampere / 10, 3, 0);
135	write_char_xy(22, line, 0x9F); // small A	138	write_char_xy(22, line, 0x9F); // small A
136	}	139	}
137	write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[4])))); // max time	140	write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[4])))); // max time
138	write_time(16, line, max_FlyingTime);	141	write_time(16, line, max_FlyingTime);
139	write_char_xy(22, line, 210); // fly clock	142	write_char_xy(22, line, 210); // fly clock
140	write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[5])))); // longitude	143	write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[5])))); // longitude
141	write_gps_pos(15, line, naviData.CurrentPosition.Longitude);	144	write_gps_pos(15, line, naviData.CurrentPosition.Longitude);
142	write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[6])))); // latitude	145	write_ascii_string_pgm(2, ++line, (const char *) (pgm_read_word(&(stats_item_pointers[6])))); // latitude
143	write_gps_pos(15, line, naviData.CurrentPosition.Latitude);	146	write_gps_pos(15, line, naviData.CurrentPosition.Latitude);
144	} else if (COSD_FLAGS & COSD_FLAG_ARTHORIZON) { // if no stats there is space horizon	147	} else if (COSD_FLAGS & COSD_FLAG_ARTHORIZON) { // if no stats there is space horizon
145	if (COSD_FLAGS2 & COSD_FLAG_STROMREC) {	148	if (COSD_FLAGS2 & COSD_FLAG_STROMREC) {
146	draw_artificial_horizon(top_line + 2, bottom_line - 2, naviData.AngleNick, naviData.AngleRoll);	149	draw_artificial_horizon(top_line + 2, bottom_line - 2, naviData.AngleNick, naviData.AngleRoll);
147	} else {	150	} else {
148	draw_artificial_horizon(top_line + 2, bottom_line - 1, naviData.AngleNick, naviData.AngleRoll);	151	draw_artificial_horizon(top_line + 2, bottom_line - 1, naviData.AngleNick, naviData.AngleRoll);
149	}	152	}
150	}	153	}
151	}	154	}
152	if (COSD_FLAGS & COSD_FLAG_BIGVARIO) {	155	if (COSD_FLAGS & COSD_FLAG_BIGVARIO) {
153	draw_big_variometer(27, 8, naviData.Variometer);	156	draw_big_variometer(27, 8, naviData.Variometer);
154	}	157	}
155		158
156	// pre-bottom line	159	// pre-bottom line
157	if (COSD_FLAGS2 & COSD_FLAG_STROMREC) {	160	if (COSD_FLAGS2 & COSD_FLAG_STROMREC) {
158	//write_ndigit_number_s(3, bottom_line - 1, ampere, 1000, 0);	161	//write_ndigit_number_s(3, bottom_line - 1, ampere, 4, 0);
159	write_ndigit_number_u_10th(3, bottom_line - 1, ampere / 10, 100, 0);	162	write_ndigit_number_u_10th(3, bottom_line - 1, ampere / 10, 3, 0);
160	write_ndigit_number_s(10, bottom_line - 1, ampere_wasted / 10, 1000, 0);	163	write_ndigit_number_s(10, bottom_line - 1, ampere_wasted / 10, 4, 0);
161	if (COSD_FLAGS & COSD_FLAG_STROMVOLT) {	164	if (COSD_FLAGS & COSD_FLAG_STROMVOLT) {
162	write_ndigit_number_u_10th(17, bottom_line - 1, s_volt, 100, 0);	165	write_ndigit_number_u_10th(17, bottom_line - 1, s_volt, 3, 0);
163	}	166	}
164	}	167	}
165		168
166	// bottom line	169	// bottom line
167	draw_battery(2, bottom_line, min_voltage, naviData.UBat, max_voltage);	170	draw_battery(2, bottom_line, min_voltage, naviData.UBat, max_voltage);
168	write_ndigit_number_u_10th(3, bottom_line, naviData.UBat, 100, 0);	171	write_ndigit_number_u_10th(3, bottom_line, naviData.UBat, 3, 0);
169	if (naviData.UBat <= min_voltage && last_UBat > min_voltage) {	172	if (naviData.UBat <= min_voltage && last_UBat > min_voltage) {
170	for (uint8_t x = 2; x < 8; x++)	173	for (uint8_t x = 2; x < 8; x++)
171	write_char_att_xy(x, bottom_line, BLINK);	174	write_char_att_xy(x, bottom_line, BLINK);
172	} else if (naviData.UBat > min_voltage && last_UBat < min_voltage) {	175	} else if (naviData.UBat > min_voltage && last_UBat < min_voltage) {
173	for (uint8_t x = 2; x < 8; x++)	176	for (uint8_t x = 2; x < 8; x++)
174	write_char_att_xy(x, bottom_line, 0);	177	write_char_att_xy(x, bottom_line, 0);
175	}	178	}
176		179
177	write_time(8, bottom_line, uptime);	180	write_time(8, bottom_line, uptime);
178	write_time(15, bottom_line, naviData.FlyingTime);	181	write_time(15, bottom_line, naviData.FlyingTime);
179		182
180	write_ndigit_number_u(24, bottom_line, naviData.SatsInUse, 10, 0);	183	write_ndigit_number_u(24, bottom_line, naviData.SatsInUse, 2, 0);
181		184
182	if (naviData.NCFlags & NC_FLAG_MANUAL_CONTROL) {	185	if (naviData.NCFlags & NC_FLAG_MANUAL_CONTROL) {
183	write_char_xy(23, bottom_line, 0xB3); // rc transmitter	186	write_char_xy(23, bottom_line, 0xB3); // rc transmitter
184	} else {	187	} else {
185	write_char_xy(23, bottom_line, 0); // clear	188	write_char_xy(23, bottom_line, 0); // clear
186	}	189	}
187		190
188	if (naviData.NCFlags & NC_FLAG_CH) {	191	if (naviData.NCFlags & NC_FLAG_CH) {
189	write_char_xy(27, bottom_line, 231); // gps ch	192	write_char_xy(27, bottom_line, 231); // gps ch
190	} else if (naviData.NCFlags & NC_FLAG_PH) {	193	} else if (naviData.NCFlags & NC_FLAG_PH) {
191	write_char_xy(27, bottom_line, 230); // gps ph	194	write_char_xy(27, bottom_line, 230); // gps ph
192	} else { // (naviData.NCFlags & NC_FLAG_FREE)	195	} else { // (naviData.NCFlags & NC_FLAG_FREE)
193	write_char_xy(27, bottom_line, 201); // sat2 (free)	196	write_char_xy(27, bottom_line, 201); // sat2 (free)
194	}	197	}
195	}	198	}
196		199
197	//write_number_s(8, 5, RxDataLen);	200	//write_number_s(8, 5, RxDataLen);
198	//write_number_s(16, 5, setsReceived++);	201	//write_number_s(16, 5, setsReceived++);
199		202
200	// remember statistics (only when engines running)	203	// remember statistics (only when engines running)
201	if (naviData.MKFlags & FLAG_MOTOR_RUN) {	204	if (naviData.MKFlags & FLAG_MOTOR_RUN) {
202	if (naviData.Altimeter > max_Altimeter) max_Altimeter = naviData.Altimeter;	205	if (naviData.Altimeter > max_Altimeter) max_Altimeter = naviData.Altimeter;
203	if (naviData.GroundSpeed > max_GroundSpeed) max_GroundSpeed = naviData.GroundSpeed;	206	if (naviData.GroundSpeed > max_GroundSpeed) max_GroundSpeed = naviData.GroundSpeed;
204	if (naviData.HomePositionDeviation.Distance > max_Distance) {	207	if (naviData.HomePositionDeviation.Distance > max_Distance) {
205	max_Distance = naviData.HomePositionDeviation.Distance;	208	max_Distance = naviData.HomePositionDeviation.Distance;
206	}	209	}
207	if (naviData.UBat < min_UBat) min_UBat = naviData.UBat;	210	if (naviData.UBat < min_UBat) min_UBat = naviData.UBat;
208	if (naviData.FlyingTime > max_FlyingTime) max_FlyingTime = naviData.FlyingTime;	211	if (naviData.FlyingTime > max_FlyingTime) max_FlyingTime = naviData.FlyingTime;
209	if (ampere > max_ampere) max_ampere = ampere;	212	if (ampere > max_ampere) max_ampere = ampere;
210	}	213	}
211		214
212	// remember last values	215	// remember last values
213	last_RC_Quality = naviData.RC_Quality;	216	last_RC_Quality = naviData.RC_Quality;
214	last_UBat = naviData.UBat;	217	last_UBat = naviData.UBat;
215	old_MKFlags = naviData.MKFlags;	218	old_MKFlags = naviData.MKFlags;
216	seconds_since_last_data = 0;	219	seconds_since_last_data = 0;
217		220
218	return 0;	221	return 0;
219	}	222	}
220		223
221	#endif	224	#endif
222		225