diff --git a/src/main/cms/cms_menu_osd.c b/src/main/cms/cms_menu_osd.c index 4fc9f233c3..918f801eab 100644 --- a/src/main/cms/cms_menu_osd.c +++ b/src/main/cms/cms_menu_osd.c @@ -127,6 +127,7 @@ OSD_Entry menuOsdActiveElemsEntries[] = {"ROLL PID", OME_VISIBLE, NULL, &osdConfig_item_pos[OSD_ROLL_PIDS], 0}, {"PITCH PID", OME_VISIBLE, NULL, &osdConfig_item_pos[OSD_PITCH_PIDS], 0}, {"YAW PID", OME_VISIBLE, NULL, &osdConfig_item_pos[OSD_YAW_PIDS], 0}, + {"DEBUG", OME_VISIBLE, NULL, &osdConfig_item_pos[OSD_DEBUG], 0}, {"BACK", OME_Back, NULL, NULL, 0}, {NULL, OME_END, NULL, NULL, 0} }; diff --git a/src/main/fc/cli.c b/src/main/fc/cli.c index 2e76a47d55..b7c98537a3 100755 --- a/src/main/fc/cli.c +++ b/src/main/fc/cli.c @@ -847,6 +847,7 @@ static const clivalue_t valueTable[] = { { "osd_pid_roll_pos", VAR_UINT16 | MASTER_VALUE, .config.minmax = { 0, OSD_POSCFG_MAX }, PG_OSD_CONFIG, offsetof(osdConfig_t, item_pos[OSD_ROLL_PIDS]) }, { "osd_pid_pitch_pos", VAR_UINT16 | MASTER_VALUE, .config.minmax = { 0, OSD_POSCFG_MAX }, PG_OSD_CONFIG, offsetof(osdConfig_t, item_pos[OSD_PITCH_PIDS]) }, { "osd_pid_yaw_pos", VAR_UINT16 | MASTER_VALUE, .config.minmax = { 0, OSD_POSCFG_MAX }, PG_OSD_CONFIG, offsetof(osdConfig_t, item_pos[OSD_YAW_PIDS]) }, + { "osd_debug_pos", VAR_UINT16 | MASTER_VALUE, .config.minmax = { 0, OSD_POSCFG_MAX }, PG_OSD_CONFIG, offsetof(osdConfig_t, item_pos[OSD_DEBUG]) }, { "osd_power_pos", VAR_UINT16 | MASTER_VALUE, .config.minmax = { 0, OSD_POSCFG_MAX }, PG_OSD_CONFIG, offsetof(osdConfig_t, item_pos[OSD_POWER]) }, { "osd_pidrate_profile_pos", VAR_UINT16 | MASTER_VALUE, .config.minmax = { 0, OSD_POSCFG_MAX }, PG_OSD_CONFIG, offsetof(osdConfig_t, item_pos[OSD_PIDRATE_PROFILE]) }, { "osd_battery_warning_pos", VAR_UINT16 | MASTER_VALUE, .config.minmax = { 0, OSD_POSCFG_MAX }, PG_OSD_CONFIG, offsetof(osdConfig_t, item_pos[OSD_MAIN_BATT_WARNING]) }, diff --git a/src/main/io/osd.c b/src/main/io/osd.c index b10208e206..be4a8501c3 100644 --- a/src/main/io/osd.c +++ b/src/main/io/osd.c @@ -460,7 +460,7 @@ static void osdDrawSingleElement(uint8_t item) break; } - case OSD_AVG_CELL_VOLTAGE: + case OSD_AVG_CELL_VOLTAGE: { uint16_t cellV = getBatteryVoltage() * 10 / getBatteryCellCount(); buff[0] = SYM_BATT_5; @@ -468,8 +468,14 @@ static void osdDrawSingleElement(uint8_t item) break; } - default: - return; + case OSD_DEBUG: + { + sprintf(buff, "DBG %5d %5d %5d %5d", debug[0], debug[1], debug[2], debug[3]); + break; + } + + default: + return; } displayWrite(osdDisplayPort, elemPosX + elemOffsetX, elemPosY, buff); @@ -518,6 +524,7 @@ void osdDrawElements(void) osdDrawSingleElement(OSD_PIDRATE_PROFILE); osdDrawSingleElement(OSD_MAIN_BATT_WARNING); osdDrawSingleElement(OSD_AVG_CELL_VOLTAGE); + osdDrawSingleElement(OSD_DEBUG); #ifdef GPS #ifdef CMS @@ -559,6 +566,7 @@ void pgResetFn_osdConfig(osdConfig_t *osdProfile) osdProfile->item_pos[OSD_PIDRATE_PROFILE] = OSD_POS(25, 10) | VISIBLE_FLAG; osdProfile->item_pos[OSD_MAIN_BATT_WARNING] = OSD_POS(9, 10) | VISIBLE_FLAG; osdProfile->item_pos[OSD_AVG_CELL_VOLTAGE] = OSD_POS(12, 2) | VISIBLE_FLAG; + osdProfile->item_pos[OSD_DEBUG] = OSD_POS(7, 12) | VISIBLE_FLAG; osdProfile->item_pos[OSD_GPS_LAT] = OSD_POS(18, 14) | VISIBLE_FLAG; osdProfile->item_pos[OSD_GPS_LON] = OSD_POS(18, 15) | VISIBLE_FLAG; diff --git a/src/main/io/osd.h b/src/main/io/osd.h index 859e7a70d5..b2a232bb95 100755 --- a/src/main/io/osd.h +++ b/src/main/io/osd.h @@ -52,6 +52,7 @@ typedef enum { OSD_AVG_CELL_VOLTAGE, OSD_GPS_LON, OSD_GPS_LAT, + OSD_DEBUG, OSD_ITEM_COUNT // MUST BE LAST } osd_items_e;