(root)/C-OSD/trunk/osd_fcmode_default.c - Rev 2536
Rev 2099 |
Go to most recent revision |
Blame |
Compare with Previous |
Last modification |
View Log
| RSS feed
/****************************************************************************
* Copyright (C) 2009-2016 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_fcmode_default.h"
#include "usart1.h"
#if (!(ALLCHARSDEBUG || (WRITECHARS != -1)) && FCONLY)
int osd_fcmode_default
() {
static signed int rc_quality
= 0;
#ifndef ACT_RSSI_FROM_LCD
rc_quality
= debugData.
Analog[10];
#endif
if (!(COSD_FLAGS_MODES
& COSD_FLAG_HUD
)) {
clear
();
} else {
// write icons at init or after menu/mode-switch
if (!(COSD_FLAGS_RUNTIME
& COSD_ICONS_WRITTEN
)) {
write_char_xy
(10, top_line
, 0xCA); // RC-transmitter
write_char_xy
(27, top_line
, 0xCC); // small meters m height
write_char_xy
(7, bottom_line
, 0x9E); // small v
if (COSD_FLAGS_RUNTIME
& 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_MODES
& COSD_FLAG_STROMVOLT
) {
write_char_xy
(21, bottom_line
- 1, 0x9E); // small V
}
}
COSD_FLAGS_RUNTIME
|= COSD_ICONS_WRITTEN
;
}
write_ndigit_number_u
(7, top_line
, rc_quality
, 3, 0);
if (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 (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 (debugData.
Analog[5] > 200 || debugData.
Analog[5] < -200) {
// above 10m only write full meters
write_ndigit_number_s
(23, top_line
, debugData.
Analog[5] / 20, 4, 0);
} else {
// up to 10m write meters.dm
write_ndigit_number_s_10th
(23, top_line
, debugData.
Analog[5] / 2, 3, 0);
}
if (debugData.
Analog[5] > max_Altimeter
) max_Altimeter
= debugData.
Analog[5];
if (COSD_FLAGS_MODES
& COSD_FLAG_ARTHORIZON
) {
draw_artificial_horizon
(top_line
+ 2, bottom_line
- 1, debugData.
Analog[0], debugData.
Analog[1]);
}
// pre-bottom line
if (COSD_FLAGS_RUNTIME
& 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_MODES
& COSD_FLAG_STROMVOLT
) {
write_ndigit_number_u_10th
(17, bottom_line
- 1, s_volt
, 3, 0);
}
}
draw_battery
(2, bottom_line
, min_voltage
, debugData.
Analog[9], max_voltage
);
write_ndigit_number_u_10th
(3, bottom_line
, debugData.
Analog[9], 3, 0);
if (debugData.
Analog[9] <= min_voltage
&& last_UBat
> min_voltage
) {
for (uint8_t x
= 2; x
< 8; x
++)
write_char_att_xy
(x
, bottom_line
, BLINK
);
} else if (debugData.
Analog[9] > min_voltage
&& last_UBat
< min_voltage
) {
for (uint8_t x
= 2; x
< 8; x
++)
write_char_att_xy
(x
, bottom_line
, 0);
}
}
// remember last values
last_UBat
= debugData.
Analog[9];
last_RC_Quality
= debugData.
Analog[10];
/*
debugData.Analog[0]); // AngleNick
debugData.Analog[1]); // AngleRoll
debugData.Analog[5]); // Height
debugData.Analog[9]); // Voltage
debugData.Analog[10]);// RC Signal
debugData.Analog[11]);// Gyro compass
*/
seconds_since_last_data
= 0;
//
// really dirty way to get the RSSI out of the display
#ifdef ACT_RSSI_FROM_LCD
#define REQUEST_FC_LCD_8 "#al?===Dc\r"
usart1_request_blocking
('L', PSTR
(REQUEST_FC_LCD_8
));
char* str
= ((char*)pRxData
) + 2;
/*
write_ascii_string_len(2, 5, str, 20);
write_ascii_string_len(2, 6, str + 20, 20);
write_ascii_string_len(2, 7, str + 40, 20);
write_ascii_string_len(2, 8, str + 60, 20);
*/
uint8_t rssi_index
= 30; // middle of 2nd line
while (str
[rssi_index
] == ' ') rssi_index
++;
str
+= rssi_index
;
int lcd_rssi
= atoi(str
);
write_ndigit_number_u
(7, top_line
, lcd_rssi
, 3, 0);
rc_quality
= lcd_rssi
;
#endif
return 0;
}
#endif