osd: add dynamic element

src/core/profile.c

@@ -490,6 +490,7 @@ const profile_t default_profile = {
             ENCODE_OSD_ELEMENT(1, 0, 1, 13),  // OSD_THROTTLE
             ENCODE_OSD_ELEMENT(0, 0, 1, 1),   // OSD_VTX_CHANNEL
             ENCODE_OSD_ELEMENT(1, 0, 1, 14),  // OSD_CURRENT_DRAW
+            ENCODE_OSD_ELEMENT(1, 0, 1, 2),   // OSD_DEBUG
         },
         .elements_hd = {
             ENCODE_OSD_ELEMENT(1, 1, 19, 0),  // OSD_CALLSIGN
@@ -504,6 +505,7 @@ const profile_t default_profile = {
             ENCODE_OSD_ELEMENT(1, 0, 0, 16),  // OSD_THROTTLE
             ENCODE_OSD_ELEMENT(0, 0, 0, 0),   // OSD_VTX_CHANNEL
             ENCODE_OSD_ELEMENT(1, 0, 0, 17),  // OSD_CURRENT_DRAW
+            ENCODE_OSD_ELEMENT(1, 0, 0, 2),   // OSD_DEBUG
         },
     },
     .blackbox = {

src/driver/osd.c

@@ -160,6 +160,15 @@ void osd_start(uint8_t attr, uint8_t x, uint8_t y) {
   osd_seg.offset = 0;
 }
 
+uint32_t osd_auto_width(int32_t val) {
+  uint32_t width = 0;
+  while (val) {
+    val /= 10;
+    width++;
+  }
+  return width;
+}
+
 void osd_write_data(const uint8_t *buffer, uint8_t size) {
   for (uint8_t i = 0; i < size; i++) {
     osd_display_set(osd_seg.x + osd_seg.offset + i, osd_seg.y, osd_seg.attr, buffer[i]);

src/driver/osd.h

@@ -54,6 +54,7 @@ void osd_display_refresh();
 osd_system_t osd_check_system();
 
 void osd_start(uint8_t attr, uint8_t x, uint8_t y);
+uint32_t osd_auto_width(int32_t val);
 
 void osd_write_data(const uint8_t *buffer, uint8_t size);
 void osd_write_str(const char *buffer);

src/osd/render.c

@@ -92,6 +92,7 @@ static const char *osd_element_labels[] = {
     "THROTTLE",
     "VTX",
     "CURRENT DRAW",
+    "DEBUG",
 };
 
 static const char *aux_channel_labels[] = {
@@ -314,6 +315,69 @@ static void print_osd_flightmode(osd_element_t *el) {
   osd_write_data(flightmode_labels[flightmode], 10);
 }
 
+static void print_state_member_uint8(uint8_t *data) {
+  osd_write_uint(*data, osd_auto_width(*data));
+}
+
+static void print_state_member_uint16(uint16_t *data) {
+  osd_write_uint(*data, osd_auto_width(*data));
+}
+
+static void print_state_member_uint32(uint32_t *data) {
+  osd_write_uint(*data, osd_auto_width(*data));
+}
+
+static void print_state_member_float(float *data) {
+  osd_write_float(*data, osd_auto_width(*data), 2);
+}
+
+static void print_state_member_vec3_t(vec3_t *data) {
+}
+
+static void print_state_member_vec4_t(vec4_t *data) {
+}
+
+static void print_state_member(char *name) {
+#define MEMBER(member, type)                  \
+  if (strcmp(name, #member) == 0) {           \
+    print_state_member_##type(&state.member); \
+    return;                                   \
+  }
+#define ARRAY_MEMBER(member, size, type) \
+  {}
+
+  STATE_MEMBERS
+
+#undef MEMBER
+#undef ARRAY_MEMBER
+}
+
+static void print_debug_element(osd_element_t *el, char *str) {
+  osd_start(osd_attr(el), el->pos_x, el->pos_y);
+
+  char element[32];
+  uint32_t element_len = 0;
+  bool started = false;
+  for (uint32_t i = 0; i < strlen(str); i++) {
+    if (str[i] == '{') {
+      element_len = 0;
+      started = true;
+      continue;
+    }
+    if (str[i] == '}') {
+      started = false;
+      element[element_len] = 0;
+      print_state_member(element);
+      continue;
+    }
+    if (started) {
+      element[element_len++] = str[i];
+    } else {
+      osd_write_char(str[i]);
+    }
+  }
+}
+
 static void print_osd_rssi(osd_element_t *el) {
   static float rx_rssi_filt;
   if (flags.failsafe)
@@ -697,6 +761,12 @@ static void osd_display_regular() {
     break;
   }
 
+  case OSD_DEBUG: {
+    print_debug_element(el, "{cpu_load}S");
+    osd_state.element++;
+    break;
+  }
+
   case OSD_ELEMENT_MAX: {
     // end of regular display - display_trigger counter sticks here till it wraps
     static uint8_t display_trigger = 0;

src/osd/render.h

@@ -68,6 +68,7 @@ typedef enum {
   OSD_THROTTLE,
   OSD_VTX_CHANNEL,
   OSD_CURRENT_DRAW,
+  OSD_DEBUG,
 
   OSD_ELEMENT_MAX
 } osd_elements_t;