rooty/LibrePilot
1
0
Fork 0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2024-12-01 09:24:10 +01:00
Code Issues Releases Activity

LP-609 Add menu per sensor used

Browse Source
This commit is contained in:
Laurent Lalanne 2019-02-21 13:54:25 +01:00
parent 6d9b9eb08a
commit 63cedc16c0
2 changed files with 644 additions and 174 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

170
flight/modules/UAVOHottBridge/inc/uavohottbridge.h
View File

@ -30,101 +30,102 @@
*/ */
// timing variables // timing variables
#define IDLE_TIME 10 // idle line delay to prevent data crashes on telemetry line. #define IDLE_TIME 10 // idle line delay to prevent data crashes on telemetry line.
#define DATA_TIME 3 // time between 2 transmitted bytes #define DATA_TIME 3 // time between 2 transmitted bytes
// sizes and lengths // sizes and lengths
#define climbratesize 50 // defines size of ring buffer for climbrate calculation #define climbratesize 50 // defines size of ring buffer for climbrate calculation
#define statussize 21 // number of characters in status line #define statussize 21 // number of characters in status line
#define HOTT_MAX_MESSAGE_LENGTH 200 #define HOTT_MAX_MESSAGE_LENGTH 200
// scale factors // scale factors
#define M_TO_CM 100 // scale m to cm or m/s to cm/s #define M_TO_CM 100 // scale m to cm or m/s to cm/s
#define MS_TO_KMH 3.6f // scale m/s to km/h #define MS_TO_KMH 3.6f // scale m/s to km/h
#define DEG_TO_UINT 0.5f // devide degrees by 2. then the value fits into a byte. #define DEG_TO_UINT 0.5f // devide degrees by 2. then the value fits into a byte.
// offsets. used to make transmitted values unsigned. // offsets. used to make transmitted values unsigned.
#define OFFSET_ALTITUDE 500 // 500m #define OFFSET_ALTITUDE 500 // 500m
#define OFFSET_CLIMBRATE 30000 // 30000cm/s or 300m/s #define OFFSET_CLIMBRATE 30000 // 30000cm/s or 300m/s
#define OFFSET_CLIMBRATE3S 120 // 120m/s #define OFFSET_CLIMBRATE3S 120 // 120m/s
#define OFFSET_TEMPERATURE 20 // 20 degrees #define OFFSET_TEMPERATURE 20 // 20 degrees
// Bits to invert display areas or values // Bits to invert display areas or values
#define VARIO_INVERT_ALT (1 << 0) // altitude #define VARIO_INVERT_ALT (1 << 0) // altitude
#define VARIO_INVERT_MAX (1 << 1) // max altitude #define VARIO_INVERT_MAX (1 << 1) // max altitude
#define VARIO_INVERT_MIN (1 << 2) // min altitude #define VARIO_INVERT_MIN (1 << 2) // min altitude
#define VARIO_INVERT_CR1S (1 << 3) // climbrate 1s #define VARIO_INVERT_CR1S (1 << 3) // climbrate 1s
#define VARIO_INVERT_CR3S (1 << 4) // climbrate 3s #define VARIO_INVERT_CR3S (1 << 4) // climbrate 3s
#define VARIO_INVERT_CR10S (1 << 5) // climbrate 10s #define VARIO_INVERT_CR10S (1 << 5) // climbrate 10s
#define GPS_INVERT_HDIST (1 << 0) // home distance #define GPS_INVERT_HDIST (1 << 0) // home distance
#define GPS_INVERT_SPEED (1 << 1) // speed (kmh) #define GPS_INVERT_SPEED (1 << 1) // speed (kmh)
#define GPS_INVERT_ALT (1 << 2) // altitude #define GPS_INVERT_ALT (1 << 2) // altitude
#define GPS_INVERT_CR1S (1 << 3) // climbrate 1s #define GPS_INVERT_CR1S (1 << 3) // climbrate 1s
#define GPS_INVERT_CR3S (1 << 4) // climbrate 3s #define GPS_INVERT_CR3S (1 << 4) // climbrate 3s
#define GPS_INVERT2_POS (1 << 0) // GPS postion values #define GPS_INVERT2_POS (1 << 0) // GPS postion values
#define GAM_INVERT_CELL (1 << 0) // cell voltage #define GAM_INVERT_CELL (1 << 0) // cell voltage
#define GAM_INVERT_BATT1 (1 << 1) // battery 1 voltage #define GAM_INVERT_BATT1 (1 << 1) // battery 1 voltage
#define GAM_INVERT_BATT2 (1 << 2) // battery 1 voltage #define GAM_INVERT_BATT2 (1 << 2) // battery 1 voltage
#define GAM_INVERT_TEMP1 (1 << 3) // temperature 1 #define GAM_INVERT_TEMP1 (1 << 3) // temperature 1
#define GAM_INVERT_TEMP2 (1 << 4) // temperature 2 #define GAM_INVERT_TEMP2 (1 << 4) // temperature 2
#define GAM_INVERT_FUEL (1 << 5) // fuel #define GAM_INVERT_FUEL (1 << 5) // fuel
#define GAM_INVERT2_CURRENT (1 << 0) // current #define GAM_INVERT2_CURRENT (1 << 0) // current
#define GAM_INVERT2_VOLTAGE (1 << 1) // voltage #define GAM_INVERT2_VOLTAGE (1 << 1) // voltage
#define GAM_INVERT2_ALT (1 << 2) // altitude #define GAM_INVERT2_ALT (1 << 2) // altitude
#define GAM_INVERT2_CR1S (1 << 3) // climbrate 1s #define GAM_INVERT2_CR1S (1 << 3) // climbrate 1s
#define GAM_INVERT2_CR3S (1 << 4) // climbrate 3s #define GAM_INVERT2_CR3S (1 << 4) // climbrate 3s
#define EAM_INVERT_CAPACITY (1 << 0) // capacity #define EAM_INVERT_CAPACITY (1 << 0) // capacity
#define EAM_INVERT_BATT1 (1 << 1) // battery 1 voltage #define EAM_INVERT_BATT1 (1 << 1) // battery 1 voltage
#define EAM_INVERT_BATT2 (1 << 2) // battery 1 voltage #define EAM_INVERT_BATT2 (1 << 2) // battery 1 voltage
#define EAM_INVERT_TEMP1 (1 << 3) // temperature 1 #define EAM_INVERT_TEMP1 (1 << 3) // temperature 1
#define EAM_INVERT_TEMP2 (1 << 4) // temperature 2 #define EAM_INVERT_TEMP2 (1 << 4) // temperature 2
#define EAM_INVERT_ALT (1 << 5) // altitude #define EAM_INVERT_ALT (1 << 5) // altitude
#define EAM_INVERT_CURRENT (1 << 6) // current #define EAM_INVERT_CURRENT (1 << 6) // current
#define EAM_INVERT_VOLTAGE (1 << 7) // voltage #define EAM_INVERT_VOLTAGE (1 << 7) // voltage
#define EAM_INVERT2_ALT (1 << 2) // altitude #define EAM_INVERT2_ALT (1 << 2) // altitude
#define EAM_INVERT2_CR1S (1 << 3) // climbrate 1s #define EAM_INVERT2_CR1S (1 << 3) // climbrate 1s
#define EAM_INVERT2_CR3S (1 << 4) // climbrate 3s #define EAM_INVERT2_CR3S (1 << 4) // climbrate 3s
#define ESC_INVERT_VOLTAGE (1 << 0) // voltage #define ESC_INVERT_VOLTAGE (1 << 0) // voltage
#define ESC_INVERT_TEMP1 (1 << 1) // temperature 1 #define ESC_INVERT_TEMP1 (1 << 1) // temperature 1
#define ESC_INVERT_TEMP2 (1 << 2) // temperature 2 #define ESC_INVERT_TEMP2 (1 << 2) // temperature 2
#define ESC_INVERT_CURRENT (1 << 3) // current #define ESC_INVERT_CURRENT (1 << 3) // current
#define ESC_INVERT_RPM (1 << 4) // rpm #define ESC_INVERT_RPM (1 << 4) // rpm
#define ESC_INVERT_CAPACITY (1 << 5) // capacity #define ESC_INVERT_CAPACITY (1 << 5) // capacity
#define ESC_INVERT_MAXCURRENT (1 << 6) // maximum current #define ESC_INVERT_MAXCURRENT (1 << 6) // maximum current
// message codes // message codes
#define HOTT_TEXT_ID 0x7f // Text request #define HOTT_TEXT_ID 0x7f // Text request
#define HOTT_BINARY_ID 0x80 // Binary request #define HOTT_BINARY_ID 0x80 // Binary request
#define HOTT_VARIO_ID 0x89 // Vario Module ID #define HOTT_VARIO_ID 0x89 // Vario Module ID
#define HOTT_VARIO_TEXT_ID 0x90 // Vario Module TEXT ID #define HOTT_VARIO_TEXT_ID 0x90 // Vario Module TEXT ID
#define HOTT_GPS_ID 0x8a // GPS Module ID #define HOTT_GPS_ID 0x8a // GPS Module ID
#define HOTT_GPS_TEXT_ID 0xa0 // GPS Module TEXT ID #define HOTT_GPS_TEXT_ID 0xa0 // GPS Module TEXT ID
#define HOTT_ESC_ID 0x8c // ESC Module ID #define HOTT_ESC_ID 0x8c // ESC Module ID
#define HOTT_ESC_TEXT_ID 0xc0 // ESC Module TEXT ID #define HOTT_ESC_TEXT_ID 0xc0 // ESC Module TEXT ID
#define HOTT_GAM_ID 0x8d // General Air Module ID #define HOTT_GAM_ID 0x8d // General Air Module ID
#define HOTT_GAM_TEXT_ID 0xd0 // General Air Module TEXT ID #define HOTT_GAM_TEXT_ID 0xd0 // General Air Module TEXT ID
#define HOTT_EAM_ID 0x8e // Electric Air Module ID #define HOTT_EAM_ID 0x8e // Electric Air Module ID
#define HOTT_EAM_TEXT_ID 0xe0 // Electric Air Module TEXT ID #define HOTT_EAM_TEXT_ID 0xe0 // Electric Air Module TEXT ID
#define HOTT_TEXT_START 0x7b // Start byte Text mode #define HOTT_TEXT_START 0x7b // Start byte Text mode
#define HOTT_START 0x7c // Start byte Binary mode #define HOTT_START 0x7c // Start byte Binary mode
#define HOTT_STOP 0x7d // End byte #define HOTT_STOP 0x7d // End byte
#define HOTT_BUTTON_DEC 0xEB // minus button
#define HOTT_BUTTON_INC 0xED // plus button
#define HOTT_BUTTON_SET 0xE9 // set button
#define HOTT_BUTTON_NIL 0x0F // esc button
#define HOTT_BUTTON_NEXT 0xEE // next button
#define HOTT_BUTTON_PREV 0xE7 // previous button
// prefined signal tones or spoken announcments #define HOTT_BUTTON_DEC 0xEB // minus button
#define HOTT_BUTTON_INC 0xED // plus button
#define HOTT_BUTTON_SET 0xE9 // set button
#define HOTT_BUTTON_NIL 0x0F // esc button
#define HOTT_BUTTON_NEXT 0xEE // next button
#define HOTT_BUTTON_PREV 0xE7 // previous button
// prefined signal tones or spoken announcements
#define HOTT_TONE_A 1 // minimum speed #define HOTT_TONE_A 1 // minimum speed
#define HOTT_TONE_B 2 // sink rate 3 seconds #define HOTT_TONE_B 2 // sink rate 3 seconds
#define HOTT_TONE_C 3 // sink rate 1 second #define HOTT_TONE_C 3 // sink rate 1 second
#define HOTT_TONE_D 4 // maximum distance #define HOTT_TONE_D 4 // maximum distance
#define HOTT_TONE_E 5 // - #define HOTT_TONE_E 5 // low signal
#define HOTT_TONE_F 6 // minimum temperature sensor 1 #define HOTT_TONE_F 6 // minimum temperature sensor 1
#define HOTT_TONE_G 7 // minimum temperature sensor 2 #define HOTT_TONE_G 7 // minimum temperature sensor 2
#define HOTT_TONE_H 8 // maximum temperature sensor 1 #define HOTT_TONE_H 8 // maximum temperature sensor 1
@ -207,8 +208,9 @@ struct telemetrydata {
}; };
// HoTT menu // HoTT menu
static const char *const hottPageTitle[] = { static const char *const hottTextPageTitle[] = {
"***LIBREPILOT Hott***", "***LIBREPILOT Hott***",
"*****GPS CONFIG******",
"-----VARIO PAGE------", "-----VARIO PAGE------",
"------GPS PAGE-------", "------GPS PAGE-------",
"--GENERAL AIR PAGE---", "--GENERAL AIR PAGE---",
@ -217,15 +219,21 @@ static const char *const hottPageTitle[] = {
}; };
typedef enum { typedef enum {
HOTTPAGE_MAIN = 0, HOTTTEXT_PAGE_MAIN = 0,
HOTTPAGE_VARIO = 1, HOTTTEXT_PAGE_GPSCONFIG = 1,
HOTTPAGE_GPS = 2, HOTTTEXT_PAGE_VARIO = 2,
HOTTPAGE_GENERAL = 3, HOTTTEXT_PAGE_GPS = 3,
HOTTPAGE_ELECTRIC = 4, HOTTTEXT_PAGE_GENERAL = 4,
HOTTPAGE_ESC = 5, HOTTTEXT_PAGE_ELECTRIC = 5,
} hottPageElem; HOTTTEXT_PAGE_ESC = 6,
} hottTextPageElem;
#define HOTTPAGE_NUMELEM 6 #define HOTTTEXT_PAGE_NUMELEM 7
struct hotttext_edit_status {
bool stored;
uint8_t newstep;
};
// VARIO Module message structure // VARIO Module message structure
struct hott_vario_message { struct hott_vario_message {

648
flight/modules/UAVOHottBridge/uavohottbridge.c
View File

@ -53,6 +53,8 @@
#include "hottbridgestatus.h" #include "hottbridgestatus.h"
#include "hottbridgesettings.h" #include "hottbridgesettings.h"
#include "revosettings.h" #include "revosettings.h"
#include "gpssettings.h"
#include "homelocation.h"
#include "objectpersistence.h" #include "objectpersistence.h"
#include "pios_sensors.h" #include "pios_sensors.h"
#include "uavohottbridge.h" #include "uavohottbridge.h"
@ -82,9 +84,13 @@ static uint16_t build_GPS_message(struct hott_gps_message *msg);
static uint16_t build_GAM_message(struct hott_gam_message *msg); static uint16_t build_GAM_message(struct hott_gam_message *msg);
static uint16_t build_EAM_message(struct hott_eam_message *msg); static uint16_t build_EAM_message(struct hott_eam_message *msg);
static uint16_t build_ESC_message(struct hott_esc_message *msg); static uint16_t build_ESC_message(struct hott_esc_message *msg);
static uint16_t build_TEXT_message(struct hott_text_message *msg, uint8_t page, uint8_t current_line, bool edit_line, bool exit_menu); static bool build_TEXT_message(struct hott_text_message *msg, uint8_t page, uint8_t current_line, int8_t value_change, uint8_t step_change, bool edit_line, bool exit_menu);
static char *reverse_pixels(char *line, uint8_t from_char, uint8_t to_char);
static uint8_t get_page(uint8_t page, bool next);
static int16_t get_new_value(int16_t current_value, int8_t value_change, uint8_t step, int16_t min, int16_t max);
static uint8_t calc_checksum(uint8_t *data, uint16_t size); static uint8_t calc_checksum(uint8_t *data, uint16_t size);
static uint8_t generate_warning(); static uint8_t generate_warning();
static void store_settings(uint8_t page);
static void update_telemetrydata(); static void update_telemetrydata();
static void convert_long2gps(int32_t value, uint8_t *dir, uword_t *min, uword_t *sec); static void convert_long2gps(int32_t value, uint8_t *dir, uword_t *min, uword_t *sec);
static uint8_t scale_float2uint8(float value, float scale, float offset); static uint8_t scale_float2uint8(float value, float scale, float offset);
@ -202,59 +208,100 @@ static void uavoHoTTBridgeTask(__attribute__((unused)) void *parameters)
} }
} else if (rx_buffer[1] == HOTT_TEXT_ID) { } else if (rx_buffer[1] == HOTT_TEXT_ID) {
// first received byte looks like a text request. check second received byte for a valid button. // first received byte looks like a text request. check second received byte for a valid button.
uint8_t id_key = rx_buffer[0] & 0x0F; uint8_t id_key = rx_buffer[0] & 0x0F;
uint8_t id_sensor = rx_buffer[0] >> 4; uint8_t id_sensor = rx_buffer[0] >> 4;
bool exit_menu = false; static bool edit_line = false;
bool refresh = true; bool exit_menu = false;
bool edit_line = false; bool is_saved = false;
// define allowed edited lines for Main, Vario, Gps, General, Electric and Esc pages int8_t value_change = 0;
uint8_t min_line[] = { 2, 2, 0, 0, 0 }; static uint8_t step_change = 0;
uint8_t max_line[] = { 6, 2, 0, 0, 0 };
static uint8_t page = HOTTPAGE_MAIN; // define allowed edited lines for Main, GPS config, Vario, Gps, General, Electric and Esc pages
uint8_t min_line[] = { 2, 2, 2, 2, 2, 2, 2 };
uint8_t max_line[] = { 6, 5, 7, 7, 7, 7, 7 };
static uint8_t page = HOTTTEXT_PAGE_MAIN;
static uint8_t last_page = 0; static uint8_t last_page = 0;
static uint8_t current_line = 0; static uint8_t current_line = 0;
// select page to display from text request // select page to display from text request
switch (id_sensor) { switch (id_sensor) {
case (HOTT_VARIO_ID & 0x0f): case (HOTT_VARIO_ID & 0x0f):
page = HOTTPAGE_VARIO; page = HOTTTEXT_PAGE_VARIO;
break; break;
case (HOTT_GPS_ID & 0x0f): case (HOTT_GPS_ID & 0x0f):
page = HOTTPAGE_GPS; page = HOTTTEXT_PAGE_GPS;
break; break;
case (HOTT_GAM_ID & 0x0f): case (HOTT_GAM_ID & 0x0f):
page = HOTTPAGE_GENERAL; page = HOTTTEXT_PAGE_GENERAL;
break; break;
case (HOTT_EAM_ID & 0x0f): case (HOTT_EAM_ID & 0x0f):
page = HOTTPAGE_ELECTRIC; page = HOTTTEXT_PAGE_ELECTRIC;
break; break;
case (HOTT_ESC_ID & 0x0f): case (HOTT_ESC_ID & 0x0f):
page = HOTTPAGE_ESC; page = HOTTTEXT_PAGE_ESC;
} }
// menu keys // menu keys
switch (id_key) { if (edit_line) {
case HOTT_KEY_DEC: // up switch (id_key) {
current_line--; case HOTT_KEY_DEC: // up
break; value_change--;
case HOTT_KEY_INC: // down break;
current_line++; case HOTT_KEY_INC: // down
break; value_change++;
case HOTT_KEY_PREV: // left break;
exit_menu = (page == 0) ? true : false; case HOTT_KEY_PREV: // left
page--; if (step_change < 3 ) {
break; step_change++;
case HOTT_KEY_NEXT: // right }
exit_menu = false; break;
case HOTT_KEY_NEXT: // right
if (step_change > 0) {
step_change--;
}
break;
case HOTT_KEY_SET: // Set
value_change = 0;
step_change = 0;
if (!is_saved) {
store_settings(page);
edit_line = false; // exit edit mode
}
break;
default:
value_change = 0;
}
} else {
switch (id_key) {
case HOTT_KEY_DEC: // up
current_line--;
break;
case HOTT_KEY_INC: // down
current_line++;
break;
case HOTT_KEY_PREV: // left
exit_menu = (page == HOTTTEXT_PAGE_MAIN) ? true : false;
page = get_page(page, false);
break;
case HOTT_KEY_NEXT: // right
exit_menu = false;
current_line = 0;
page = get_page(page, true);
break;
case HOTT_KEY_SET: // Set
edit_line = true; // enter edit mode
break;
}
}
// new page
if (page != last_page) {
last_page = page;
current_line = 0; current_line = 0;
page++; edit_line = false;
break;
case HOTT_KEY_SET: // Set
edit_line = true;
break;
} }
// keep current line between min/max limits // keep current line between min/max limits
@ -265,18 +312,14 @@ static void uavoHoTTBridgeTask(__attribute__((unused)) void *parameters)
current_line = min_line[page]; current_line = min_line[page];
} }
if (page > (HOTTPAGE_NUMELEM - 1)) { status.RxFail = step_change;
page = HOTTPAGE_MAIN; status.TxFail = value_change;
}
if (page != last_page) {
current_line = 0;
last_page = page;
}
// prevent double call and tx already in progress is_saved = build_TEXT_message((struct hott_text_message *)tx_buffer, page, current_line, value_change, step_change, edit_line, exit_menu);
if (refresh && (message_size == 0)) { message_size = sizeof(tx_buffer);
message_size = build_TEXT_message((struct hott_text_message *)tx_buffer, page, current_line, edit_line, exit_menu); if (is_saved) {
refresh = false; // is already saved, exit edit mode
edit_line = false;
} }
} }
@ -636,7 +679,7 @@ uint16_t build_ESC_message(struct hott_esc_message *msg)
msg->warning = 0; msg->warning = 0;
msg->sensor_text_id = HOTT_ESC_TEXT_ID; msg->sensor_text_id = HOTT_ESC_TEXT_ID;
// main batterie // main battery
float voltage = (telestate->Battery.Voltage > 0) ? telestate->Battery.Voltage : 0; float voltage = (telestate->Battery.Voltage > 0) ? telestate->Battery.Voltage : 0;
float current = (telestate->Battery.Current > 0) ? telestate->Battery.Current : 0; float current = (telestate->Battery.Current > 0) ? telestate->Battery.Current : 0;
float max_current = (telestate->Battery.PeakCurrent > 0) ? telestate->Battery.PeakCurrent : 0; float max_current = (telestate->Battery.PeakCurrent > 0) ? telestate->Battery.PeakCurrent : 0;
@ -656,7 +699,7 @@ uint16_t build_ESC_message(struct hott_esc_message *msg)
return sizeof(*msg); return sizeof(*msg);
} }
uint16_t build_TEXT_message(struct hott_text_message *msg, uint8_t page, uint8_t current_line, bool edit_line, bool exit_menu) bool build_TEXT_message(struct hott_text_message *msg, uint8_t page, uint8_t current_line, int8_t value_change, uint8_t step, bool edit_mode, bool exit_menu)
{ {
// clear message buffer // clear message buffer
memset(msg, 0, sizeof(*msg)); memset(msg, 0, sizeof(*msg));
@ -668,24 +711,80 @@ uint16_t build_TEXT_message(struct hott_text_message *msg, uint8_t page, uint8_t
msg->warning = 0; msg->warning = 0;
HoTTBridgeSettingsSensorData sensor; HoTTBridgeSettingsSensorData sensor;
HoTTBridgeSettingsLimitData alarmLimits;
HoTTBridgeSettingsWarningData alarmWarning;
RevoSettingsFusionAlgorithmOptions revoFusionAlgo; RevoSettingsFusionAlgorithmOptions revoFusionAlgo;
bool ekf_enabled = false; HomeLocationSetOptions homeSet;
GPSSettingsData gpsSettings;
if (HoTTBridgeSettingsHandle() != NULL) { bool storedtoflash = false;
HoTTBridgeSettingsSensorGet(&sensor); bool ekf_enabled = false;
}
if (RevoSettingsHandle() != NULL) {
RevoSettingsFusionAlgorithmGet(&revoFusionAlgo);
}
char *txt_fusionalgo = "";
// page title // page title
snprintf(msg->text[0], HOTT_TEXT_COLUMNS, "%s", hottPageTitle[page]); // line 1 snprintf(msg->text[0], HOTT_TEXT_COLUMNS, "%s", hottTextPageTitle[page]); // line 1
// compute page content // compute page content
switch (page) { switch (page) {
case HOTTPAGE_VARIO: // Vario page case HOTTTEXT_PAGE_VARIO: // Vario page
if (RevoSettingsHandle() != NULL) {
RevoSettingsFusionAlgorithmGet(&revoFusionAlgo);
}
if (HoTTBridgeSettingsHandle() != NULL) {
HoTTBridgeSettingsWarningGet(&alarmWarning);
HoTTBridgeSettingsLimitGet(&alarmLimits);
}
bool edit_altitudebeep = (edit_mode && (current_line == 2));
bool edit_maxheight = (edit_mode && (current_line == 3));
bool edit_minheight = (edit_mode && (current_line == 4));
bool edit_minheight_value = (edit_mode && (current_line == 5));
bool edit_maxheight_value = (edit_mode && (current_line == 6));
if (edit_altitudebeep) {
if (alarmWarning.AltitudeBeep == HOTTBRIDGESETTINGS_WARNING_DISABLED) {
alarmWarning.AltitudeBeep = HOTTBRIDGESETTINGS_WARNING_ENABLED;
} else {
alarmWarning.AltitudeBeep = HOTTBRIDGESETTINGS_WARNING_DISABLED;
}
HoTTBridgeSettingsWarningSet(&alarmWarning);
UAVObjSave(HoTTBridgeSettingsHandle(), 0);
storedtoflash = true;
}
if (edit_minheight) {
if (alarmWarning.MinHeight == HOTTBRIDGESETTINGS_WARNING_DISABLED) {
alarmWarning.MinHeight = HOTTBRIDGESETTINGS_WARNING_ENABLED;
} else {
alarmWarning.MinHeight = HOTTBRIDGESETTINGS_WARNING_DISABLED;
}
HoTTBridgeSettingsWarningSet(&alarmWarning);
UAVObjSave(HoTTBridgeSettingsHandle(), 0);
storedtoflash = true;
}
if (edit_maxheight) {
if (alarmWarning.MaxHeight == HOTTBRIDGESETTINGS_WARNING_DISABLED) {
alarmWarning.MaxHeight = HOTTBRIDGESETTINGS_WARNING_ENABLED;
} else {
alarmWarning.MaxHeight = HOTTBRIDGESETTINGS_WARNING_DISABLED;
}
HoTTBridgeSettingsWarningSet(&alarmWarning);
UAVObjSave(HoTTBridgeSettingsHandle(), 0);
storedtoflash = true;
}
if (edit_minheight_value) {
step = (step > 2) ? 2 : step;
// -500 to 500m
alarmLimits.MinHeight = get_new_value((int16_t)alarmLimits.MinHeight, value_change, step, -500, 500);
HoTTBridgeSettingsLimitSet(&alarmLimits);
}
if (edit_maxheight_value) {
step = (step > 2) ? 2 : step;
// -500 to 1500m
alarmLimits.MaxHeight = get_new_value((int16_t)alarmLimits.MaxHeight, value_change, step, -500, 1500);
HoTTBridgeSettingsLimitSet(&alarmLimits);
}
char *txt_fusionalgo = "";
// check current algo status // check current algo status
switch (revoFusionAlgo) { switch (revoFusionAlgo) {
case REVOSETTINGS_FUSIONALGORITHM_INS13INDOOR: case REVOSETTINGS_FUSIONALGORITHM_INS13INDOOR:
@ -705,7 +804,7 @@ uint16_t build_TEXT_message(struct hott_text_message *msg, uint8_t page, uint8_t
txt_fusionalgo = " * BASIC ALGO * "; txt_fusionalgo = " * BASIC ALGO * ";
ekf_enabled = false; ekf_enabled = false;
} }
if (edit_line && (current_line == 2)) { if (edit_mode && (current_line == 7)) {
// check if a GPS is available // check if a GPS is available
bool gps_ok = (telestate->SysAlarms.Alarm.GPS != SYSTEMALARMS_ALARM_UNINITIALISED) && (telestate->SysAlarms.Alarm.GPS != SYSTEMALARMS_ALARM_ERROR); bool gps_ok = (telestate->SysAlarms.Alarm.GPS != SYSTEMALARMS_ALARM_UNINITIALISED) && (telestate->SysAlarms.Alarm.GPS != SYSTEMALARMS_ALARM_ERROR);
if (gps_ok) { if (gps_ok) {
@ -724,37 +823,267 @@ uint16_t build_TEXT_message(struct hott_text_message *msg, uint8_t page, uint8_t
} }
RevoSettingsFusionAlgorithmSet(&revoFusionAlgo); RevoSettingsFusionAlgorithmSet(&revoFusionAlgo);
UAVObjSave(RevoSettingsHandle(), 0); UAVObjSave(RevoSettingsHandle(), 0);
storedtoflash = true;
} }
char *ekf_status = (ekf_enabled) ? "*" : " "; snprintf(msg->text[1], HOTT_TEXT_COLUMNS, " Altitude speak [%1s] ", ((alarmWarning.AltitudeBeep == HOTTBRIDGESETTINGS_WARNING_DISABLED) ? " " : "*")); // line 2
snprintf(msg->text[2], HOTT_TEXT_COLUMNS, " MaxHeight warn [%1s] ", ((alarmWarning.MaxHeight == HOTTBRIDGESETTINGS_WARNING_DISABLED) ? " " : "*")); // line 3
snprintf(msg->text[3], HOTT_TEXT_COLUMNS, " MinHeight warn [%1s] ", ((alarmWarning.MinHeight == HOTTBRIDGESETTINGS_WARNING_DISABLED) ? " " : "*")); // line 4
snprintf(msg->text[4], HOTT_TEXT_COLUMNS, " Max height %4d ", (int16_t)alarmLimits.MaxHeight); // line 5
snprintf(msg->text[5], HOTT_TEXT_COLUMNS, " Min height %4d ", (int16_t)alarmLimits.MinHeight); // line 6
snprintf(msg->text[6], HOTT_TEXT_COLUMNS, " Use EKF algo [%1s] ", ((ekf_enabled) ? "*" : " ")); // line 7
snprintf(msg->text[7], HOTT_TEXT_COLUMNS, "%s", txt_fusionalgo); // line 8
if (current_line > 1) {
msg->text[current_line - 1][0] = '>';
}
snprintf(msg->text[1], HOTT_TEXT_COLUMNS, " Use EKF algo [%1s] ", ekf_status); // line 2 if (edit_minheight_value) {
snprintf(msg->text[2], HOTT_TEXT_COLUMNS, " "); // line 3 reverse_pixels((char *)msg->text[current_line - 1], 16 + (3 - step), 20 - step);
snprintf(msg->text[3], HOTT_TEXT_COLUMNS, "%s", txt_fusionalgo); // line 4 }
snprintf(msg->text[4], HOTT_TEXT_COLUMNS, " "); // line 5 if (edit_maxheight_value) {
snprintf(msg->text[5], HOTT_TEXT_COLUMNS, " WARNING!! "); // line 6 reverse_pixels((char *)msg->text[current_line - 1], 16 + (3 - step), 20 - step);
snprintf(msg->text[6], HOTT_TEXT_COLUMNS, " This overwrites "); // line 7 }
snprintf(msg->text[7], HOTT_TEXT_COLUMNS, " algo settings "); // line 8 break;
case HOTTTEXT_PAGE_GPS: // GPS page
if (HoTTBridgeSettingsHandle() != NULL) {
HoTTBridgeSettingsWarningGet(&alarmWarning);
HoTTBridgeSettingsLimitGet(&alarmLimits);
}
bool edit_maxdistance = (edit_mode && (current_line == 2));
bool edit_maxspeed = (edit_mode && (current_line == 3));
bool edit_minspeed = (edit_mode && (current_line == 4));
bool edit_maxdistance_value = (edit_mode && (current_line == 5));
bool edit_maxspeed_value = (edit_mode && (current_line == 6));
bool edit_minspeed_value = (edit_mode && (current_line == 7));
if (edit_maxdistance) {
if (alarmWarning.MaxDistance == HOTTBRIDGESETTINGS_WARNING_DISABLED) {
alarmWarning.MaxDistance = HOTTBRIDGESETTINGS_WARNING_ENABLED;
} else {
alarmWarning.MaxDistance = HOTTBRIDGESETTINGS_WARNING_DISABLED;
}
HoTTBridgeSettingsWarningSet(&alarmWarning);
UAVObjSave(HoTTBridgeSettingsHandle(), 0);
storedtoflash = true;
}
if (edit_minspeed) {
if (alarmWarning.MinSpeed == HOTTBRIDGESETTINGS_WARNING_DISABLED) {
alarmWarning.MinSpeed = HOTTBRIDGESETTINGS_WARNING_ENABLED;
} else {
alarmWarning.MinSpeed = HOTTBRIDGESETTINGS_WARNING_DISABLED;
}
HoTTBridgeSettingsWarningSet(&alarmWarning);
UAVObjSave(HoTTBridgeSettingsHandle(), 0);
storedtoflash = true;
}
if (edit_maxspeed) {
if (alarmWarning.MaxSpeed == HOTTBRIDGESETTINGS_WARNING_DISABLED) {
alarmWarning.MaxSpeed = HOTTBRIDGESETTINGS_WARNING_ENABLED;
} else {
alarmWarning.MaxSpeed = HOTTBRIDGESETTINGS_WARNING_DISABLED;
}
HoTTBridgeSettingsWarningSet(&alarmWarning);
UAVObjSave(HoTTBridgeSettingsHandle(), 0);
storedtoflash = true;
}
if (edit_maxdistance_value) {
step = (step > 3) ? 3 : step;
// 10m to 9000m
alarmLimits.MaxDistance = get_new_value((uint16_t)alarmLimits.MaxDistance, value_change, step, 10, 9000);
HoTTBridgeSettingsLimitSet(&alarmLimits);
}
if (edit_maxspeed_value) {
step = (step > 2) ? 2 : step;
alarmLimits.MaxSpeed = get_new_value((int16_t)alarmLimits.MaxSpeed, value_change, step, 0, 600);
HoTTBridgeSettingsLimitSet(&alarmLimits);
}
if (edit_minspeed_value) {
step = (step > 2) ? 2 : step;
alarmLimits.MinSpeed = get_new_value((int16_t)alarmLimits.MinSpeed, value_change, step, 0, 600);
HoTTBridgeSettingsLimitSet(&alarmLimits);
}
snprintf(msg->text[1], HOTT_TEXT_COLUMNS, " MaxDist warn [%1s] ", ((alarmWarning.MaxDistance == HOTTBRIDGESETTINGS_WARNING_DISABLED) ? " " : "*")); // line 2
snprintf(msg->text[2], HOTT_TEXT_COLUMNS, " MaxSpeed warn [%1s] ", ((alarmWarning.MaxSpeed == HOTTBRIDGESETTINGS_WARNING_DISABLED) ? " " : "*")); // line 3
snprintf(msg->text[3], HOTT_TEXT_COLUMNS, " MinSpeed warn [%1s] ", ((alarmWarning.MinSpeed == HOTTBRIDGESETTINGS_WARNING_DISABLED) ? " " : "*")); // line 4
snprintf(msg->text[4], HOTT_TEXT_COLUMNS, " Max distance %4d ", (uint16_t)alarmLimits.MaxDistance); // line 5
snprintf(msg->text[5], HOTT_TEXT_COLUMNS, " Max speed %4d ", (int16_t)alarmLimits.MaxSpeed); // line 6
snprintf(msg->text[6], HOTT_TEXT_COLUMNS, " Min speed %4d ", (int16_t)alarmLimits.MinSpeed); // line 7
snprintf(msg->text[7], HOTT_TEXT_COLUMNS, " "); // line 8
if (current_line > 1) {
msg->text[current_line - 1][0] = '>';
}
if (edit_maxdistance_value) {
reverse_pixels((char *)msg->text[current_line - 1], 16 + (3 - step), 20 - step);
}
if (edit_maxspeed_value) {
reverse_pixels((char *)msg->text[current_line - 1], 16 + (3 - step), 20 - step);
}
if (edit_minspeed_value) {
reverse_pixels((char *)msg->text[current_line - 1], 16 + (3 - step), 20 - step);
}
break;
case HOTTTEXT_PAGE_GENERAL: // General Air page
case HOTTTEXT_PAGE_ELECTRIC: // Electric Air page
case HOTTTEXT_PAGE_ESC: // Esc page
if (HoTTBridgeSettingsHandle() != NULL) {
HoTTBridgeSettingsWarningGet(&alarmWarning);
HoTTBridgeSettingsLimitGet(&alarmLimits);
}
bool edit_minvoltage = (edit_mode && (current_line == 2));
bool edit_maxcurrent = (edit_mode && (current_line == 3));
bool edit_maxusedcapacity = (edit_mode && (current_line == 4));
bool edit_minvoltage_value = (edit_mode && (current_line == 5));
bool edit_maxcurrent_value = (edit_mode && (current_line == 6));
bool edit_maxusedcapacity_value = (edit_mode && (current_line == 7));
if (edit_minvoltage) {
if (alarmWarning.MinPowerVoltage == HOTTBRIDGESETTINGS_WARNING_DISABLED) {
alarmWarning.MinPowerVoltage = HOTTBRIDGESETTINGS_WARNING_ENABLED;
} else {
alarmWarning.MinPowerVoltage = HOTTBRIDGESETTINGS_WARNING_DISABLED;
}
HoTTBridgeSettingsWarningSet(&alarmWarning);
UAVObjSave(HoTTBridgeSettingsHandle(), 0);
storedtoflash = true;
}
if (edit_maxcurrent) {
if (alarmWarning.MaxCurrent == HOTTBRIDGESETTINGS_WARNING_DISABLED) {
alarmWarning.MaxCurrent = HOTTBRIDGESETTINGS_WARNING_ENABLED;
} else {
alarmWarning.MaxCurrent = HOTTBRIDGESETTINGS_WARNING_DISABLED;
}
HoTTBridgeSettingsWarningSet(&alarmWarning);
UAVObjSave(HoTTBridgeSettingsHandle(), 0);
storedtoflash = true;
}
if (edit_maxusedcapacity) {
if (alarmWarning.MaxUsedCapacity == HOTTBRIDGESETTINGS_WARNING_DISABLED) {
alarmWarning.MaxUsedCapacity = HOTTBRIDGESETTINGS_WARNING_ENABLED;
} else {
alarmWarning.MaxUsedCapacity = HOTTBRIDGESETTINGS_WARNING_DISABLED;
}
HoTTBridgeSettingsWarningSet(&alarmWarning);
UAVObjSave(HoTTBridgeSettingsHandle(), 0);
storedtoflash = true;
}
if (edit_minvoltage_value) {
step = (step > 2) ? 2 : step;
// 3V to 50V
alarmLimits.MinPowerVoltage = (float)(get_new_value((uint16_t)(alarmLimits.MinPowerVoltage * 10), value_change, step, 30, 500) / 10.0f);
HoTTBridgeSettingsLimitSet(&alarmLimits);
}
if (edit_maxcurrent_value) {
step = (step > 2) ? 2 : step;
// 1A to 300A
alarmLimits.MaxCurrent = get_new_value((uint16_t)(alarmLimits.MaxCurrent), value_change, step, 1, 300);
HoTTBridgeSettingsLimitSet(&alarmLimits);
}
if (edit_maxusedcapacity_value) {
step = (step > 3) ? 3 : step;
// 100mAh to 30000mAh
alarmLimits.MaxUsedCapacity = (float)(get_new_value((uint16_t)alarmLimits.MaxUsedCapacity, value_change, step, 100, 30000));
HoTTBridgeSettingsLimitSet(&alarmLimits);
}
snprintf(msg->text[1], HOTT_TEXT_COLUMNS, " MinVoltage warn [%1s] ", ((alarmWarning.MinPowerVoltage == HOTTBRIDGESETTINGS_WARNING_DISABLED) ? " " : "*")); // line 2
snprintf(msg->text[2], HOTT_TEXT_COLUMNS, " MaxCurrent warn [%1s] ", ((alarmWarning.MaxCurrent == HOTTBRIDGESETTINGS_WARNING_DISABLED) ? " " : "*")); // line 3
snprintf(msg->text[3], HOTT_TEXT_COLUMNS, " MaxUsedmAH warn [%1s] ", ((alarmWarning.MaxUsedCapacity == HOTTBRIDGESETTINGS_WARNING_DISABLED) ? " " : "*")); // line 4
snprintf(msg->text[4], HOTT_TEXT_COLUMNS, " Min voltage %2d.%d ", (uint16_t)(alarmLimits.MinPowerVoltage), (uint16_t)(alarmLimits.MinPowerVoltage * 10) % 10); // line 5
snprintf(msg->text[5], HOTT_TEXT_COLUMNS, " Max current %3d ", (uint16_t)alarmLimits.MaxCurrent); // line 6
snprintf(msg->text[6], HOTT_TEXT_COLUMNS, " Max used mAH %5d ", (uint16_t)alarmLimits.MaxUsedCapacity); // line 7
snprintf(msg->text[7], HOTT_TEXT_COLUMNS, " "); // line 8
if (current_line > 1) {
msg->text[current_line - 1][0] = '>';
}
if (edit_minvoltage_value) {
if (step > 0) {
step += 1;
}
reverse_pixels((char *)msg->text[current_line - 1], 15 + (4 - step), 20 - step);
}
if (edit_maxcurrent_value) {
reverse_pixels((char *)msg->text[current_line - 1], 16 + (3 - step), 20 - step);
}
if (edit_maxusedcapacity_value) {
reverse_pixels((char *)msg->text[current_line - 1], 15 + (4 - step), 20 - step);
}
break;
case HOTTTEXT_PAGE_GPSCONFIG: // GPS config page
if (GPSSettingsHandle() != NULL) {
GPSSettingsGet(&gpsSettings);
}
if (HomeLocationHandle() != NULL) {
UAVObjLoad(HomeLocationHandle(), 0); // load from flash
HomeLocationSetGet(&homeSet);
}
bool edit_savehome = (edit_mode && (current_line == 2));
bool edit_minsat_value = (edit_mode && (current_line == 3));
bool edit_maxpdop_value = (edit_mode && (current_line == 4));
bool edit_ubxrate_value = (edit_mode && (current_line == 5));
if (edit_minsat_value) {
gpsSettings.MinSatellites = get_new_value(gpsSettings.MinSatellites, value_change, 0, 4, 9);
GPSSettingsSet(&gpsSettings);
}
if (edit_maxpdop_value) {
step = (step > 2) ? 2 : step;
// 1.0 to 10.0
gpsSettings.MaxPDOP = (float)(get_new_value((uint16_t)(gpsSettings.MaxPDOP * 10), value_change, step, 10, 100) / 10.0f);
GPSSettingsSet(&gpsSettings);
}
if (edit_ubxrate_value) {
gpsSettings.UbxRate = get_new_value(gpsSettings.UbxRate, value_change, 0, 1, 15);
GPSSettingsSet(&gpsSettings);
}
char *home_set_perm = (homeSet == HOMELOCATION_SET_FALSE) ? "NEVER" : "ISSET";
snprintf(msg->text[1], HOTT_TEXT_COLUMNS, " Home status %s ", home_set_perm); // line 2
snprintf(msg->text[2], HOTT_TEXT_COLUMNS, " Min satellites %d ", gpsSettings.MinSatellites); // line 3
snprintf(msg->text[3], HOTT_TEXT_COLUMNS, " Max PDOP %2d.%d ", (uint16_t)(gpsSettings.MaxPDOP), (uint16_t)(gpsSettings.MaxPDOP * 10) % 10); // line 4
snprintf(msg->text[4], HOTT_TEXT_COLUMNS, " UBX Rate %2d ", gpsSettings.UbxRate); // line 5
snprintf(msg->text[5], HOTT_TEXT_COLUMNS, " "); // line 6
snprintf(msg->text[6], HOTT_TEXT_COLUMNS, " "); // line 7
snprintf(msg->text[7], HOTT_TEXT_COLUMNS, " "); // line 8
if (current_line > 1) { if (current_line > 1) {
msg->text[current_line - 1][0] = '>'; msg->text[current_line - 1][0] = '>';
} }
break;
case HOTTPAGE_GPS: // GPS page if (edit_savehome) {
case HOTTPAGE_GENERAL: // General Air page if (homeSet == HOMELOCATION_SET_TRUE) {
case HOTTPAGE_ELECTRIC: // Electric Air page homeSet = HOMELOCATION_SET_FALSE;
case HOTTPAGE_ESC: // Esc page HomeLocationSetSet(&homeSet);
snprintf(msg->text[1], HOTT_TEXT_COLUMNS, " "); // line 2 UAVObjSave(HomeLocationHandle(), 0);
snprintf(msg->text[2], HOTT_TEXT_COLUMNS, " "); // line 3 storedtoflash = true;
snprintf(msg->text[3], HOTT_TEXT_COLUMNS, " "); // line 4 }
snprintf(msg->text[4], HOTT_TEXT_COLUMNS, " "); // line 5 }
snprintf(msg->text[5], HOTT_TEXT_COLUMNS, " "); // line 6 if (edit_minsat_value) {
snprintf(msg->text[6], HOTT_TEXT_COLUMNS, " "); // line 7 reverse_pixels((char *)msg->text[current_line - 1], 19, 20);
snprintf(msg->text[7], HOTT_TEXT_COLUMNS, " "); // line 8 }
if (edit_maxpdop_value) {
if (step > 0) {
step += 1;
}
reverse_pixels((char *)msg->text[current_line - 1], 15 + (4 - step), 20 - step);
}
if (edit_ubxrate_value) {
reverse_pixels((char *)msg->text[current_line - 1], 18, 20);
}
break; break;
default: default:
case HOTTPAGE_MAIN: // Main page where HoTT modules can be started case HOTTTEXT_PAGE_MAIN: // Main page where HoTT modules can be started
if (edit_line) { if (HoTTBridgeSettingsHandle() != NULL) {
HoTTBridgeSettingsSensorGet(&sensor);
}
if (edit_mode) {
switch (current_line) { switch (current_line) {
case 2: case 2:
if (sensor.VARIO == HOTTBRIDGESETTINGS_SENSOR_DISABLED) { if (sensor.VARIO == HOTTBRIDGESETTINGS_SENSOR_DISABLED) {
@ -797,21 +1126,15 @@ uint16_t build_TEXT_message(struct hott_text_message *msg, uint8_t page, uint8_t
} }
HoTTBridgeSettingsSensorSet(&sensor); HoTTBridgeSettingsSensorSet(&sensor);
UAVObjSave(HoTTBridgeSettingsHandle(), 0); UAVObjSave(HoTTBridgeSettingsHandle(), 0);
storedtoflash = true;
} }
// check sensors status and set char
char *vario_status = (sensor.VARIO == HOTTBRIDGESETTINGS_SENSOR_DISABLED) ? " " : "*";
char *gps_status = (sensor.GPS == HOTTBRIDGESETTINGS_SENSOR_DISABLED) ? " " : "*";
char *gam_status = (sensor.GAM == HOTTBRIDGESETTINGS_SENSOR_DISABLED) ? " " : "*";
char *eam_status = (sensor.EAM == HOTTBRIDGESETTINGS_SENSOR_DISABLED) ? " " : "*";
char *esc_status = (sensor.ESC == HOTTBRIDGESETTINGS_SENSOR_DISABLED) ? " " : "*";
// create Main page content // create Main page content
snprintf(msg->text[1], HOTT_TEXT_COLUMNS, " VARIO module [%1s] ", vario_status); // line 2 snprintf(msg->text[1], HOTT_TEXT_COLUMNS, " VARIO module [%1s] ", ((sensor.VARIO == HOTTBRIDGESETTINGS_SENSOR_DISABLED) ? " " : "*")); // line 2
snprintf(msg->text[2], HOTT_TEXT_COLUMNS, " GPS module [%1s] ", gps_status); // line 3 snprintf(msg->text[2], HOTT_TEXT_COLUMNS, " GPS module [%1s] ", ((sensor.GPS == HOTTBRIDGESETTINGS_SENSOR_DISABLED) ? " " : "*")); // line 3
snprintf(msg->text[3], HOTT_TEXT_COLUMNS, " ELECTRIC module [%1s] ", eam_status); // line 4 snprintf(msg->text[3], HOTT_TEXT_COLUMNS, " ELECTRIC module [%1s] ", ((sensor.EAM == HOTTBRIDGESETTINGS_SENSOR_DISABLED) ? " " : "*")); // line 4
snprintf(msg->text[4], HOTT_TEXT_COLUMNS, " GENERAL module [%1s] ", gam_status); // line 5 snprintf(msg->text[4], HOTT_TEXT_COLUMNS, " GENERAL module [%1s] ", ((sensor.GAM == HOTTBRIDGESETTINGS_SENSOR_DISABLED) ? " " : "*")); // line 5
snprintf(msg->text[5], HOTT_TEXT_COLUMNS, " ESC module [%1s] ", esc_status); // line 6 snprintf(msg->text[5], HOTT_TEXT_COLUMNS, " ESC module [%1s] ", ((sensor.ESC == HOTTBRIDGESETTINGS_SENSOR_DISABLED) ? " " : "*")); // line 6
snprintf(msg->text[6], HOTT_TEXT_COLUMNS, " Select module "); snprintf(msg->text[6], HOTT_TEXT_COLUMNS, " Select module ");
snprintf(msg->text[7], HOTT_TEXT_COLUMNS, " to be emulated "); snprintf(msg->text[7], HOTT_TEXT_COLUMNS, " to be emulated ");
@ -824,7 +1147,131 @@ uint16_t build_TEXT_message(struct hott_text_message *msg, uint8_t page, uint8_t
msg->stop = HOTT_STOP; msg->stop = HOTT_STOP;
msg->checksum = calc_checksum((uint8_t *)msg, sizeof(*msg)); msg->checksum = calc_checksum((uint8_t *)msg, sizeof(*msg));
return sizeof(*msg); return storedtoflash;
}
/**
* get next/previous page to display
*/
uint8_t get_page(uint8_t page, bool next)
{
HoTTBridgeSettingsSensorData sensor;
if (HoTTBridgeSettingsHandle() != NULL) {
HoTTBridgeSettingsSensorGet(&sensor);
}
if (next) {
switch (page) {
case HOTTTEXT_PAGE_MAIN:
if (sensor.GPS == HOTTBRIDGESETTINGS_SENSOR_ENABLED) {
page = HOTTTEXT_PAGE_GPSCONFIG;
break;
}
case HOTTTEXT_PAGE_GPSCONFIG:
if (sensor.VARIO == HOTTBRIDGESETTINGS_SENSOR_ENABLED) {
page = HOTTTEXT_PAGE_VARIO;
break;
}
case HOTTTEXT_PAGE_VARIO:
if (sensor.GPS == HOTTBRIDGESETTINGS_SENSOR_ENABLED) {
page = HOTTTEXT_PAGE_GPS;
break;
}
case HOTTTEXT_PAGE_GPS:
if (sensor.GAM == HOTTBRIDGESETTINGS_SENSOR_ENABLED) {
page = HOTTTEXT_PAGE_GENERAL;
break;
}
case HOTTTEXT_PAGE_GENERAL:
if (sensor.EAM == HOTTBRIDGESETTINGS_SENSOR_ENABLED) {
page = HOTTTEXT_PAGE_ELECTRIC;
break;
}
case HOTTTEXT_PAGE_ELECTRIC:
if (sensor.ESC == HOTTBRIDGESETTINGS_SENSOR_ENABLED) {
page = HOTTTEXT_PAGE_ESC;
break;
}
case HOTTTEXT_PAGE_ESC:
break;
default:
page = HOTTTEXT_PAGE_MAIN;
}
} else {
switch (page) {
case HOTTTEXT_PAGE_ESC:
if (sensor.EAM == HOTTBRIDGESETTINGS_SENSOR_ENABLED) {
page = HOTTTEXT_PAGE_ELECTRIC;
break;
}
case HOTTTEXT_PAGE_ELECTRIC:
if (sensor.GAM == HOTTBRIDGESETTINGS_SENSOR_ENABLED) {
page = HOTTTEXT_PAGE_GENERAL;
break;
}
case HOTTTEXT_PAGE_GENERAL:
if (sensor.GPS == HOTTBRIDGESETTINGS_SENSOR_ENABLED) {
page = HOTTTEXT_PAGE_GPS;
break;
}
case HOTTTEXT_PAGE_GPS:
if (sensor.VARIO == HOTTBRIDGESETTINGS_SENSOR_ENABLED) {
page = HOTTTEXT_PAGE_VARIO;
break;
}
case HOTTTEXT_PAGE_VARIO:
if (sensor.GPS == HOTTBRIDGESETTINGS_SENSOR_ENABLED) {
page = HOTTTEXT_PAGE_GPSCONFIG;
break;
}
case HOTTTEXT_PAGE_GPSCONFIG:
page = HOTTTEXT_PAGE_MAIN;
break;
case HOTTTEXT_PAGE_MAIN:
default:
page = HOTTTEXT_PAGE_MAIN;
}
}
return page;
}
/**
* get new value for edited field
*/
int16_t get_new_value(int16_t current_value, int8_t value_change, uint8_t step, int16_t min, int16_t max)
{
uint16_t increment[] = { 1, 10, 100, 1000, 10000 };
int16_t new_value = 0;
new_value = current_value + (value_change * increment[step]);
if (new_value < min) {
new_value = min;
}
if (new_value > max) {
new_value = max;
}
return new_value;
}
/**
* store settings to onboard flash
*/
void store_settings(uint8_t page)
{
switch (page) {
case HOTTTEXT_PAGE_MAIN:
case HOTTTEXT_PAGE_VARIO:
case HOTTTEXT_PAGE_GPS:
case HOTTTEXT_PAGE_GENERAL:
case HOTTTEXT_PAGE_ELECTRIC:
case HOTTTEXT_PAGE_ESC:
UAVObjSave(HoTTBridgeSettingsHandle(), 0);
break;
case HOTTTEXT_PAGE_GPSCONFIG:
UAVObjSave(GPSSettingsHandle(), 0);
break;
}
} }
/** /**
@ -1148,6 +1595,21 @@ uint8_t generate_warning()
return 0; return 0;
} }
/**
* reverse pixels
*/
char *reverse_pixels(char *line, uint8_t from_char, uint8_t to_char)
{
for (int i = from_char; i < to_char; i++) {
if (line[i] == 0) {
line[i] = (uint8_t)(0x80 + 0x20);
} else {
line[i] = (0x80 + line[i]);
}
}
return line;
}
/** /**
* calculate checksum of data buffer * calculate checksum of data buffer
*/ */