WebSVN - Projects - Blame - Rev 2039 - /C-OSD/trunk/osd_ncmode

Rev	Author	Line No.	Line
497	cascade	1	/****************************************************************************
2039	-	2	* Copyright (C) 2009-2014 by Claas Anders "CaScAdE" Rathje *
497	cascade	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 "main.h"
		22	#include "max7456_software_spi.h"
		23	#include "osd_helpers.h"
		24	#include "osd_ncmode_default.h"
		25
783	-	26	#if (!(ALLCHARSDEBUG \|\| (WRITECHARS != -1)) && !FCONLY)
497	cascade	27
753	cascade	28	int osd_ncmode_minimal() {
1771	-	29	if (!(COSD_FLAGS_MODES & COSD_FLAG_HUD)) {
		30	clear();
		31	} else {
761	-	32	// write icons at init or after menu/mode-switch
		33	if (!(COSD_FLAGS_RUNTIME & COSD_ICONS_WRITTEN)) {
		34	write_char_xy(4, top_line, 0xCB); // km/h
		35	write_char_xy(15, top_line, 0xCC); // small meters m height
		36	write_char_xy(26, top_line, 0xCC); // small meters m height
		37	write_char_xy(16, top_line, 0xB0); // left circle
		38	write_char_xy(18, top_line, 0xB2); // right circle
		39	write_char_xy(7, bottom_line, 0x9E); // small V
		40	write_char_xy(17, bottom_line, 0xD2); // fly clock
		41	write_char_xy(26, bottom_line, 0xC8); // sat1
		42	write_char_xy(27, bottom_line, 0xC9); // sat2
		43	COSD_FLAGS_RUNTIME \|= COSD_ICONS_WRITTEN;
		44	}
		45
		46	// first line
		47	write_ndigit_number_u(1, top_line, (uint16_t)(((uint32_t)naviData.GroundSpeed * (uint32_t)9) / (uint32_t)250), 3, 0);
		48
		49	write_ndigit_number_u(12, top_line, naviData.HomePositionDeviation.Distance / 10, 3, 0);
		50
		51	uint16_t heading_home = (naviData.HomePositionDeviation.Bearing + 360 - naviData.CompassHeading) % 360;
		52	write_char_xy(17, top_line, 0xa0 + heading_fine_conv(heading_home));
		53
766	-	54	if (naviData.Altimeter > 200 \|\| naviData.Altimeter < -200) {
761	-	55	// above 10m only write full meters
766	-	56	write_ndigit_number_s(22, top_line, naviData.Altimeter / 20, 4, 0);
761	-	57	} else {
		58	// up to 10m write meters.dm
766	-	59	write_ndigit_number_s_10th(22, top_line, naviData.Altimeter / 2, 3, 0);
761	-	60	}
		61
		62	draw_variometer(27, top_line, naviData.Variometer);
		63
		64
		65	// center
2039	-	66	if (naviData.FCStatusFlags & FCFLAG_MOTOR_RUN) { // should be engines running
783	-	67	if (!(old_MKFlags & FCFLAG_MOTOR_RUN)) { // motors just started, clear middle
761	-	68	clear();
		69	// update flags to paint display again if needed
		70	COSD_FLAGS_RUNTIME &= ~COSD_ICONS_WRITTEN;
		71	}
		72	if (COSD_FLAGS_MODES & COSD_FLAG_ARTHORIZON) {
		73	if (COSD_FLAGS_RUNTIME & COSD_FLAG_STROMREC) {
		74	draw_artificial_horizon(top_line + 2, bottom_line - 2, naviData.AngleNick, naviData.AngleRoll);
		75	} else {
		76	draw_artificial_horizon(top_line + 2, bottom_line - 1, naviData.AngleNick, naviData.AngleRoll);
		77	}
		78	}
		79	// motors are on, assume we were/are flying
		80	COSD_FLAGS_RUNTIME \|= COSD_WASFLYING;
		81	} else {
		82	// stats
		83	if ((COSD_FLAGS_RUNTIME & COSD_WASFLYING) && (COSD_FLAGS_MODES & COSD_FLAG_STATS)) {
902	-	84	draw_stats();
761	-	85	}
		86	}
		87	if (COSD_FLAGS_MODES & COSD_FLAG_BIGVARIO) {
		88	draw_big_variometer(27, 8, naviData.Variometer);
		89	}
		90
		91	// pre-bottom line
		92	if (COSD_FLAGS_RUNTIME & COSD_FLAG_STROMREC) {
		93	//write_ndigit_number_s(3, bottom_line - 1, ampere, 4, 0);
		94	write_ndigit_number_u_10th(3, bottom_line - 1, ampere / 10, 3, 0);
		95	write_ndigit_number_s(10, bottom_line - 1, ampere_wasted / 10, 4, 0);
		96	}
		97
		98	// bottom line
		99	draw_battery(2, bottom_line, min_voltage, naviData.UBat, max_voltage);
		100	write_ndigit_number_u_10th(3, bottom_line, naviData.UBat, 3, 0);
		101	if (naviData.UBat <= min_voltage && last_UBat > min_voltage) {
		102	for (uint8_t x = 2; x < 8; x++)
		103	write_char_att_xy(x, bottom_line, BLINK);
		104	} else if (naviData.UBat > min_voltage && last_UBat < min_voltage) {
		105	for (uint8_t x = 2; x < 8; x++)
		106	write_char_att_xy(x, bottom_line, 0);
		107	}
		108
		109	write_time(11, bottom_line, naviData.FlyingTime);
		110
		111	write_ndigit_number_u(24, bottom_line, naviData.SatsInUse, 2, 0);
		112
		113	if (naviData.NCFlags & NC_FLAG_CH) {
		114	write_char_xy(27, bottom_line, 231); // gps ch
		115	} else if (naviData.NCFlags & NC_FLAG_PH) {
		116	write_char_xy(27, bottom_line, 230); // gps ph
		117	} else { // (naviData.NCFlags & NC_FLAG_FREE)
		118	write_char_xy(27, bottom_line, 201); // sat2 (free)
		119	}
		120	}
		121
		122	// remember statistics (only when engines running)
2039	-	123	if (naviData.FCStatusFlags & FCFLAG_MOTOR_RUN) {
952	-	124	if (COSD_FLAGS_CONFIG & COSD_FLAG_GPSHEIGHT) {
		125	if (naviData.CurrentPosition.Altitude / 1000 - altimeter_offset > max_Altimeter) max_Altimeter = naviData.CurrentPosition.Altitude / 1000;
		126	} else {
		127	if (naviData.Altimeter / 20 > max_Altimeter) max_Altimeter = naviData.Altimeter / 20;
		128	}
761	-	129	if (naviData.GroundSpeed > max_GroundSpeed) max_GroundSpeed = naviData.GroundSpeed;
		130	if (naviData.HomePositionDeviation.Distance > max_Distance) {
		131	max_Distance = naviData.HomePositionDeviation.Distance;
		132	}
		133	if (naviData.UBat < min_UBat) min_UBat = naviData.UBat;
		134	if (naviData.FlyingTime > max_FlyingTime) max_FlyingTime = naviData.FlyingTime;
952	-	135	if ((COSD_FLAGS_RUNTIME & COSD_FLAG_STROMREC) && !(COSD_FLAGS_MODES & COSD_FLAG_FCCURRENT)) {
		136	if (ampere > max_ampere) max_ampere = ampere;
		137	} else if (COSD_FLAGS_MODES & COSD_FLAG_FCCURRENT) {
		138	if (naviData.Current * 10 > max_ampere) max_ampere = naviData.Current * 10;
		139	}
761	-	140	}
		141
		142	// remember last values
952	-	143	last_RC_Quality = naviData.RC_Quality;
761	-	144	last_UBat = naviData.UBat;
2039	-	145	old_MKFlags = naviData.FCStatusFlags;
952	-	146	old_NCFlags = naviData.NCFlags;
761	-	147	seconds_since_last_data = 0;
		148
		149	return 0;
497	cascade	150	}
		151
		152	#endif

Subversion Repositories Projects

(root)/C-OSD/trunk/osd_ncmode_minimal.c - Rev 2039