src/main/cms/cms_menu_vtx_common.c

   1 /*
   2  * This file is part of Cleanflight and Betaflight.
   3  *
   4  * Cleanflight and Betaflight are free software. You can redistribute
   5  * this software and/or modify this software under the terms of the
   6  * GNU General Public License as published by the Free Software
   7  * Foundation, either version 3 of the License, or (at your option)
   8  * any later version.
   9  *
  10  * Cleanflight and Betaflight are distributed in the hope that they
  11  * will be useful, but WITHOUT ANY WARRANTY; without even the implied
  12  * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
  13  * See the GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this software.
  17  *
  18  * If not, see <http://www.gnu.org/licenses/>.
  19  */
  20
  21 #include <stdbool.h>
  22 #include <stdint.h>
  23 #include <ctype.h>
  24
  25 #include "platform.h"
  26
  27 #if defined(USE_CMS) && defined(USE_VTX_CONTROL) && (defined(USE_VTX_TRAMP) || defined(USE_VTX_SMARTAUDIO) || defined(USE_VTX_RTC6705))
  28
  29 #include "common/printf.h"
  30
  31 #include "cms/cms.h"
  32 #include "cms/cms_menu_vtx_rtc6705.h"
  33 #include "cms/cms_menu_vtx_smartaudio.h"
  34 #include "cms/cms_menu_vtx_tramp.h"
  35 #include "cms/cms_types.h"
  36
  37 #include "drivers/vtx_common.h"
  38
  39 #include "cms_menu_vtx_common.h"
  40
  41 #define MAX_STATUS_LINE_LENGTH 21
  42
  43 static char statusLine1[MAX_STATUS_LINE_LENGTH] = "";
  44 static char statusLine2[MAX_STATUS_LINE_LENGTH] = "";
  45
  46 static const void *setStatusMessage(displayPort_t *pDisp)
  47 {
  48     UNUSED(pDisp);
  49
  50     vtxDevice_t *device = vtxCommonDevice();
  51
  52     statusLine1[0] = 0;
  53     statusLine2[0] = 0;
  54
  55     if (!device) {
  56         tfp_sprintf(&statusLine1[0], "VTX NOT RESPONDING");
  57         tfp_sprintf(&statusLine2[0], "OR NOT CONFIGURED");
  58     } else {
  59         vtxDevType_e vtxType = vtxCommonGetDeviceType(device);
  60         if (vtxType == VTXDEV_UNSUPPORTED) {
  61             tfp_sprintf(&statusLine1[0], "UNSUPPORTED VTX TYPE");
  62         } else {
  63             tfp_sprintf(&statusLine1[0], "UNKNOWN VTX TYPE");
  64         }
  65     }
  66     return NULL;
  67 }
  68
  69 static const OSD_Entry vtxErrorMenuEntries[] =
  70 {
  71     { "",     OME_Label | DYNAMIC, NULL, statusLine1 },
  72     { "",     OME_Label | DYNAMIC, NULL, statusLine2 },
  73     { "",     OME_Label, NULL, NULL },
  74     { "BACK", OME_Back,  NULL, NULL },
  75     { NULL,   OME_END,   NULL, NULL }
  76 };
  77
  78 static CMS_Menu cmsx_menuVtxError = {
  79 #ifdef CMS_MENU_DEBUG
  80     .GUARD_text = "XVTXERROR",
  81     .GUARD_type = OME_MENU,
  82 #endif
  83     .onEnter = setStatusMessage,
  84     .onExit = NULL,
  85     .onDisplayUpdate = NULL,
  86     .entries = vtxErrorMenuEntries,
  87 };
  88
  89 // Redirect to the proper menu based on the vtx device type
  90 // If device isn't valid or not a supported type then don't
  91 // redirect and instead display a local informational menu.
  92 const void *cmsSelectVtx(displayPort_t *pDisplay, const void *ptr)
  93 {
  94     UNUSED(ptr);
  95
  96     vtxDevice_t *device = vtxCommonDevice();
  97
  98     if (device) {
  99         vtxDevType_e vtxType = vtxCommonGetDeviceType(device);
 100
 101         switch (vtxType) {
 102
 103 #if defined(USE_VTX_RTC6705)
 104         case VTXDEV_RTC6705:
 105             cmsMenuChange(pDisplay, &cmsx_menuVtxRTC6705);
 106
 107             break;
 108 #endif
 109 #if defined(USE_VTX_SMARTAUDIO)
 110         case VTXDEV_SMARTAUDIO:
 111             cmsMenuChange(pDisplay, &cmsx_menuVtxSmartAudio);
 112
 113             break;
 114 #endif
 115 #if defined(USE_VTX_TRAMP)
 116         case VTXDEV_TRAMP:
 117             cmsMenuChange(pDisplay, &cmsx_menuVtxTramp);
 118
 119             break;
 120 #endif
 121
 122         default:
 123             cmsMenuChange(pDisplay, &cmsx_menuVtxError);
 124
 125             break;
 126         }
 127     } else {
 128         cmsMenuChange(pDisplay, &cmsx_menuVtxError);
 129     }
 130
 131     return NULL;
 132 }
 133 #endif