void osdDrawElements(void) { max7456ClearScreen(); if (currentElement) osdDrawElementPositioningHelp(); else if (sensors(SENSOR_ACC) || inMenu) { osdDrawSingleElement(OSD_ARTIFICIAL_HORIZON); osdDrawSingleElement(OSD_CROSSHAIRS); } osdDrawSingleElement(OSD_MAIN_BATT_VOLTAGE); osdDrawSingleElement(OSD_RSSI_VALUE); osdDrawSingleElement(OSD_FLYTIME); osdDrawSingleElement(OSD_ONTIME); osdDrawSingleElement(OSD_FLYMODE); osdDrawSingleElement(OSD_THROTTLE_POS); osdDrawSingleElement(OSD_VTX_CHANNEL); osdDrawSingleElement(OSD_CURRENT_DRAW); osdDrawSingleElement(OSD_MAH_DRAWN); osdDrawSingleElement(OSD_CRAFT_NAME); osdDrawSingleElement(OSD_ALTITUDE); #ifdef GPS if (sensors(SENSOR_GPS) || inMenu) { osdDrawSingleElement(OSD_GPS_SATS); osdDrawSingleElement(OSD_GPS_SPEED); } #endif // GPS }
void osdDrawSingleElement(uint8_t item) { if (!VISIBLE(OSD_cfg.item_pos[item]) || BLINK(OSD_cfg.item_pos[item])) return; uint8_t elemPosX = OSD_X(OSD_cfg.item_pos[item]); uint8_t elemPosY = OSD_Y(OSD_cfg.item_pos[item]); char buff[32]; switch(item) { case OSD_RSSI_VALUE: { uint16_t osdRssi = rssi * 100 / 1024; // change range if (osdRssi >= 100) osdRssi = 99; buff[0] = SYM_RSSI; sprintf(buff + 1, "%d", osdRssi); break; } case OSD_MAIN_BATT_VOLTAGE: { buff[0] = SYM_BATT_5; sprintf(buff + 1, "%d.%1dV", vbat / 10, vbat % 10); break; } case OSD_CURRENT_DRAW: { buff[0] = SYM_AMP; sprintf(buff + 1, "%d.%02d", abs(amperage) / 100, abs(amperage) % 100); break; } case OSD_MAH_DRAWN: { buff[0] = SYM_MAH; sprintf(buff + 1, "%d", mAhDrawn); break; } #ifdef GPS case OSD_GPS_SATS: { buff[0] = 0x1f; sprintf(buff + 1, "%d", GPS_numSat); break; } case OSD_GPS_SPEED: { sprintf(buff, "%d", GPS_speed * 36 / 1000); break; } #endif // GPS case OSD_ALTITUDE: { int32_t alt = osdGetAltitude(BaroAlt); sprintf(buff, "%c%d.%01d%c", alt < 0 ? '-' : ' ', abs(alt / 100), abs((alt % 100) / 10), osdGetAltitudeSymbol()); break; } case OSD_ONTIME: { uint32_t seconds = micros() / 1000000; buff[0] = SYM_ON_M; sprintf(buff + 1, "%02d:%02d", seconds / 60, seconds % 60); break; } case OSD_FLYTIME: { buff[0] = SYM_FLY_M; sprintf(buff + 1, "%02d:%02d", flyTime / 60, flyTime % 60); break; } case OSD_FLYMODE: { char *p = "ACRO"; if (isAirmodeActive()) p = "AIR"; if (FLIGHT_MODE(FAILSAFE_MODE)) p = "!FS"; else if (FLIGHT_MODE(ANGLE_MODE)) p = "STAB"; else if (FLIGHT_MODE(HORIZON_MODE)) p = "HOR"; max7456Write(elemPosX, elemPosY, p); return; } case OSD_CRAFT_NAME: { if (strlen(masterConfig.name) == 0) strcpy(buff, "CRAFT_NAME"); else { for (uint8_t i = 0; i < MAX_NAME_LENGTH; i++) { buff[i] = toupper((unsigned char)masterConfig.name[i]); if (masterConfig.name[i] == 0) break; } } break; } case OSD_THROTTLE_POS: { buff[0] = SYM_THR; buff[1] = SYM_THR1; sprintf(buff + 2, "%d", (constrain(rcData[THROTTLE], PWM_RANGE_MIN, PWM_RANGE_MAX) - PWM_RANGE_MIN) * 100 / (PWM_RANGE_MAX - PWM_RANGE_MIN)); break; } #ifdef VTX case OSD_VTX_CHANNEL: { sprintf(buff, "CH:%d", current_vtx_channel % CHANNELS_PER_BAND + 1); break; } #endif // VTX case OSD_CROSSHAIRS: { uint8_t *screenBuffer = max7456GetScreenBuffer(); uint16_t position = 194; if (maxScreenSize == VIDEO_BUFFER_CHARS_PAL) position += 30; screenBuffer[position - 1] = (SYM_AH_CENTER_LINE); screenBuffer[position + 1] = (SYM_AH_CENTER_LINE_RIGHT); screenBuffer[position] = (SYM_AH_CENTER); return; } case OSD_ARTIFICIAL_HORIZON: { uint8_t *screenBuffer = max7456GetScreenBuffer(); uint16_t position = 194; int rollAngle = attitude.values.roll; int pitchAngle = attitude.values.pitch; if (maxScreenSize == VIDEO_BUFFER_CHARS_PAL) position += 30; if (pitchAngle > AH_MAX_PITCH) pitchAngle = AH_MAX_PITCH; if (pitchAngle < -AH_MAX_PITCH) pitchAngle = -AH_MAX_PITCH; if (rollAngle > AH_MAX_ROLL) rollAngle = AH_MAX_ROLL; if (rollAngle < -AH_MAX_ROLL) rollAngle = -AH_MAX_ROLL; for (uint8_t x = 0; x <= 8; x++) { int y = (rollAngle * (4 - x)) / 64; y -= pitchAngle / 8; y += 41; if (y >= 0 && y <= 81) { uint16_t pos = position - 7 + LINE * (y / 9) + 3 - 4 * LINE + x; screenBuffer[pos] = (SYM_AH_BAR9_0 + (y % 9)); } } osdDrawSingleElement(OSD_HORIZON_SIDEBARS); return; } case OSD_HORIZON_SIDEBARS: { uint8_t *screenBuffer = max7456GetScreenBuffer(); uint16_t position = 194; if (maxScreenSize == VIDEO_BUFFER_CHARS_PAL) position += 30; // Draw AH sides int8_t hudwidth = AH_SIDEBAR_WIDTH_POS; int8_t hudheight = AH_SIDEBAR_HEIGHT_POS; for (int8_t x = -hudheight; x <= hudheight; x++) { screenBuffer[position - hudwidth + (x * LINE)] = (SYM_AH_DECORATION); screenBuffer[position + hudwidth + (x * LINE)] = (SYM_AH_DECORATION); } // AH level indicators screenBuffer[position - hudwidth + 1] = (SYM_AH_LEFT); screenBuffer[position + hudwidth - 1] = (SYM_AH_RIGHT); return; } default: return; } max7456Write(elemPosX, elemPosY, buff); }
static void osdDrawElements(void) { displayClearScreen(osdDisplayPort); // Hide OSD when OSDSW mode is active if (IS_RC_MODE_ACTIVE(BOXOSD)) { return; } if (sensors(SENSOR_ACC)) { osdDrawSingleElement(OSD_ARTIFICIAL_HORIZON); } for (unsigned i = 0; i < sizeof(osdElementDisplayOrder); i++) { osdDrawSingleElement(osdElementDisplayOrder[i]); } #ifdef USE_GPS if (sensors(SENSOR_GPS)) { osdDrawSingleElement(OSD_GPS_SATS); osdDrawSingleElement(OSD_GPS_SPEED); osdDrawSingleElement(OSD_GPS_LAT); osdDrawSingleElement(OSD_GPS_LON); osdDrawSingleElement(OSD_HOME_DIST); osdDrawSingleElement(OSD_HOME_DIR); } #endif // GPS #ifdef USE_ESC_SENSOR if (feature(FEATURE_ESC_SENSOR)) { osdDrawSingleElement(OSD_ESC_TMP); osdDrawSingleElement(OSD_ESC_RPM); } #endif #ifdef USE_RTC_TIME osdDrawSingleElement(OSD_RTC_DATETIME); #endif #ifdef USE_OSD_ADJUSTMENTS osdDrawSingleElement(OSD_ADJUSTMENT_RANGE); #endif #ifdef USE_ADC_INTERNAL osdDrawSingleElement(OSD_CORE_TEMPERATURE); #endif }