/* * Copyright (C) OpenTX * * Based on code named * th9x - http://code.google.com/p/th9x * er9x - http://code.google.com/p/er9x * gruvin9x - http://code.google.com/p/gruvin9x * * License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. */ #include "opentx.h" extern uint8_t g_moduleIdx; enum SpectrumFields { SPECTRUM_FREQUENCY, SPECTRUM_SPAN, SPECTRUM_FIELDS_MAX }; bool menuRadioSpectrumAnalyser(event_t event) { SIMPLE_SUBMENU(STR_MENU_SPECTRUM_ANALYSER, ICON_RADIO, 1); if (TELEMETRY_STREAMING()) { lcdDrawCenteredText(LCD_H/2, STR_TURN_OFF_RECEIVER ); if (event == EVT_KEY_FIRST(KEY_EXIT)) { killEvents(event); popMenu(); } return true; } if (menuEvent) { lcdDrawCenteredText(LCD_H/2, STR_STOPPING ); lcdRefresh(); moduleState[g_moduleIdx].mode = MODULE_MODE_NORMAL; /* wait 1s to resume normal operation before leaving */ watchdogSuspend(1000); RTOS_WAIT_MS(1000); return true; } if (moduleState[g_moduleIdx].mode != MODULE_MODE_SPECTRUM_ANALYSER) { memclear(reusableBuffer.spectrumAnalyser.bars, sizeof(reusableBuffer.spectrumAnalyser.bars)); reusableBuffer.spectrumAnalyser.span = 40000000; // 40MHz reusableBuffer.spectrumAnalyser.freq = 2440000000; // 2440MHz reusableBuffer.spectrumAnalyser.step = reusableBuffer.spectrumAnalyser.span / LCD_W; moduleState[g_moduleIdx].mode = MODULE_MODE_SPECTRUM_ANALYSER; } for (uint8_t i=0; i0 ? INVERS|BLINK : INVERS) : 0); switch (i) { case SPECTRUM_FREQUENCY: { uint16_t frequency = reusableBuffer.spectrumAnalyser.freq / 1000000; lcdDrawText(1, MENU_CONTENT_TOP + 10, "F:", 0); lcdDrawNumber(lcdNextPos + 2, 10, frequency, attr); lcdDrawText(lcdNextPos + 2, 10, "MHz", 0); if (attr) { reusableBuffer.spectrumAnalyser.freq = uint32_t(checkIncDec(event, frequency, 2400, 2485, 0)) * 1000000; } break; } case SPECTRUM_SPAN: uint8_t span = reusableBuffer.spectrumAnalyser.span / 1000000; lcdDrawText(lcdNextPos + 5, MENU_CONTENT_TOP + 10, "S:", 0); lcdDrawNumber(lcdNextPos + 2, MENU_CONTENT_TOP + 10, reusableBuffer.spectrumAnalyser.span/1000000, attr); lcdDrawText(lcdNextPos + 2, MENU_CONTENT_TOP + 10, "MHz", 0); if (attr) { reusableBuffer.spectrumAnalyser.span = checkIncDec(event, span, 1, 80, 0) * 1000000; } break; } } uint8_t peak_y = 1; uint8_t peak_x = 0; for (coord_t i=0; i(reusableBuffer.spectrumAnalyser.bars[i] >> 1, 128); if (h > peak_y) { peak_x = i; peak_y = h; } lcdDrawSolidVerticalLine(i, LCD_H - h, h, TEXT_COLOR); } int8_t y = max(FH, LCD_H - peak_y - FH); lcdDrawNumber(min(100, peak_x), y, ((reusableBuffer.spectrumAnalyser.freq - reusableBuffer.spectrumAnalyser.span / 2) + peak_x * (reusableBuffer.spectrumAnalyser.span / 128)) / 1000000, TINSIZE); lcdDrawText(lcdNextPos, y, "M", TINSIZE); return true; }