Merge pull request #3888 from martinbudden/bf_vtx_cms_smartaudio_split
Split smartaudio CMS code into separate module
This commit is contained in:
Martin Budden
GitHub
commit
61cb7c501c
|
|
@ -132,6 +132,7 @@ FC_SRC = \
|
||||||
cms/cms_menu_misc.c \
|
cms/cms_menu_misc.c \
|
||||||
cms/cms_menu_osd.c \
|
cms/cms_menu_osd.c \
|
||||||
cms/cms_menu_vtx_rtc6705.c \
|
cms/cms_menu_vtx_rtc6705.c \
|
||||||
|
cms/cms_menu_vtx_smartaudio.c \
|
||||||
common/colorconversion.c \
|
common/colorconversion.c \
|
||||||
common/gps_conversion.c \
|
common/gps_conversion.c \
|
||||||
drivers/display_ug2864hsweg01.c \
|
drivers/display_ug2864hsweg01.c \
|
||||||
|
|
|
||||||
|
|
@ -47,8 +47,8 @@
|
||||||
// User supplied menus
|
// User supplied menus
|
||||||
|
|
||||||
#include "io/vtx_rtc6705_cms.h"
|
#include "io/vtx_rtc6705_cms.h"
|
||||||
#include "io/vtx_smartaudio_cms.h"
|
|
||||||
#include "io/vtx_tramp.h"
|
#include "io/vtx_tramp.h"
|
||||||
|
#include "cms/cms_menu_vtx_smartaudio.h"
|
||||||
|
|
||||||
// Info
|
// Info
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -0,0 +1,639 @@
|
||||||
|
/*
|
||||||
|
* This file is part of Cleanflight.
|
||||||
|
*
|
||||||
|
* Cleanflight is free software: you can redistribute it and/or modify
|
||||||
|
* it under the terms of the GNU General Public License as published by
|
||||||
|
* the Free Software Foundation, either version 3 of the License, or
|
||||||
|
* (at your option) any later version.
|
||||||
|
*
|
||||||
|
* Cleanflight 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.
|
||||||
|
*
|
||||||
|
* You should have received a copy of the GNU General Public License
|
||||||
|
* along with Cleanflight. If not, see <http://www.gnu.org/licenses/>.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <stdbool.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <ctype.h>
|
||||||
|
|
||||||
|
#include "platform.h"
|
||||||
|
|
||||||
|
#ifdef CMS
|
||||||
|
|
||||||
|
#include "common/printf.h"
|
||||||
|
#include "common/utils.h"
|
||||||
|
|
||||||
|
#include "cms/cms.h"
|
||||||
|
#include "cms/cms_types.h"
|
||||||
|
#include "cms/cms_menu_vtx_smartaudio.h"
|
||||||
|
|
||||||
|
#include "io/vtx_string.h"
|
||||||
|
#include "io/vtx_smartaudio.h"
|
||||||
|
|
||||||
|
// Interface to CMS
|
||||||
|
|
||||||
|
// Operational Model and RF modes (CMS)
|
||||||
|
|
||||||
|
#define SACMS_OPMODEL_UNDEF 0 // Not known yet
|
||||||
|
#define SACMS_OPMODEL_FREE 1 // Freestyle model: Power up transmitting
|
||||||
|
#define SACMS_OPMODEL_RACE 2 // Race model: Power up in pit mode
|
||||||
|
|
||||||
|
uint8_t saCmsOpmodel = SACMS_OPMODEL_UNDEF;
|
||||||
|
|
||||||
|
#define SACMS_TXMODE_NODEF 0
|
||||||
|
#define SACMS_TXMODE_PIT_OUTRANGE 1
|
||||||
|
#define SACMS_TXMODE_PIT_INRANGE 2
|
||||||
|
#define SACMS_TXMODE_ACTIVE 3
|
||||||
|
|
||||||
|
uint8_t saCmsRFState; // RF state; ACTIVE, PIR, POR XXX Not currently used
|
||||||
|
|
||||||
|
uint8_t saCmsBand = 0;
|
||||||
|
uint8_t saCmsChan = 0;
|
||||||
|
uint8_t saCmsPower = 0;
|
||||||
|
|
||||||
|
// Frequency derived from channel table (used for reference in band/channel mode)
|
||||||
|
uint16_t saCmsFreqRef = 0;
|
||||||
|
|
||||||
|
uint16_t saCmsDeviceFreq = 0;
|
||||||
|
|
||||||
|
uint8_t saCmsDeviceStatus = 0;
|
||||||
|
uint8_t saCmsPower;
|
||||||
|
uint8_t saCmsPitFMode; // Undef(0), In-Range(1) or Out-Range(2)
|
||||||
|
uint8_t saCmsFselMode; // Channel(0) or User defined(1)
|
||||||
|
|
||||||
|
uint16_t saCmsORFreq = 0; // POR frequency
|
||||||
|
uint16_t saCmsORFreqNew; // POR frequency
|
||||||
|
|
||||||
|
uint16_t saCmsUserFreq = 0; // User defined frequency
|
||||||
|
uint16_t saCmsUserFreqNew; // User defined frequency
|
||||||
|
|
||||||
|
void saCmsUpdate(void)
|
||||||
|
{
|
||||||
|
// XXX Take care of pit mode update somewhere???
|
||||||
|
|
||||||
|
if (saCmsOpmodel == SACMS_OPMODEL_UNDEF) {
|
||||||
|
// This is a first valid response to GET_SETTINGS.
|
||||||
|
saCmsOpmodel = (saDevice.mode & SA_MODE_GET_PITMODE) ? SACMS_OPMODEL_RACE : SACMS_OPMODEL_FREE;
|
||||||
|
|
||||||
|
saCmsFselMode = (saDevice.mode & SA_MODE_GET_FREQ_BY_FREQ) ? 1 : 0;
|
||||||
|
|
||||||
|
saCmsBand = (saDevice.channel / 8) + 1;
|
||||||
|
saCmsChan = (saDevice.channel % 8) + 1;
|
||||||
|
saCmsFreqRef = vtx58frequencyTable[saDevice.channel / 8][saDevice.channel % 8];
|
||||||
|
|
||||||
|
saCmsDeviceFreq = vtx58frequencyTable[saDevice.channel / 8][saDevice.channel % 8];
|
||||||
|
|
||||||
|
if ((saDevice.mode & SA_MODE_GET_PITMODE) == 0) {
|
||||||
|
saCmsRFState = SACMS_TXMODE_ACTIVE;
|
||||||
|
} else if (saDevice.mode & SA_MODE_GET_IN_RANGE_PITMODE) {
|
||||||
|
saCmsRFState = SACMS_TXMODE_PIT_INRANGE;
|
||||||
|
} else {
|
||||||
|
saCmsRFState = SACMS_TXMODE_PIT_OUTRANGE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (saDevice.version == 2) {
|
||||||
|
saCmsPower = saDevice.power + 1; // XXX Take care V1
|
||||||
|
} else {
|
||||||
|
saCmsPower = saDacToPowerIndex(saDevice.power) + 1;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
saUpdateStatusString();
|
||||||
|
}
|
||||||
|
|
||||||
|
char saCmsStatusString[31] = "- -- ---- ---";
|
||||||
|
// m bc ffff ppp
|
||||||
|
// 0123456789012
|
||||||
|
|
||||||
|
static long saCmsConfigOpmodelByGvar(displayPort_t *, const void *self);
|
||||||
|
static long saCmsConfigPitFModeByGvar(displayPort_t *, const void *self);
|
||||||
|
static long saCmsConfigBandByGvar(displayPort_t *, const void *self);
|
||||||
|
static long saCmsConfigChanByGvar(displayPort_t *, const void *self);
|
||||||
|
static long saCmsConfigPowerByGvar(displayPort_t *, const void *self);
|
||||||
|
|
||||||
|
void saUpdateStatusString(void)
|
||||||
|
{
|
||||||
|
if (saDevice.version == 0)
|
||||||
|
return;
|
||||||
|
|
||||||
|
// XXX These should be done somewhere else
|
||||||
|
if (saCmsDeviceStatus == 0 && saDevice.version != 0)
|
||||||
|
saCmsDeviceStatus = saDevice.version;
|
||||||
|
if (saCmsORFreq == 0 && saDevice.orfreq != 0)
|
||||||
|
saCmsORFreq = saDevice.orfreq;
|
||||||
|
if (saCmsUserFreq == 0 && saDevice.freq != 0)
|
||||||
|
saCmsUserFreq = saDevice.freq;
|
||||||
|
|
||||||
|
if (saDevice.version == 2) {
|
||||||
|
if (saDevice.mode & SA_MODE_GET_OUT_RANGE_PITMODE)
|
||||||
|
saCmsPitFMode = 1;
|
||||||
|
else
|
||||||
|
saCmsPitFMode = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
saCmsStatusString[0] = "-FR"[saCmsOpmodel];
|
||||||
|
|
||||||
|
if (saCmsFselMode == 0) {
|
||||||
|
saCmsStatusString[2] = "ABEFR"[saDevice.channel / 8];
|
||||||
|
saCmsStatusString[3] = '1' + (saDevice.channel % 8);
|
||||||
|
} else {
|
||||||
|
saCmsStatusString[2] = 'U';
|
||||||
|
saCmsStatusString[3] = 'F';
|
||||||
|
}
|
||||||
|
|
||||||
|
if ((saDevice.mode & SA_MODE_GET_PITMODE)
|
||||||
|
&& (saDevice.mode & SA_MODE_GET_OUT_RANGE_PITMODE))
|
||||||
|
tfp_sprintf(&saCmsStatusString[5], "%4d", saDevice.orfreq);
|
||||||
|
else if (saDevice.mode & SA_MODE_GET_FREQ_BY_FREQ)
|
||||||
|
tfp_sprintf(&saCmsStatusString[5], "%4d", saDevice.freq);
|
||||||
|
else
|
||||||
|
tfp_sprintf(&saCmsStatusString[5], "%4d",
|
||||||
|
vtx58frequencyTable[saDevice.channel / 8][saDevice.channel % 8]);
|
||||||
|
|
||||||
|
saCmsStatusString[9] = ' ';
|
||||||
|
|
||||||
|
if (saDevice.mode & SA_MODE_GET_PITMODE) {
|
||||||
|
saCmsStatusString[10] = 'P';
|
||||||
|
if (saDevice.mode & SA_MODE_GET_IN_RANGE_PITMODE) {
|
||||||
|
saCmsStatusString[11] = 'I';
|
||||||
|
} else {
|
||||||
|
saCmsStatusString[11] = 'O';
|
||||||
|
}
|
||||||
|
saCmsStatusString[12] = 'R';
|
||||||
|
saCmsStatusString[13] = 0;
|
||||||
|
} else {
|
||||||
|
tfp_sprintf(&saCmsStatusString[10], "%3d", (saDevice.version == 2) ? saPowerTable[saDevice.power].rfpower : saPowerTable[saDacToPowerIndex(saDevice.power)].rfpower);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static long saCmsConfigBandByGvar(displayPort_t *pDisp, const void *self)
|
||||||
|
{
|
||||||
|
UNUSED(pDisp);
|
||||||
|
UNUSED(self);
|
||||||
|
|
||||||
|
if (saDevice.version == 0) {
|
||||||
|
// Bounce back; not online yet
|
||||||
|
saCmsBand = 0;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (saCmsBand == 0) {
|
||||||
|
// Bouce back, no going back to undef state
|
||||||
|
saCmsBand = 1;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
if ((saCmsOpmodel == SACMS_OPMODEL_FREE) && !saDeferred)
|
||||||
|
saSetBandAndChannel(saCmsBand - 1, saCmsChan - 1);
|
||||||
|
|
||||||
|
saCmsFreqRef = vtx58frequencyTable[saCmsBand - 1][saCmsChan - 1];
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static long saCmsConfigChanByGvar(displayPort_t *pDisp, const void *self)
|
||||||
|
{
|
||||||
|
UNUSED(pDisp);
|
||||||
|
UNUSED(self);
|
||||||
|
|
||||||
|
if (saDevice.version == 0) {
|
||||||
|
// Bounce back; not online yet
|
||||||
|
saCmsChan = 0;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (saCmsChan == 0) {
|
||||||
|
// Bounce back; no going back to undef state
|
||||||
|
saCmsChan = 1;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
if ((saCmsOpmodel == SACMS_OPMODEL_FREE) && !saDeferred)
|
||||||
|
saSetBandAndChannel(saCmsBand - 1, saCmsChan - 1);
|
||||||
|
|
||||||
|
saCmsFreqRef = vtx58frequencyTable[saCmsBand - 1][saCmsChan - 1];
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static long saCmsConfigPowerByGvar(displayPort_t *pDisp, const void *self)
|
||||||
|
{
|
||||||
|
UNUSED(pDisp);
|
||||||
|
UNUSED(self);
|
||||||
|
|
||||||
|
if (saDevice.version == 0) {
|
||||||
|
// Bounce back; not online yet
|
||||||
|
saCmsPower = 0;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (saCmsPower == 0) {
|
||||||
|
// Bouce back; no going back to undef state
|
||||||
|
saCmsPower = 1;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (saCmsOpmodel == SACMS_OPMODEL_FREE)
|
||||||
|
saSetPowerByIndex(saCmsPower - 1);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static long saCmsConfigPitFModeByGvar(displayPort_t *pDisp, const void *self)
|
||||||
|
{
|
||||||
|
UNUSED(pDisp);
|
||||||
|
UNUSED(self);
|
||||||
|
|
||||||
|
if (saDevice.version == 1) {
|
||||||
|
// V1 device doesn't support PIT mode; bounce back.
|
||||||
|
saCmsPitFMode = 0;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
dprintf(("saCmsConfigPitFmodeByGbar: saCmsPitFMode %d\r\n", saCmsPitFMode));
|
||||||
|
|
||||||
|
if (saCmsPitFMode == 0) {
|
||||||
|
// Bounce back
|
||||||
|
saCmsPitFMode = 1;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (saCmsPitFMode == 1) {
|
||||||
|
saSetMode(SA_MODE_SET_IN_RANGE_PITMODE);
|
||||||
|
} else {
|
||||||
|
saSetMode(SA_MODE_SET_OUT_RANGE_PITMODE);
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static long saCmsConfigFreqModeByGvar(displayPort_t *pDisp, const void *self); // Forward
|
||||||
|
|
||||||
|
static long saCmsConfigOpmodelByGvar(displayPort_t *pDisp, const void *self)
|
||||||
|
{
|
||||||
|
UNUSED(pDisp);
|
||||||
|
UNUSED(self);
|
||||||
|
|
||||||
|
if (saDevice.version == 1) {
|
||||||
|
if (saCmsOpmodel != SACMS_OPMODEL_FREE)
|
||||||
|
saCmsOpmodel = SACMS_OPMODEL_FREE;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t opmodel = saCmsOpmodel;
|
||||||
|
|
||||||
|
dprintf(("saCmsConfigOpmodelByGvar: opmodel %d\r\n", opmodel));
|
||||||
|
|
||||||
|
if (opmodel == SACMS_OPMODEL_FREE) {
|
||||||
|
// VTX should power up transmitting.
|
||||||
|
// Turn off In-Range and Out-Range bits
|
||||||
|
saSetMode(0);
|
||||||
|
} else if (opmodel == SACMS_OPMODEL_RACE) {
|
||||||
|
// VTX should power up in pit mode.
|
||||||
|
// Default PitFMode is in-range to prevent users without
|
||||||
|
// out-range receivers from getting blinded.
|
||||||
|
saCmsPitFMode = 0;
|
||||||
|
saCmsConfigPitFModeByGvar(pDisp, self);
|
||||||
|
|
||||||
|
// Direct frequency mode is not available in RACE opmodel
|
||||||
|
saCmsFselMode = 0;
|
||||||
|
saCmsConfigFreqModeByGvar(pDisp, self);
|
||||||
|
} else {
|
||||||
|
// Trying to go back to unknown state; bounce back
|
||||||
|
saCmsOpmodel = SACMS_OPMODEL_UNDEF + 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static const char * const saCmsDeviceStatusNames[] = {
|
||||||
|
"OFFL",
|
||||||
|
"ONL V1",
|
||||||
|
"ONL V2",
|
||||||
|
};
|
||||||
|
|
||||||
|
static OSD_TAB_t saCmsEntOnline = { &saCmsDeviceStatus, 2, saCmsDeviceStatusNames };
|
||||||
|
|
||||||
|
static OSD_Entry saCmsMenuStatsEntries[] = {
|
||||||
|
{ "- SA STATS -", OME_Label, NULL, NULL, 0 },
|
||||||
|
{ "STATUS", OME_TAB, NULL, &saCmsEntOnline, DYNAMIC },
|
||||||
|
{ "BAUDRATE", OME_UINT16, NULL, &(OSD_UINT16_t){ &sa_smartbaud, 0, 0, 0 }, DYNAMIC },
|
||||||
|
{ "SENT", OME_UINT16, NULL, &(OSD_UINT16_t){ &saStat.pktsent, 0, 0, 0 }, DYNAMIC },
|
||||||
|
{ "RCVD", OME_UINT16, NULL, &(OSD_UINT16_t){ &saStat.pktrcvd, 0, 0, 0 }, DYNAMIC },
|
||||||
|
{ "BADPRE", OME_UINT16, NULL, &(OSD_UINT16_t){ &saStat.badpre, 0, 0, 0 }, DYNAMIC },
|
||||||
|
{ "BADLEN", OME_UINT16, NULL, &(OSD_UINT16_t){ &saStat.badlen, 0, 0, 0 }, DYNAMIC },
|
||||||
|
{ "CRCERR", OME_UINT16, NULL, &(OSD_UINT16_t){ &saStat.crc, 0, 0, 0 }, DYNAMIC },
|
||||||
|
{ "OOOERR", OME_UINT16, NULL, &(OSD_UINT16_t){ &saStat.ooopresp, 0, 0, 0 }, DYNAMIC },
|
||||||
|
{ "BACK", OME_Back, NULL, NULL, 0 },
|
||||||
|
{ NULL, OME_END, NULL, NULL, 0 }
|
||||||
|
};
|
||||||
|
|
||||||
|
static CMS_Menu saCmsMenuStats = {
|
||||||
|
.GUARD_text = "XSAST",
|
||||||
|
.GUARD_type = OME_MENU,
|
||||||
|
.onEnter = NULL,
|
||||||
|
.onExit = NULL,
|
||||||
|
.onGlobalExit = NULL,
|
||||||
|
.entries = saCmsMenuStatsEntries
|
||||||
|
};
|
||||||
|
|
||||||
|
static OSD_TAB_t saCmsEntBand = { &saCmsBand, 5, vtx58BandNames };
|
||||||
|
|
||||||
|
static OSD_TAB_t saCmsEntChan = { &saCmsChan, 8, vtx58ChannelNames };
|
||||||
|
|
||||||
|
static const char * const saCmsPowerNames[] = {
|
||||||
|
"---",
|
||||||
|
"25 ",
|
||||||
|
"200",
|
||||||
|
"500",
|
||||||
|
"800",
|
||||||
|
};
|
||||||
|
|
||||||
|
static OSD_TAB_t saCmsEntPower = { &saCmsPower, 4, saCmsPowerNames};
|
||||||
|
|
||||||
|
static OSD_UINT16_t saCmsEntFreqRef = { &saCmsFreqRef, 5600, 5900, 0 };
|
||||||
|
|
||||||
|
static const char * const saCmsOpmodelNames[] = {
|
||||||
|
"----",
|
||||||
|
"FREE",
|
||||||
|
"RACE",
|
||||||
|
};
|
||||||
|
|
||||||
|
static const char * const saCmsFselModeNames[] = {
|
||||||
|
"CHAN",
|
||||||
|
"USER"
|
||||||
|
};
|
||||||
|
|
||||||
|
static const char * const saCmsPitFModeNames[] = {
|
||||||
|
"---",
|
||||||
|
"PIR",
|
||||||
|
"POR"
|
||||||
|
};
|
||||||
|
|
||||||
|
static OSD_TAB_t saCmsEntPitFMode = { &saCmsPitFMode, 1, saCmsPitFModeNames };
|
||||||
|
|
||||||
|
static long sacms_SetupTopMenu(void); // Forward
|
||||||
|
|
||||||
|
static long saCmsConfigFreqModeByGvar(displayPort_t *pDisp, const void *self)
|
||||||
|
{
|
||||||
|
UNUSED(pDisp);
|
||||||
|
UNUSED(self);
|
||||||
|
|
||||||
|
if (saCmsFselMode == 0) {
|
||||||
|
// CHAN
|
||||||
|
saSetBandAndChannel(saCmsBand - 1, saCmsChan - 1);
|
||||||
|
} else {
|
||||||
|
// USER: User frequency mode is only available in FREE opmodel.
|
||||||
|
if (saCmsOpmodel == SACMS_OPMODEL_FREE) {
|
||||||
|
saSetFreq(saCmsUserFreq);
|
||||||
|
} else {
|
||||||
|
// Bounce back
|
||||||
|
saCmsFselMode = 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
sacms_SetupTopMenu();
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static long saCmsCommence(displayPort_t *pDisp, const void *self)
|
||||||
|
{
|
||||||
|
UNUSED(pDisp);
|
||||||
|
UNUSED(self);
|
||||||
|
|
||||||
|
if (saCmsOpmodel == SACMS_OPMODEL_RACE) {
|
||||||
|
// Race model
|
||||||
|
// Setup band, freq and power.
|
||||||
|
|
||||||
|
saSetBandAndChannel(saCmsBand - 1, saCmsChan - 1);
|
||||||
|
|
||||||
|
// If in pit mode, cancel it.
|
||||||
|
|
||||||
|
if (saCmsPitFMode == 0)
|
||||||
|
saSetMode(SA_MODE_CLR_PITMODE|SA_MODE_SET_IN_RANGE_PITMODE);
|
||||||
|
else
|
||||||
|
saSetMode(SA_MODE_CLR_PITMODE|SA_MODE_SET_OUT_RANGE_PITMODE);
|
||||||
|
} else {
|
||||||
|
// Freestyle model
|
||||||
|
// Setup band and freq / user freq
|
||||||
|
if (saCmsFselMode == 0)
|
||||||
|
saSetBandAndChannel(saCmsBand - 1, saCmsChan - 1);
|
||||||
|
else
|
||||||
|
saSetFreq(saCmsUserFreq);
|
||||||
|
}
|
||||||
|
|
||||||
|
saSetPowerByIndex(saCmsPower - 1);
|
||||||
|
|
||||||
|
return MENU_CHAIN_BACK;
|
||||||
|
}
|
||||||
|
|
||||||
|
static long saCmsSetPORFreqOnEnter(void)
|
||||||
|
{
|
||||||
|
if (saDevice.version == 1)
|
||||||
|
return MENU_CHAIN_BACK;
|
||||||
|
|
||||||
|
saCmsORFreqNew = saCmsORFreq;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static long saCmsSetPORFreq(displayPort_t *pDisp, const void *self)
|
||||||
|
{
|
||||||
|
UNUSED(pDisp);
|
||||||
|
UNUSED(self);
|
||||||
|
|
||||||
|
saSetFreq(saCmsORFreqNew|SA_FREQ_SETPIT);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static char *saCmsORFreqGetString(void)
|
||||||
|
{
|
||||||
|
static char pbuf[5];
|
||||||
|
|
||||||
|
tfp_sprintf(pbuf, "%4d", saCmsORFreq);
|
||||||
|
|
||||||
|
return pbuf;
|
||||||
|
}
|
||||||
|
|
||||||
|
static char *saCmsUserFreqGetString(void)
|
||||||
|
{
|
||||||
|
static char pbuf[5];
|
||||||
|
|
||||||
|
tfp_sprintf(pbuf, "%4d", saCmsUserFreq);
|
||||||
|
|
||||||
|
return pbuf;
|
||||||
|
}
|
||||||
|
|
||||||
|
static long saCmsSetUserFreqOnEnter(void)
|
||||||
|
{
|
||||||
|
saCmsUserFreqNew = saCmsUserFreq;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static long saCmsConfigUserFreq(displayPort_t *pDisp, const void *self)
|
||||||
|
{
|
||||||
|
UNUSED(pDisp);
|
||||||
|
UNUSED(self);
|
||||||
|
|
||||||
|
saCmsUserFreq = saCmsUserFreqNew;
|
||||||
|
//saSetFreq(saCmsUserFreq);
|
||||||
|
|
||||||
|
return MENU_CHAIN_BACK;
|
||||||
|
}
|
||||||
|
|
||||||
|
static OSD_Entry saCmsMenuPORFreqEntries[] = {
|
||||||
|
{ "- POR FREQ -", OME_Label, NULL, NULL, 0 },
|
||||||
|
|
||||||
|
{ "CUR FREQ", OME_UINT16, NULL, &(OSD_UINT16_t){ &saCmsORFreq, 5000, 5900, 0 }, DYNAMIC },
|
||||||
|
{ "NEW FREQ", OME_UINT16, NULL, &(OSD_UINT16_t){ &saCmsORFreqNew, 5000, 5900, 1 }, 0 },
|
||||||
|
{ "SET", OME_Funcall, saCmsSetPORFreq, NULL, 0 },
|
||||||
|
|
||||||
|
{ "BACK", OME_Back, NULL, NULL, 0 },
|
||||||
|
{ NULL, OME_END, NULL, NULL, 0 }
|
||||||
|
};
|
||||||
|
|
||||||
|
static CMS_Menu saCmsMenuPORFreq =
|
||||||
|
{
|
||||||
|
.GUARD_text = "XSAPOR",
|
||||||
|
.GUARD_type = OME_MENU,
|
||||||
|
.onEnter = saCmsSetPORFreqOnEnter,
|
||||||
|
.onExit = NULL,
|
||||||
|
.onGlobalExit = NULL,
|
||||||
|
.entries = saCmsMenuPORFreqEntries,
|
||||||
|
};
|
||||||
|
|
||||||
|
static OSD_Entry saCmsMenuUserFreqEntries[] = {
|
||||||
|
{ "- USER FREQ -", OME_Label, NULL, NULL, 0 },
|
||||||
|
|
||||||
|
{ "CUR FREQ", OME_UINT16, NULL, &(OSD_UINT16_t){ &saCmsUserFreq, 5000, 5900, 0 }, DYNAMIC },
|
||||||
|
{ "NEW FREQ", OME_UINT16, NULL, &(OSD_UINT16_t){ &saCmsUserFreqNew, 5000, 5900, 1 }, 0 },
|
||||||
|
{ "SET", OME_Funcall, saCmsConfigUserFreq, NULL, 0 },
|
||||||
|
|
||||||
|
{ "BACK", OME_Back, NULL, NULL, 0 },
|
||||||
|
{ NULL, OME_END, NULL, NULL, 0 }
|
||||||
|
};
|
||||||
|
|
||||||
|
static CMS_Menu saCmsMenuUserFreq =
|
||||||
|
{
|
||||||
|
.GUARD_text = "XSAUFQ",
|
||||||
|
.GUARD_type = OME_MENU,
|
||||||
|
.onEnter = saCmsSetUserFreqOnEnter,
|
||||||
|
.onExit = NULL,
|
||||||
|
.onGlobalExit = NULL,
|
||||||
|
.entries = saCmsMenuUserFreqEntries,
|
||||||
|
};
|
||||||
|
|
||||||
|
static OSD_TAB_t saCmsEntFselMode = { &saCmsFselMode, 1, saCmsFselModeNames };
|
||||||
|
|
||||||
|
static OSD_Entry saCmsMenuConfigEntries[] = {
|
||||||
|
{ "- SA CONFIG -", OME_Label, NULL, NULL, 0 },
|
||||||
|
|
||||||
|
{ "OP MODEL", OME_TAB, saCmsConfigOpmodelByGvar, &(OSD_TAB_t){ &saCmsOpmodel, 2, saCmsOpmodelNames }, DYNAMIC },
|
||||||
|
{ "FSEL MODE", OME_TAB, saCmsConfigFreqModeByGvar, &saCmsEntFselMode, DYNAMIC },
|
||||||
|
{ "PIT FMODE", OME_TAB, saCmsConfigPitFModeByGvar, &saCmsEntPitFMode, 0 },
|
||||||
|
{ "POR FREQ", OME_Submenu, (CMSEntryFuncPtr)saCmsORFreqGetString, &saCmsMenuPORFreq, OPTSTRING },
|
||||||
|
{ "STATX", OME_Submenu, cmsMenuChange, &saCmsMenuStats, 0 },
|
||||||
|
|
||||||
|
{ "BACK", OME_Back, NULL, NULL, 0 },
|
||||||
|
{ NULL, OME_END, NULL, NULL, 0 }
|
||||||
|
};
|
||||||
|
|
||||||
|
static CMS_Menu saCmsMenuConfig = {
|
||||||
|
.GUARD_text = "XSACFG",
|
||||||
|
.GUARD_type = OME_MENU,
|
||||||
|
.onEnter = NULL,
|
||||||
|
.onExit = NULL,
|
||||||
|
.onGlobalExit = NULL,
|
||||||
|
.entries = saCmsMenuConfigEntries
|
||||||
|
};
|
||||||
|
|
||||||
|
static OSD_Entry saCmsMenuCommenceEntries[] = {
|
||||||
|
{ "CONFIRM", OME_Label, NULL, NULL, 0 },
|
||||||
|
|
||||||
|
{ "YES", OME_Funcall, saCmsCommence, NULL, 0 },
|
||||||
|
|
||||||
|
{ "BACK", OME_Back, NULL, NULL, 0 },
|
||||||
|
{ NULL, OME_END, NULL, NULL, 0 }
|
||||||
|
};
|
||||||
|
|
||||||
|
static CMS_Menu saCmsMenuCommence = {
|
||||||
|
.GUARD_text = "XVTXCOM",
|
||||||
|
.GUARD_type = OME_MENU,
|
||||||
|
.onEnter = NULL,
|
||||||
|
.onExit = NULL,
|
||||||
|
.onGlobalExit = NULL,
|
||||||
|
.entries = saCmsMenuCommenceEntries,
|
||||||
|
};
|
||||||
|
|
||||||
|
static OSD_Entry saCmsMenuFreqModeEntries[] = {
|
||||||
|
{ "- SMARTAUDIO -", OME_Label, NULL, NULL, 0 },
|
||||||
|
|
||||||
|
{ "", OME_Label, NULL, saCmsStatusString, DYNAMIC },
|
||||||
|
{ "FREQ", OME_Submenu, (CMSEntryFuncPtr)saCmsUserFreqGetString, &saCmsMenuUserFreq, OPTSTRING },
|
||||||
|
{ "POWER", OME_TAB, saCmsConfigPowerByGvar, &saCmsEntPower, 0 },
|
||||||
|
{ "SET", OME_Submenu, cmsMenuChange, &saCmsMenuCommence, 0 },
|
||||||
|
{ "CONFIG", OME_Submenu, cmsMenuChange, &saCmsMenuConfig, 0 },
|
||||||
|
|
||||||
|
{ "BACK", OME_Back, NULL, NULL, 0 },
|
||||||
|
{ NULL, OME_END, NULL, NULL, 0 }
|
||||||
|
};
|
||||||
|
|
||||||
|
static OSD_Entry saCmsMenuChanModeEntries[] =
|
||||||
|
{
|
||||||
|
{ "- SMARTAUDIO -", OME_Label, NULL, NULL, 0 },
|
||||||
|
|
||||||
|
{ "", OME_Label, NULL, saCmsStatusString, DYNAMIC },
|
||||||
|
{ "BAND", OME_TAB, saCmsConfigBandByGvar, &saCmsEntBand, 0 },
|
||||||
|
{ "CHAN", OME_TAB, saCmsConfigChanByGvar, &saCmsEntChan, 0 },
|
||||||
|
{ "(FREQ)", OME_UINT16, NULL, &saCmsEntFreqRef, DYNAMIC },
|
||||||
|
{ "POWER", OME_TAB, saCmsConfigPowerByGvar, &saCmsEntPower, 0 },
|
||||||
|
{ "SET", OME_Submenu, cmsMenuChange, &saCmsMenuCommence, 0 },
|
||||||
|
{ "CONFIG", OME_Submenu, cmsMenuChange, &saCmsMenuConfig, 0 },
|
||||||
|
|
||||||
|
{ "BACK", OME_Back, NULL, NULL, 0 },
|
||||||
|
{ NULL, OME_END, NULL, NULL, 0 }
|
||||||
|
};
|
||||||
|
|
||||||
|
static OSD_Entry saCmsMenuOfflineEntries[] =
|
||||||
|
{
|
||||||
|
{ "- VTX SMARTAUDIO -", OME_Label, NULL, NULL, 0 },
|
||||||
|
|
||||||
|
{ "", OME_Label, NULL, saCmsStatusString, DYNAMIC },
|
||||||
|
{ "STATX", OME_Submenu, cmsMenuChange, &saCmsMenuStats, 0 },
|
||||||
|
|
||||||
|
{ "BACK", OME_Back, NULL, NULL, 0 },
|
||||||
|
{ NULL, OME_END, NULL, NULL, 0 }
|
||||||
|
};
|
||||||
|
|
||||||
|
CMS_Menu cmsx_menuVtxSmartAudio; // Forward
|
||||||
|
|
||||||
|
static long sacms_SetupTopMenu(void)
|
||||||
|
{
|
||||||
|
if (saCmsDeviceStatus) {
|
||||||
|
if (saCmsFselMode == 0)
|
||||||
|
cmsx_menuVtxSmartAudio.entries = saCmsMenuChanModeEntries;
|
||||||
|
else
|
||||||
|
cmsx_menuVtxSmartAudio.entries = saCmsMenuFreqModeEntries;
|
||||||
|
} else {
|
||||||
|
cmsx_menuVtxSmartAudio.entries = saCmsMenuOfflineEntries;
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
CMS_Menu cmsx_menuVtxSmartAudio = {
|
||||||
|
.GUARD_text = "XVTXSA",
|
||||||
|
.GUARD_type = OME_MENU,
|
||||||
|
.onEnter = sacms_SetupTopMenu,
|
||||||
|
.onExit = NULL,
|
||||||
|
.onGlobalExit = NULL,
|
||||||
|
.entries = saCmsMenuOfflineEntries,
|
||||||
|
};
|
||||||
|
|
||||||
|
#endif // CMS
|
||||||
|
|
@ -0,0 +1,25 @@
|
||||||
|
/*
|
||||||
|
* This file is part of Cleanflight.
|
||||||
|
*
|
||||||
|
* Cleanflight is free software: you can redistribute it and/or modify
|
||||||
|
* it under the terms of the GNU General Public License as published by
|
||||||
|
* the Free Software Foundation, either version 3 of the License, or
|
||||||
|
* (at your option) any later version.
|
||||||
|
*
|
||||||
|
* Cleanflight 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.
|
||||||
|
*
|
||||||
|
* You should have received a copy of the GNU General Public License
|
||||||
|
* along with Cleanflight. If not, see <http://www.gnu.org/licenses/>.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#pragma once
|
||||||
|
|
||||||
|
#include "cms/cms.h"
|
||||||
|
#include "cms/cms_types.h"
|
||||||
|
|
||||||
|
extern CMS_Menu cmsx_menuVtxSmartAudio;
|
||||||
|
|
||||||
|
void saUpdateStatusString(void);
|
||||||
|
|
@ -26,9 +26,12 @@
|
||||||
|
|
||||||
#if defined(VTX_SMARTAUDIO) && defined(VTX_CONTROL)
|
#if defined(VTX_SMARTAUDIO) && defined(VTX_CONTROL)
|
||||||
#include "build/build_config.h"
|
#include "build/build_config.h"
|
||||||
|
#include "build/debug.h"
|
||||||
|
|
||||||
|
|
||||||
#include "cms/cms.h"
|
#include "cms/cms.h"
|
||||||
#include "cms/cms_types.h"
|
#include "cms/cms_types.h"
|
||||||
|
#include "cms/cms_menu_vtx_smartaudio.h"
|
||||||
|
|
||||||
#include "common/printf.h"
|
#include "common/printf.h"
|
||||||
#include "common/utils.h"
|
#include "common/utils.h"
|
||||||
|
|
@ -53,25 +56,9 @@
|
||||||
//#define SMARTAUDIO_DEBUG_MONITOR
|
//#define SMARTAUDIO_DEBUG_MONITOR
|
||||||
|
|
||||||
#ifdef SMARTAUDIO_DPRINTF
|
#ifdef SMARTAUDIO_DPRINTF
|
||||||
|
|
||||||
#ifdef OMNIBUSF4
|
|
||||||
#define DPRINTF_SERIAL_PORT SERIAL_PORT_USART3
|
|
||||||
#else
|
|
||||||
#define DPRINTF_SERIAL_PORT SERIAL_PORT_USART1
|
|
||||||
#endif
|
|
||||||
|
|
||||||
serialPort_t *debugSerialPort = NULL;
|
serialPort_t *debugSerialPort = NULL;
|
||||||
#define dprintf(x) if (debugSerialPort) printf x
|
|
||||||
#else
|
|
||||||
#define dprintf(x)
|
|
||||||
#endif // SMARTAUDIO_DPRINTF
|
#endif // SMARTAUDIO_DPRINTF
|
||||||
|
|
||||||
#include "build/debug.h"
|
|
||||||
|
|
||||||
#ifdef CMS
|
|
||||||
static void saUpdateStatusString(void); // Forward
|
|
||||||
#endif
|
|
||||||
|
|
||||||
static serialPort_t *smartAudioSerialPort = NULL;
|
static serialPort_t *smartAudioSerialPort = NULL;
|
||||||
|
|
||||||
#if defined(CMS) || defined(VTX_COMMON)
|
#if defined(CMS) || defined(VTX_COMMON)
|
||||||
|
|
@ -107,44 +94,15 @@ enum {
|
||||||
// This is not a good design; can't distinguish command from response this way.
|
// This is not a good design; can't distinguish command from response this way.
|
||||||
#define SACMD(cmd) (((cmd) << 1) | 1)
|
#define SACMD(cmd) (((cmd) << 1) | 1)
|
||||||
|
|
||||||
// opmode flags, GET side
|
|
||||||
#define SA_MODE_GET_FREQ_BY_FREQ 1
|
|
||||||
#define SA_MODE_GET_PITMODE 2
|
|
||||||
#define SA_MODE_GET_IN_RANGE_PITMODE 4
|
|
||||||
#define SA_MODE_GET_OUT_RANGE_PITMODE 8
|
|
||||||
#define SA_MODE_GET_UNLOCK 16
|
|
||||||
#define SA_MODE_GET_DEFERRED_FREQ 32
|
|
||||||
|
|
||||||
#define SA_IS_PITMODE(n) ((n) & SA_MODE_GET_PITMODE)
|
#define SA_IS_PITMODE(n) ((n) & SA_MODE_GET_PITMODE)
|
||||||
#define SA_IS_PIRMODE(n) (((n) & SA_MODE_GET_PITMODE) && ((n) & SA_MODE_GET_IN_RANGE_PITMODE))
|
#define SA_IS_PIRMODE(n) (((n) & SA_MODE_GET_PITMODE) && ((n) & SA_MODE_GET_IN_RANGE_PITMODE))
|
||||||
#define SA_IS_PORMODE(n) (((n) & SA_MODE_GET_PITMODE) && ((n) & SA_MODE_GET_OUT_RANGE_PITMODE))
|
#define SA_IS_PORMODE(n) (((n) & SA_MODE_GET_PITMODE) && ((n) & SA_MODE_GET_OUT_RANGE_PITMODE))
|
||||||
|
|
||||||
// opmode flags, SET side
|
|
||||||
#define SA_MODE_SET_IN_RANGE_PITMODE 1 // Immediate
|
|
||||||
#define SA_MODE_SET_OUT_RANGE_PITMODE 2 // Immediate
|
|
||||||
#define SA_MODE_CLR_PITMODE 4 // Immediate
|
|
||||||
#define SA_MODE_SET_UNLOCK 8
|
|
||||||
#define SA_MODE_SET_LOCK 0 // ~UNLOCK
|
|
||||||
#define SA_MODE_SET_DEFERRED_FREQ 16
|
|
||||||
|
|
||||||
// SetFrequency flags, for pit mode frequency manipulation
|
|
||||||
#define SA_FREQ_GETPIT (1 << 14)
|
|
||||||
#define SA_FREQ_SETPIT (1 << 15)
|
|
||||||
#define SA_FREQ_MASK (~(SA_FREQ_GETPIT|SA_FREQ_SETPIT))
|
|
||||||
|
|
||||||
// Statistical counters, for user side trouble shooting.
|
// Statistical counters, for user side trouble shooting.
|
||||||
|
|
||||||
typedef struct smartAudioStat_s {
|
smartAudioStat_t saStat = {
|
||||||
uint16_t pktsent;
|
|
||||||
uint16_t pktrcvd;
|
|
||||||
uint16_t badpre;
|
|
||||||
uint16_t badlen;
|
|
||||||
uint16_t crc;
|
|
||||||
uint16_t ooopresp;
|
|
||||||
uint16_t badcode;
|
|
||||||
} smartAudioStat_t;
|
|
||||||
|
|
||||||
static smartAudioStat_t saStat = {
|
|
||||||
.pktsent = 0,
|
.pktsent = 0,
|
||||||
.pktrcvd = 0,
|
.pktrcvd = 0,
|
||||||
.badpre = 0,
|
.badpre = 0,
|
||||||
|
|
@ -154,13 +112,7 @@ static smartAudioStat_t saStat = {
|
||||||
.badcode = 0,
|
.badcode = 0,
|
||||||
};
|
};
|
||||||
|
|
||||||
typedef struct saPowerTable_s {
|
saPowerTable_t saPowerTable[] = {
|
||||||
int rfpower;
|
|
||||||
int16_t valueV1;
|
|
||||||
int16_t valueV2;
|
|
||||||
} saPowerTable_t;
|
|
||||||
|
|
||||||
static saPowerTable_t saPowerTable[] = {
|
|
||||||
{ 25, 7, 0 },
|
{ 25, 7, 0 },
|
||||||
{ 200, 16, 1 },
|
{ 200, 16, 1 },
|
||||||
{ 500, 25, 2 },
|
{ 500, 25, 2 },
|
||||||
|
|
@ -169,16 +121,7 @@ static saPowerTable_t saPowerTable[] = {
|
||||||
|
|
||||||
// Last received device ('hard') states
|
// Last received device ('hard') states
|
||||||
|
|
||||||
typedef struct smartAudioDevice_s {
|
smartAudioDevice_t saDevice = {
|
||||||
int8_t version;
|
|
||||||
int8_t channel;
|
|
||||||
int8_t power;
|
|
||||||
int8_t mode;
|
|
||||||
uint16_t freq;
|
|
||||||
uint16_t orfreq;
|
|
||||||
} smartAudioDevice_t;
|
|
||||||
|
|
||||||
static smartAudioDevice_t saDevice = {
|
|
||||||
.version = 0,
|
.version = 0,
|
||||||
.channel = -1,
|
.channel = -1,
|
||||||
.power = -1,
|
.power = -1,
|
||||||
|
|
@ -195,7 +138,7 @@ static smartAudioDevice_t saDevicePrev = {
|
||||||
static uint8_t saLockMode = SA_MODE_SET_UNLOCK; // saCms variable?
|
static uint8_t saLockMode = SA_MODE_SET_UNLOCK; // saCms variable?
|
||||||
|
|
||||||
// XXX Should be configurable by user?
|
// XXX Should be configurable by user?
|
||||||
static bool saDeferred = true; // saCms variable?
|
bool saDeferred = true; // saCms variable?
|
||||||
|
|
||||||
// Receive frame reassembly buffer
|
// Receive frame reassembly buffer
|
||||||
#define SA_MAX_RCVLEN 11
|
#define SA_MAX_RCVLEN 11
|
||||||
|
|
@ -247,15 +190,13 @@ static void saPrintSettings(void)
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
static int saDacToPowerIndex(int dac)
|
int saDacToPowerIndex(int dac)
|
||||||
{
|
{
|
||||||
int idx;
|
for (int idx = 3 ; idx >= 0 ; idx--) {
|
||||||
|
|
||||||
for (idx = 3 ; idx >= 0 ; idx--) {
|
|
||||||
if (saPowerTable[idx].valueV1 <= dac)
|
if (saPowerTable[idx].valueV1 <= dac)
|
||||||
return(idx);
|
return idx;
|
||||||
}
|
}
|
||||||
return(0);
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
//
|
//
|
||||||
|
|
@ -597,7 +538,7 @@ static void saGetSettings(void)
|
||||||
saQueueCmd(bufGetSettings, 5);
|
saQueueCmd(bufGetSettings, 5);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void saSetFreq(uint16_t freq)
|
void saSetFreq(uint16_t freq)
|
||||||
{
|
{
|
||||||
static uint8_t buf[7] = { 0xAA, 0x55, SACMD(SA_CMD_SET_FREQ), 2 };
|
static uint8_t buf[7] = { 0xAA, 0x55, SACMD(SA_CMD_SET_FREQ), 2 };
|
||||||
|
|
||||||
|
|
@ -638,7 +579,7 @@ void saSetBandAndChannel(uint8_t band, uint8_t channel)
|
||||||
saQueueCmd(buf, 6);
|
saQueueCmd(buf, 6);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void saSetMode(int mode)
|
void saSetMode(int mode)
|
||||||
{
|
{
|
||||||
static uint8_t buf[6] = { 0xAA, 0x55, SACMD(SA_CMD_SET_MODE), 1 };
|
static uint8_t buf[6] = { 0xAA, 0x55, SACMD(SA_CMD_SET_MODE), 1 };
|
||||||
|
|
||||||
|
|
@ -854,611 +795,5 @@ static const vtxVTable_t saVTable = {
|
||||||
};
|
};
|
||||||
#endif // VTX_COMMON
|
#endif // VTX_COMMON
|
||||||
|
|
||||||
#ifdef CMS
|
|
||||||
|
|
||||||
// Interface to CMS
|
|
||||||
|
|
||||||
// Operational Model and RF modes (CMS)
|
|
||||||
|
|
||||||
#define SACMS_OPMODEL_UNDEF 0 // Not known yet
|
|
||||||
#define SACMS_OPMODEL_FREE 1 // Freestyle model: Power up transmitting
|
|
||||||
#define SACMS_OPMODEL_RACE 2 // Race model: Power up in pit mode
|
|
||||||
|
|
||||||
uint8_t saCmsOpmodel = SACMS_OPMODEL_UNDEF;
|
|
||||||
|
|
||||||
#define SACMS_TXMODE_NODEF 0
|
|
||||||
#define SACMS_TXMODE_PIT_OUTRANGE 1
|
|
||||||
#define SACMS_TXMODE_PIT_INRANGE 2
|
|
||||||
#define SACMS_TXMODE_ACTIVE 3
|
|
||||||
|
|
||||||
uint8_t saCmsRFState; // RF state; ACTIVE, PIR, POR XXX Not currently used
|
|
||||||
|
|
||||||
uint8_t saCmsBand = 0;
|
|
||||||
uint8_t saCmsChan = 0;
|
|
||||||
uint8_t saCmsPower = 0;
|
|
||||||
|
|
||||||
// Frequency derived from channel table (used for reference in band/channel mode)
|
|
||||||
uint16_t saCmsFreqRef = 0;
|
|
||||||
|
|
||||||
uint16_t saCmsDeviceFreq = 0;
|
|
||||||
|
|
||||||
uint8_t saCmsDeviceStatus = 0;
|
|
||||||
uint8_t saCmsPower;
|
|
||||||
uint8_t saCmsPitFMode; // Undef(0), In-Range(1) or Out-Range(2)
|
|
||||||
uint8_t saCmsFselMode; // Channel(0) or User defined(1)
|
|
||||||
|
|
||||||
uint16_t saCmsORFreq = 0; // POR frequency
|
|
||||||
uint16_t saCmsORFreqNew; // POR frequency
|
|
||||||
|
|
||||||
uint16_t saCmsUserFreq = 0; // User defined frequency
|
|
||||||
uint16_t saCmsUserFreqNew; // User defined frequency
|
|
||||||
|
|
||||||
void saCmsUpdate(void)
|
|
||||||
{
|
|
||||||
// XXX Take care of pit mode update somewhere???
|
|
||||||
|
|
||||||
if (saCmsOpmodel == SACMS_OPMODEL_UNDEF) {
|
|
||||||
// This is a first valid response to GET_SETTINGS.
|
|
||||||
saCmsOpmodel = (saDevice.mode & SA_MODE_GET_PITMODE) ? SACMS_OPMODEL_RACE : SACMS_OPMODEL_FREE;
|
|
||||||
|
|
||||||
saCmsFselMode = (saDevice.mode & SA_MODE_GET_FREQ_BY_FREQ) ? 1 : 0;
|
|
||||||
|
|
||||||
saCmsBand = (saDevice.channel / 8) + 1;
|
|
||||||
saCmsChan = (saDevice.channel % 8) + 1;
|
|
||||||
saCmsFreqRef = vtx58frequencyTable[saDevice.channel / 8][saDevice.channel % 8];
|
|
||||||
|
|
||||||
saCmsDeviceFreq = vtx58frequencyTable[saDevice.channel / 8][saDevice.channel % 8];
|
|
||||||
|
|
||||||
if ((saDevice.mode & SA_MODE_GET_PITMODE) == 0) {
|
|
||||||
saCmsRFState = SACMS_TXMODE_ACTIVE;
|
|
||||||
} else if (saDevice.mode & SA_MODE_GET_IN_RANGE_PITMODE) {
|
|
||||||
saCmsRFState = SACMS_TXMODE_PIT_INRANGE;
|
|
||||||
} else {
|
|
||||||
saCmsRFState = SACMS_TXMODE_PIT_OUTRANGE;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (saDevice.version == 2) {
|
|
||||||
saCmsPower = saDevice.power + 1; // XXX Take care V1
|
|
||||||
} else {
|
|
||||||
saCmsPower = saDacToPowerIndex(saDevice.power) + 1;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
saUpdateStatusString();
|
|
||||||
}
|
|
||||||
|
|
||||||
char saCmsStatusString[31] = "- -- ---- ---";
|
|
||||||
// m bc ffff ppp
|
|
||||||
// 0123456789012
|
|
||||||
|
|
||||||
static long saCmsConfigOpmodelByGvar(displayPort_t *, const void *self);
|
|
||||||
static long saCmsConfigPitFModeByGvar(displayPort_t *, const void *self);
|
|
||||||
static long saCmsConfigBandByGvar(displayPort_t *, const void *self);
|
|
||||||
static long saCmsConfigChanByGvar(displayPort_t *, const void *self);
|
|
||||||
static long saCmsConfigPowerByGvar(displayPort_t *, const void *self);
|
|
||||||
|
|
||||||
static void saUpdateStatusString(void)
|
|
||||||
{
|
|
||||||
if (saDevice.version == 0)
|
|
||||||
return;
|
|
||||||
|
|
||||||
// XXX These should be done somewhere else
|
|
||||||
if (saCmsDeviceStatus == 0 && saDevice.version != 0)
|
|
||||||
saCmsDeviceStatus = saDevice.version;
|
|
||||||
if (saCmsORFreq == 0 && saDevice.orfreq != 0)
|
|
||||||
saCmsORFreq = saDevice.orfreq;
|
|
||||||
if (saCmsUserFreq == 0 && saDevice.freq != 0)
|
|
||||||
saCmsUserFreq = saDevice.freq;
|
|
||||||
|
|
||||||
if (saDevice.version == 2) {
|
|
||||||
if (saDevice.mode & SA_MODE_GET_OUT_RANGE_PITMODE)
|
|
||||||
saCmsPitFMode = 1;
|
|
||||||
else
|
|
||||||
saCmsPitFMode = 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
saCmsStatusString[0] = "-FR"[saCmsOpmodel];
|
|
||||||
|
|
||||||
if (saCmsFselMode == 0) {
|
|
||||||
saCmsStatusString[2] = "ABEFR"[saDevice.channel / 8];
|
|
||||||
saCmsStatusString[3] = '1' + (saDevice.channel % 8);
|
|
||||||
} else {
|
|
||||||
saCmsStatusString[2] = 'U';
|
|
||||||
saCmsStatusString[3] = 'F';
|
|
||||||
}
|
|
||||||
|
|
||||||
if ((saDevice.mode & SA_MODE_GET_PITMODE)
|
|
||||||
&& (saDevice.mode & SA_MODE_GET_OUT_RANGE_PITMODE))
|
|
||||||
tfp_sprintf(&saCmsStatusString[5], "%4d", saDevice.orfreq);
|
|
||||||
else if (saDevice.mode & SA_MODE_GET_FREQ_BY_FREQ)
|
|
||||||
tfp_sprintf(&saCmsStatusString[5], "%4d", saDevice.freq);
|
|
||||||
else
|
|
||||||
tfp_sprintf(&saCmsStatusString[5], "%4d",
|
|
||||||
vtx58frequencyTable[saDevice.channel / 8][saDevice.channel % 8]);
|
|
||||||
|
|
||||||
saCmsStatusString[9] = ' ';
|
|
||||||
|
|
||||||
if (saDevice.mode & SA_MODE_GET_PITMODE) {
|
|
||||||
saCmsStatusString[10] = 'P';
|
|
||||||
if (saDevice.mode & SA_MODE_GET_IN_RANGE_PITMODE) {
|
|
||||||
saCmsStatusString[11] = 'I';
|
|
||||||
} else {
|
|
||||||
saCmsStatusString[11] = 'O';
|
|
||||||
}
|
|
||||||
saCmsStatusString[12] = 'R';
|
|
||||||
saCmsStatusString[13] = 0;
|
|
||||||
} else {
|
|
||||||
tfp_sprintf(&saCmsStatusString[10], "%3d", (saDevice.version == 2) ? saPowerTable[saDevice.power].rfpower : saPowerTable[saDacToPowerIndex(saDevice.power)].rfpower);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static long saCmsConfigBandByGvar(displayPort_t *pDisp, const void *self)
|
|
||||||
{
|
|
||||||
UNUSED(pDisp);
|
|
||||||
UNUSED(self);
|
|
||||||
|
|
||||||
if (saDevice.version == 0) {
|
|
||||||
// Bounce back; not online yet
|
|
||||||
saCmsBand = 0;
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (saCmsBand == 0) {
|
|
||||||
// Bouce back, no going back to undef state
|
|
||||||
saCmsBand = 1;
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
if ((saCmsOpmodel == SACMS_OPMODEL_FREE) && !saDeferred)
|
|
||||||
saSetBandAndChannel(saCmsBand - 1, saCmsChan - 1);
|
|
||||||
|
|
||||||
saCmsFreqRef = vtx58frequencyTable[saCmsBand - 1][saCmsChan - 1];
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static long saCmsConfigChanByGvar(displayPort_t *pDisp, const void *self)
|
|
||||||
{
|
|
||||||
UNUSED(pDisp);
|
|
||||||
UNUSED(self);
|
|
||||||
|
|
||||||
if (saDevice.version == 0) {
|
|
||||||
// Bounce back; not online yet
|
|
||||||
saCmsChan = 0;
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (saCmsChan == 0) {
|
|
||||||
// Bounce back; no going back to undef state
|
|
||||||
saCmsChan = 1;
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
if ((saCmsOpmodel == SACMS_OPMODEL_FREE) && !saDeferred)
|
|
||||||
saSetBandAndChannel(saCmsBand - 1, saCmsChan - 1);
|
|
||||||
|
|
||||||
saCmsFreqRef = vtx58frequencyTable[saCmsBand - 1][saCmsChan - 1];
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static long saCmsConfigPowerByGvar(displayPort_t *pDisp, const void *self)
|
|
||||||
{
|
|
||||||
UNUSED(pDisp);
|
|
||||||
UNUSED(self);
|
|
||||||
|
|
||||||
if (saDevice.version == 0) {
|
|
||||||
// Bounce back; not online yet
|
|
||||||
saCmsPower = 0;
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (saCmsPower == 0) {
|
|
||||||
// Bouce back; no going back to undef state
|
|
||||||
saCmsPower = 1;
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (saCmsOpmodel == SACMS_OPMODEL_FREE)
|
|
||||||
saSetPowerByIndex(saCmsPower - 1);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static long saCmsConfigPitFModeByGvar(displayPort_t *pDisp, const void *self)
|
|
||||||
{
|
|
||||||
UNUSED(pDisp);
|
|
||||||
UNUSED(self);
|
|
||||||
|
|
||||||
if (saDevice.version == 1) {
|
|
||||||
// V1 device doesn't support PIT mode; bounce back.
|
|
||||||
saCmsPitFMode = 0;
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
dprintf(("saCmsConfigPitFmodeByGbar: saCmsPitFMode %d\r\n", saCmsPitFMode));
|
|
||||||
|
|
||||||
if (saCmsPitFMode == 0) {
|
|
||||||
// Bounce back
|
|
||||||
saCmsPitFMode = 1;
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (saCmsPitFMode == 1) {
|
|
||||||
saSetMode(SA_MODE_SET_IN_RANGE_PITMODE);
|
|
||||||
} else {
|
|
||||||
saSetMode(SA_MODE_SET_OUT_RANGE_PITMODE);
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static long saCmsConfigFreqModeByGvar(displayPort_t *pDisp, const void *self); // Forward
|
|
||||||
|
|
||||||
static long saCmsConfigOpmodelByGvar(displayPort_t *pDisp, const void *self)
|
|
||||||
{
|
|
||||||
UNUSED(pDisp);
|
|
||||||
UNUSED(self);
|
|
||||||
|
|
||||||
if (saDevice.version == 1) {
|
|
||||||
if (saCmsOpmodel != SACMS_OPMODEL_FREE)
|
|
||||||
saCmsOpmodel = SACMS_OPMODEL_FREE;
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t opmodel = saCmsOpmodel;
|
|
||||||
|
|
||||||
dprintf(("saCmsConfigOpmodelByGvar: opmodel %d\r\n", opmodel));
|
|
||||||
|
|
||||||
if (opmodel == SACMS_OPMODEL_FREE) {
|
|
||||||
// VTX should power up transmitting.
|
|
||||||
// Turn off In-Range and Out-Range bits
|
|
||||||
saSetMode(0);
|
|
||||||
} else if (opmodel == SACMS_OPMODEL_RACE) {
|
|
||||||
// VTX should power up in pit mode.
|
|
||||||
// Default PitFMode is in-range to prevent users without
|
|
||||||
// out-range receivers from getting blinded.
|
|
||||||
saCmsPitFMode = 0;
|
|
||||||
saCmsConfigPitFModeByGvar(pDisp, self);
|
|
||||||
|
|
||||||
// Direct frequency mode is not available in RACE opmodel
|
|
||||||
saCmsFselMode = 0;
|
|
||||||
saCmsConfigFreqModeByGvar(pDisp, self);
|
|
||||||
} else {
|
|
||||||
// Trying to go back to unknown state; bounce back
|
|
||||||
saCmsOpmodel = SACMS_OPMODEL_UNDEF + 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static const char * const saCmsDeviceStatusNames[] = {
|
|
||||||
"OFFL",
|
|
||||||
"ONL V1",
|
|
||||||
"ONL V2",
|
|
||||||
};
|
|
||||||
|
|
||||||
static OSD_TAB_t saCmsEntOnline = { &saCmsDeviceStatus, 2, saCmsDeviceStatusNames };
|
|
||||||
|
|
||||||
static OSD_Entry saCmsMenuStatsEntries[] = {
|
|
||||||
{ "- SA STATS -", OME_Label, NULL, NULL, 0 },
|
|
||||||
{ "STATUS", OME_TAB, NULL, &saCmsEntOnline, DYNAMIC },
|
|
||||||
{ "BAUDRATE", OME_UINT16, NULL, &(OSD_UINT16_t){ &sa_smartbaud, 0, 0, 0 }, DYNAMIC },
|
|
||||||
{ "SENT", OME_UINT16, NULL, &(OSD_UINT16_t){ &saStat.pktsent, 0, 0, 0 }, DYNAMIC },
|
|
||||||
{ "RCVD", OME_UINT16, NULL, &(OSD_UINT16_t){ &saStat.pktrcvd, 0, 0, 0 }, DYNAMIC },
|
|
||||||
{ "BADPRE", OME_UINT16, NULL, &(OSD_UINT16_t){ &saStat.badpre, 0, 0, 0 }, DYNAMIC },
|
|
||||||
{ "BADLEN", OME_UINT16, NULL, &(OSD_UINT16_t){ &saStat.badlen, 0, 0, 0 }, DYNAMIC },
|
|
||||||
{ "CRCERR", OME_UINT16, NULL, &(OSD_UINT16_t){ &saStat.crc, 0, 0, 0 }, DYNAMIC },
|
|
||||||
{ "OOOERR", OME_UINT16, NULL, &(OSD_UINT16_t){ &saStat.ooopresp, 0, 0, 0 }, DYNAMIC },
|
|
||||||
{ "BACK", OME_Back, NULL, NULL, 0 },
|
|
||||||
{ NULL, OME_END, NULL, NULL, 0 }
|
|
||||||
};
|
|
||||||
|
|
||||||
static CMS_Menu saCmsMenuStats = {
|
|
||||||
.GUARD_text = "XSAST",
|
|
||||||
.GUARD_type = OME_MENU,
|
|
||||||
.onEnter = NULL,
|
|
||||||
.onExit = NULL,
|
|
||||||
.onGlobalExit = NULL,
|
|
||||||
.entries = saCmsMenuStatsEntries
|
|
||||||
};
|
|
||||||
|
|
||||||
static OSD_TAB_t saCmsEntBand = { &saCmsBand, 5, vtx58BandNames };
|
|
||||||
|
|
||||||
static OSD_TAB_t saCmsEntChan = { &saCmsChan, 8, vtx58ChannelNames };
|
|
||||||
|
|
||||||
static const char * const saCmsPowerNames[] = {
|
|
||||||
"---",
|
|
||||||
"25 ",
|
|
||||||
"200",
|
|
||||||
"500",
|
|
||||||
"800",
|
|
||||||
};
|
|
||||||
|
|
||||||
static OSD_TAB_t saCmsEntPower = { &saCmsPower, 4, saCmsPowerNames};
|
|
||||||
|
|
||||||
static OSD_UINT16_t saCmsEntFreqRef = { &saCmsFreqRef, 5600, 5900, 0 };
|
|
||||||
|
|
||||||
static const char * const saCmsOpmodelNames[] = {
|
|
||||||
"----",
|
|
||||||
"FREE",
|
|
||||||
"RACE",
|
|
||||||
};
|
|
||||||
|
|
||||||
static const char * const saCmsFselModeNames[] = {
|
|
||||||
"CHAN",
|
|
||||||
"USER"
|
|
||||||
};
|
|
||||||
|
|
||||||
static const char * const saCmsPitFModeNames[] = {
|
|
||||||
"---",
|
|
||||||
"PIR",
|
|
||||||
"POR"
|
|
||||||
};
|
|
||||||
|
|
||||||
static OSD_TAB_t saCmsEntPitFMode = { &saCmsPitFMode, 1, saCmsPitFModeNames };
|
|
||||||
|
|
||||||
static long sacms_SetupTopMenu(void); // Forward
|
|
||||||
|
|
||||||
static long saCmsConfigFreqModeByGvar(displayPort_t *pDisp, const void *self)
|
|
||||||
{
|
|
||||||
UNUSED(pDisp);
|
|
||||||
UNUSED(self);
|
|
||||||
|
|
||||||
if (saCmsFselMode == 0) {
|
|
||||||
// CHAN
|
|
||||||
saSetBandAndChannel(saCmsBand - 1, saCmsChan - 1);
|
|
||||||
} else {
|
|
||||||
// USER: User frequency mode is only available in FREE opmodel.
|
|
||||||
if (saCmsOpmodel == SACMS_OPMODEL_FREE) {
|
|
||||||
saSetFreq(saCmsUserFreq);
|
|
||||||
} else {
|
|
||||||
// Bounce back
|
|
||||||
saCmsFselMode = 0;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
sacms_SetupTopMenu();
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static long saCmsCommence(displayPort_t *pDisp, const void *self)
|
|
||||||
{
|
|
||||||
UNUSED(pDisp);
|
|
||||||
UNUSED(self);
|
|
||||||
|
|
||||||
if (saCmsOpmodel == SACMS_OPMODEL_RACE) {
|
|
||||||
// Race model
|
|
||||||
// Setup band, freq and power.
|
|
||||||
|
|
||||||
saSetBandAndChannel(saCmsBand - 1, saCmsChan - 1);
|
|
||||||
|
|
||||||
// If in pit mode, cancel it.
|
|
||||||
|
|
||||||
if (saCmsPitFMode == 0)
|
|
||||||
saSetMode(SA_MODE_CLR_PITMODE|SA_MODE_SET_IN_RANGE_PITMODE);
|
|
||||||
else
|
|
||||||
saSetMode(SA_MODE_CLR_PITMODE|SA_MODE_SET_OUT_RANGE_PITMODE);
|
|
||||||
} else {
|
|
||||||
// Freestyle model
|
|
||||||
// Setup band and freq / user freq
|
|
||||||
if (saCmsFselMode == 0)
|
|
||||||
saSetBandAndChannel(saCmsBand - 1, saCmsChan - 1);
|
|
||||||
else
|
|
||||||
saSetFreq(saCmsUserFreq);
|
|
||||||
}
|
|
||||||
|
|
||||||
saSetPowerByIndex(saCmsPower - 1);
|
|
||||||
|
|
||||||
return MENU_CHAIN_BACK;
|
|
||||||
}
|
|
||||||
|
|
||||||
static long saCmsSetPORFreqOnEnter(void)
|
|
||||||
{
|
|
||||||
if (saDevice.version == 1)
|
|
||||||
return MENU_CHAIN_BACK;
|
|
||||||
|
|
||||||
saCmsORFreqNew = saCmsORFreq;
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static long saCmsSetPORFreq(displayPort_t *pDisp, const void *self)
|
|
||||||
{
|
|
||||||
UNUSED(pDisp);
|
|
||||||
UNUSED(self);
|
|
||||||
|
|
||||||
saSetFreq(saCmsORFreqNew|SA_FREQ_SETPIT);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static char *saCmsORFreqGetString(void)
|
|
||||||
{
|
|
||||||
static char pbuf[5];
|
|
||||||
|
|
||||||
tfp_sprintf(pbuf, "%4d", saCmsORFreq);
|
|
||||||
|
|
||||||
return pbuf;
|
|
||||||
}
|
|
||||||
|
|
||||||
static char *saCmsUserFreqGetString(void)
|
|
||||||
{
|
|
||||||
static char pbuf[5];
|
|
||||||
|
|
||||||
tfp_sprintf(pbuf, "%4d", saCmsUserFreq);
|
|
||||||
|
|
||||||
return pbuf;
|
|
||||||
}
|
|
||||||
|
|
||||||
static long saCmsSetUserFreqOnEnter(void)
|
|
||||||
{
|
|
||||||
saCmsUserFreqNew = saCmsUserFreq;
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static long saCmsConfigUserFreq(displayPort_t *pDisp, const void *self)
|
|
||||||
{
|
|
||||||
UNUSED(pDisp);
|
|
||||||
UNUSED(self);
|
|
||||||
|
|
||||||
saCmsUserFreq = saCmsUserFreqNew;
|
|
||||||
//saSetFreq(saCmsUserFreq);
|
|
||||||
|
|
||||||
return MENU_CHAIN_BACK;
|
|
||||||
}
|
|
||||||
|
|
||||||
static OSD_Entry saCmsMenuPORFreqEntries[] = {
|
|
||||||
{ "- POR FREQ -", OME_Label, NULL, NULL, 0 },
|
|
||||||
|
|
||||||
{ "CUR FREQ", OME_UINT16, NULL, &(OSD_UINT16_t){ &saCmsORFreq, 5000, 5900, 0 }, DYNAMIC },
|
|
||||||
{ "NEW FREQ", OME_UINT16, NULL, &(OSD_UINT16_t){ &saCmsORFreqNew, 5000, 5900, 1 }, 0 },
|
|
||||||
{ "SET", OME_Funcall, saCmsSetPORFreq, NULL, 0 },
|
|
||||||
|
|
||||||
{ "BACK", OME_Back, NULL, NULL, 0 },
|
|
||||||
{ NULL, OME_END, NULL, NULL, 0 }
|
|
||||||
};
|
|
||||||
|
|
||||||
static CMS_Menu saCmsMenuPORFreq =
|
|
||||||
{
|
|
||||||
.GUARD_text = "XSAPOR",
|
|
||||||
.GUARD_type = OME_MENU,
|
|
||||||
.onEnter = saCmsSetPORFreqOnEnter,
|
|
||||||
.onExit = NULL,
|
|
||||||
.onGlobalExit = NULL,
|
|
||||||
.entries = saCmsMenuPORFreqEntries,
|
|
||||||
};
|
|
||||||
|
|
||||||
static OSD_Entry saCmsMenuUserFreqEntries[] = {
|
|
||||||
{ "- USER FREQ -", OME_Label, NULL, NULL, 0 },
|
|
||||||
|
|
||||||
{ "CUR FREQ", OME_UINT16, NULL, &(OSD_UINT16_t){ &saCmsUserFreq, 5000, 5900, 0 }, DYNAMIC },
|
|
||||||
{ "NEW FREQ", OME_UINT16, NULL, &(OSD_UINT16_t){ &saCmsUserFreqNew, 5000, 5900, 1 }, 0 },
|
|
||||||
{ "SET", OME_Funcall, saCmsConfigUserFreq, NULL, 0 },
|
|
||||||
|
|
||||||
{ "BACK", OME_Back, NULL, NULL, 0 },
|
|
||||||
{ NULL, OME_END, NULL, NULL, 0 }
|
|
||||||
};
|
|
||||||
|
|
||||||
static CMS_Menu saCmsMenuUserFreq =
|
|
||||||
{
|
|
||||||
.GUARD_text = "XSAUFQ",
|
|
||||||
.GUARD_type = OME_MENU,
|
|
||||||
.onEnter = saCmsSetUserFreqOnEnter,
|
|
||||||
.onExit = NULL,
|
|
||||||
.onGlobalExit = NULL,
|
|
||||||
.entries = saCmsMenuUserFreqEntries,
|
|
||||||
};
|
|
||||||
|
|
||||||
static OSD_TAB_t saCmsEntFselMode = { &saCmsFselMode, 1, saCmsFselModeNames };
|
|
||||||
|
|
||||||
static OSD_Entry saCmsMenuConfigEntries[] = {
|
|
||||||
{ "- SA CONFIG -", OME_Label, NULL, NULL, 0 },
|
|
||||||
|
|
||||||
{ "OP MODEL", OME_TAB, saCmsConfigOpmodelByGvar, &(OSD_TAB_t){ &saCmsOpmodel, 2, saCmsOpmodelNames }, DYNAMIC },
|
|
||||||
{ "FSEL MODE", OME_TAB, saCmsConfigFreqModeByGvar, &saCmsEntFselMode, DYNAMIC },
|
|
||||||
{ "PIT FMODE", OME_TAB, saCmsConfigPitFModeByGvar, &saCmsEntPitFMode, 0 },
|
|
||||||
{ "POR FREQ", OME_Submenu, (CMSEntryFuncPtr)saCmsORFreqGetString, &saCmsMenuPORFreq, OPTSTRING },
|
|
||||||
{ "STATX", OME_Submenu, cmsMenuChange, &saCmsMenuStats, 0 },
|
|
||||||
|
|
||||||
{ "BACK", OME_Back, NULL, NULL, 0 },
|
|
||||||
{ NULL, OME_END, NULL, NULL, 0 }
|
|
||||||
};
|
|
||||||
|
|
||||||
static CMS_Menu saCmsMenuConfig = {
|
|
||||||
.GUARD_text = "XSACFG",
|
|
||||||
.GUARD_type = OME_MENU,
|
|
||||||
.onEnter = NULL,
|
|
||||||
.onExit = NULL,
|
|
||||||
.onGlobalExit = NULL,
|
|
||||||
.entries = saCmsMenuConfigEntries
|
|
||||||
};
|
|
||||||
|
|
||||||
static OSD_Entry saCmsMenuCommenceEntries[] = {
|
|
||||||
{ "CONFIRM", OME_Label, NULL, NULL, 0 },
|
|
||||||
|
|
||||||
{ "YES", OME_Funcall, saCmsCommence, NULL, 0 },
|
|
||||||
|
|
||||||
{ "BACK", OME_Back, NULL, NULL, 0 },
|
|
||||||
{ NULL, OME_END, NULL, NULL, 0 }
|
|
||||||
};
|
|
||||||
|
|
||||||
static CMS_Menu saCmsMenuCommence = {
|
|
||||||
.GUARD_text = "XVTXCOM",
|
|
||||||
.GUARD_type = OME_MENU,
|
|
||||||
.onEnter = NULL,
|
|
||||||
.onExit = NULL,
|
|
||||||
.onGlobalExit = NULL,
|
|
||||||
.entries = saCmsMenuCommenceEntries,
|
|
||||||
};
|
|
||||||
|
|
||||||
static OSD_Entry saCmsMenuFreqModeEntries[] = {
|
|
||||||
{ "- SMARTAUDIO -", OME_Label, NULL, NULL, 0 },
|
|
||||||
|
|
||||||
{ "", OME_Label, NULL, saCmsStatusString, DYNAMIC },
|
|
||||||
{ "FREQ", OME_Submenu, (CMSEntryFuncPtr)saCmsUserFreqGetString, &saCmsMenuUserFreq, OPTSTRING },
|
|
||||||
{ "POWER", OME_TAB, saCmsConfigPowerByGvar, &saCmsEntPower, 0 },
|
|
||||||
{ "SET", OME_Submenu, cmsMenuChange, &saCmsMenuCommence, 0 },
|
|
||||||
{ "CONFIG", OME_Submenu, cmsMenuChange, &saCmsMenuConfig, 0 },
|
|
||||||
|
|
||||||
{ "BACK", OME_Back, NULL, NULL, 0 },
|
|
||||||
{ NULL, OME_END, NULL, NULL, 0 }
|
|
||||||
};
|
|
||||||
|
|
||||||
static OSD_Entry saCmsMenuChanModeEntries[] =
|
|
||||||
{
|
|
||||||
{ "- SMARTAUDIO -", OME_Label, NULL, NULL, 0 },
|
|
||||||
|
|
||||||
{ "", OME_Label, NULL, saCmsStatusString, DYNAMIC },
|
|
||||||
{ "BAND", OME_TAB, saCmsConfigBandByGvar, &saCmsEntBand, 0 },
|
|
||||||
{ "CHAN", OME_TAB, saCmsConfigChanByGvar, &saCmsEntChan, 0 },
|
|
||||||
{ "(FREQ)", OME_UINT16, NULL, &saCmsEntFreqRef, DYNAMIC },
|
|
||||||
{ "POWER", OME_TAB, saCmsConfigPowerByGvar, &saCmsEntPower, 0 },
|
|
||||||
{ "SET", OME_Submenu, cmsMenuChange, &saCmsMenuCommence, 0 },
|
|
||||||
{ "CONFIG", OME_Submenu, cmsMenuChange, &saCmsMenuConfig, 0 },
|
|
||||||
|
|
||||||
{ "BACK", OME_Back, NULL, NULL, 0 },
|
|
||||||
{ NULL, OME_END, NULL, NULL, 0 }
|
|
||||||
};
|
|
||||||
|
|
||||||
static OSD_Entry saCmsMenuOfflineEntries[] =
|
|
||||||
{
|
|
||||||
{ "- VTX SMARTAUDIO -", OME_Label, NULL, NULL, 0 },
|
|
||||||
|
|
||||||
{ "", OME_Label, NULL, saCmsStatusString, DYNAMIC },
|
|
||||||
{ "STATX", OME_Submenu, cmsMenuChange, &saCmsMenuStats, 0 },
|
|
||||||
|
|
||||||
{ "BACK", OME_Back, NULL, NULL, 0 },
|
|
||||||
{ NULL, OME_END, NULL, NULL, 0 }
|
|
||||||
};
|
|
||||||
|
|
||||||
CMS_Menu cmsx_menuVtxSmartAudio; // Forward
|
|
||||||
|
|
||||||
static long sacms_SetupTopMenu(void)
|
|
||||||
{
|
|
||||||
if (saCmsDeviceStatus) {
|
|
||||||
if (saCmsFselMode == 0)
|
|
||||||
cmsx_menuVtxSmartAudio.entries = saCmsMenuChanModeEntries;
|
|
||||||
else
|
|
||||||
cmsx_menuVtxSmartAudio.entries = saCmsMenuFreqModeEntries;
|
|
||||||
} else {
|
|
||||||
cmsx_menuVtxSmartAudio.entries = saCmsMenuOfflineEntries;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
CMS_Menu cmsx_menuVtxSmartAudio = {
|
|
||||||
.GUARD_text = "XVTXSA",
|
|
||||||
.GUARD_type = OME_MENU,
|
|
||||||
.onEnter = sacms_SetupTopMenu,
|
|
||||||
.onExit = NULL,
|
|
||||||
.onGlobalExit = NULL,
|
|
||||||
.entries = saCmsMenuOfflineEntries,
|
|
||||||
};
|
|
||||||
|
|
||||||
#endif // CMS
|
|
||||||
|
|
||||||
#endif // VTX_SMARTAUDIO
|
#endif // VTX_SMARTAUDIO
|
||||||
|
|
|
||||||
|
|
@ -1,8 +1,79 @@
|
||||||
|
#pragma once
|
||||||
|
|
||||||
|
// opmode flags, GET side
|
||||||
|
#define SA_MODE_GET_FREQ_BY_FREQ 1
|
||||||
|
#define SA_MODE_GET_PITMODE 2
|
||||||
|
#define SA_MODE_GET_IN_RANGE_PITMODE 4
|
||||||
|
#define SA_MODE_GET_OUT_RANGE_PITMODE 8
|
||||||
|
#define SA_MODE_GET_UNLOCK 16
|
||||||
|
#define SA_MODE_GET_DEFERRED_FREQ 32
|
||||||
|
|
||||||
|
// opmode flags, SET side
|
||||||
|
#define SA_MODE_SET_IN_RANGE_PITMODE 1 // Immediate
|
||||||
|
#define SA_MODE_SET_OUT_RANGE_PITMODE 2 // Immediate
|
||||||
|
#define SA_MODE_CLR_PITMODE 4 // Immediate
|
||||||
|
#define SA_MODE_SET_UNLOCK 8
|
||||||
|
#define SA_MODE_SET_LOCK 0 // ~UNLOCK
|
||||||
|
#define SA_MODE_SET_DEFERRED_FREQ 16
|
||||||
|
|
||||||
|
// SetFrequency flags, for pit mode frequency manipulation
|
||||||
|
#define SA_FREQ_GETPIT (1 << 14)
|
||||||
|
#define SA_FREQ_SETPIT (1 << 15)
|
||||||
|
#define SA_FREQ_MASK (~(SA_FREQ_GETPIT|SA_FREQ_SETPIT))
|
||||||
|
|
||||||
// For generic API use, but here for now
|
// For generic API use, but here for now
|
||||||
|
|
||||||
|
typedef struct smartAudioDevice_s {
|
||||||
|
int8_t version;
|
||||||
|
int8_t channel;
|
||||||
|
int8_t power;
|
||||||
|
int8_t mode;
|
||||||
|
uint16_t freq;
|
||||||
|
uint16_t orfreq;
|
||||||
|
} smartAudioDevice_t;
|
||||||
|
|
||||||
|
typedef struct saPowerTable_s {
|
||||||
|
int rfpower;
|
||||||
|
int16_t valueV1;
|
||||||
|
int16_t valueV2;
|
||||||
|
} saPowerTable_t;
|
||||||
|
|
||||||
|
typedef struct smartAudioStat_s {
|
||||||
|
uint16_t pktsent;
|
||||||
|
uint16_t pktrcvd;
|
||||||
|
uint16_t badpre;
|
||||||
|
uint16_t badlen;
|
||||||
|
uint16_t crc;
|
||||||
|
uint16_t ooopresp;
|
||||||
|
uint16_t badcode;
|
||||||
|
} smartAudioStat_t;
|
||||||
|
|
||||||
|
extern smartAudioDevice_t saDevice;
|
||||||
|
extern saPowerTable_t saPowerTable[];
|
||||||
|
extern smartAudioStat_t saStat;
|
||||||
|
|
||||||
|
extern uint16_t sa_smartbaud;
|
||||||
|
extern bool saDeferred;
|
||||||
|
|
||||||
|
int saDacToPowerIndex(int dac);
|
||||||
|
void saSetBandAndChannel(uint8_t band, uint8_t channel);
|
||||||
|
void saSetMode(int mode);
|
||||||
|
void saSetPowerByIndex(uint8_t index);
|
||||||
|
void saSetFreq(uint16_t freq);
|
||||||
bool vtxSmartAudioInit();
|
bool vtxSmartAudioInit();
|
||||||
|
|
||||||
|
#ifdef SMARTAUDIO_DPRINTF
|
||||||
|
#ifdef OMNIBUSF4
|
||||||
|
#define DPRINTF_SERIAL_PORT SERIAL_PORT_USART3
|
||||||
|
#else
|
||||||
|
#define DPRINTF_SERIAL_PORT SERIAL_PORT_USART1
|
||||||
|
#endif
|
||||||
|
extern serialPort_t *debugSerialPort;
|
||||||
|
#define dprintf(x) if (debugSerialPort) printf x
|
||||||
|
#else
|
||||||
|
#define dprintf(x)
|
||||||
|
#endif // SMARTAUDIO_DPRINTF
|
||||||
|
|
||||||
#if 0
|
#if 0
|
||||||
#ifdef CMS
|
#ifdef CMS
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -1 +0,0 @@
|
||||||
extern CMS_Menu cmsx_menuVtxSmartAudio;
|
|
||||||
Loading…
Reference in New Issue