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

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

Subversion Repositories Projects

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