Initial, very basic implementation of OSD wind indicators

An indicator shows the wind in the XY plane while another shows the Z axis.
shellixyz · May 27, 2018 · e3c5882 · e3c5882
1 parent 9a45a0c
commit e3c5882
Show file tree

Hide file tree

Showing 2 changed files with 37 additions and 0 deletions.
diff --git a/src/main/drivers/max7456_symbols.h b/src/main/drivers/max7456_symbols.h
@@ -223,6 +223,8 @@
 
 // Air speed
 #define SYM_AIR 151
+// TODO: Proper symbol
+#define SYM_WIND 'W'
 
 //Misc
 #define SYM_COLON 0x2D

diff --git a/src/main/io/osd.c b/src/main/io/osd.c
@@ -1747,6 +1747,41 @@ static bool osdDrawSingleElement(uint8_t item)
             break;
         }
 
+#if 0
+    case OSD_HORIZONTAL_WIND:
+        {
+            float horizontalWindSpeed;
+            float horizontalWindAngle;
+            getEstimatedWindVelocityBodyFrame(&horizontalWindSpeed, &horizontalWindAngle, NULL);
+            buff[0] = SYM_WIND;
+            int16_t h = RADIANS_TO_DEGREES(horizontalWindAngle);
+            if (h < 0) {
+                h += 360;
+            }
+            if (h >= 360) {
+                h -= 360;
+            }
+            h = h*2/45;
+            buff[1] = SYM_ARROW_UP + h;
+            osdFormatCentiNumber(buff + 2, horizontalWindSpeed * 0.036, 0, 2, 0, 3);
+            buff[5] = SYM_KMH;
+            buff[6] = '\0';
+            break;
+        }
+
+    case OSD_VERTICAL_WIND:
+        {
+            float verticalWindSpeed;
+            getEstimatedWindVelocityBodyFrame(NULL, NULL, &verticalWindSpeed);
+            buff[0] = SYM_WIND;
+            buff[1] = verticalWindSpeed > 0 ? SYM_AH_DECORATION_UP : verticalWindSpeed < 0 ? SYM_AH_DECORATION_DOWN : SYM_BLANK;
+            osdFormatCentiNumber(buff + 2, verticalWindSpeed * 0.036, 0, 2, 0, 3);
+            buff[5] = SYM_KMH;
+            buff[6] = '\0';
+            break;
+        }
+#endif
+
     default:
         return false;
     }