src/main/io/displayport_hott.c

   1 /*
   2  * This file is part of Cleanflight.
   3  *
   4  * Cleanflight is free software: you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation, either version 3 of the License, or
   7  * (at your option) any later version.
   8  *
   9  * Cleanflight is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12  * GNU General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU General Public License
  15  * along with Cleanflight.  If not, see <http://www.gnu.org/licenses/>.
  16  */
  17
  18 #include <stdbool.h>
  19 #include <stdint.h>
  20 #include <string.h>
  21
  22 #include "platform.h"
  23 #if defined (USE_HOTT_TEXTMODE) && defined (USE_CMS)
  24
  25 #include "common/utils.h"
  26 #include "cms/cms.h"
  27 #include "telemetry/hott.h"
  28
  29 displayPort_t hottDisplayPort;
  30
  31 static int hottDrawScreen(displayPort_t *displayPort)
  32 {
  33     UNUSED(displayPort);
  34     return 0;
  35 }
  36
  37 static int hottScreenSize(const displayPort_t *displayPort)
  38 {
  39     return displayPort->rows * displayPort->cols;
  40 }
  41
  42 static int hottWriteChar(displayPort_t *displayPort, uint8_t col, uint8_t row, uint16_t c, textAttributes_t attr)
  43 {
  44     UNUSED(displayPort);
  45     UNUSED(attr);
  46
  47     hottTextmodeWriteChar(col, row, (uint8_t)c);
  48     return 0;
  49 }
  50
  51 static int hottWriteString(displayPort_t *displayPort, uint8_t col, uint8_t row, const char *s, textAttributes_t attr)
  52 {
  53     while (*s) {
  54         hottWriteChar(displayPort,  col++, row, *(s++), attr);
  55     }
  56     return 0;
  57 }
  58
  59 static int hottClearScreen(displayPort_t *displayPort)
  60 {
  61     for (int row = 0; row < displayPort->rows; row++) {
  62         for (int col= 0; col < displayPort->cols; col++) {
  63             hottWriteChar(displayPort, col, row, ' ', 0);
  64          }
  65     }
  66     return 0;
  67 }
  68
  69 static bool hottIsTransferInProgress(const displayPort_t *displayPort)
  70 {
  71     UNUSED(displayPort);
  72     return false;
  73 }
  74
  75 static int hottHeartbeat(displayPort_t *displayPort)
  76 {
  77     if (!hottTextmodeIsAlive()) {
  78         cmsMenuExit(displayPort, (void*)CMS_EXIT_SAVE);
  79     }
  80
  81     return 0;
  82 }
  83
  84 static void hottResync(displayPort_t *displayPort)
  85 {
  86     UNUSED(displayPort);
  87 }
  88
  89 static uint32_t hottTxBytesFree(const displayPort_t *displayPort)
  90 {
  91     UNUSED(displayPort);
  92     return UINT32_MAX;
  93 }
  94
  95 static int hottGrab(displayPort_t *displayPort)
  96 {
  97     hottTextmodeGrab();
  98     return displayPort->grabCount = 1;
  99 }
 100
 101 static int hottRelease(displayPort_t *displayPort)
 102 {
 103     int cnt = displayPort->grabCount = 0;
 104     hottClearScreen(displayPort);
 105     hottTextmodeExit();
 106     return cnt;
 107 }
 108
 109 static const displayPortVTable_t hottVTable = {
 110     .grab = hottGrab,
 111     .release = hottRelease,
 112     .clearScreen = hottClearScreen,
 113     .drawScreen = hottDrawScreen,
 114     .screenSize = hottScreenSize,
 115     .writeString = hottWriteString,
 116     .writeChar = hottWriteChar,
 117     .isTransferInProgress = hottIsTransferInProgress,
 118     .heartbeat = hottHeartbeat,
 119     .resync = hottResync,
 120     .txBytesFree = hottTxBytesFree
 121 };
 122
 123 displayPort_t *displayPortHottInit(void)
 124 {
 125     hottDisplayPort.device = NULL;
 126     displayInit(&hottDisplayPort, &hottVTable);
 127     hottDisplayPort.useFullscreen = true;
 128     hottDisplayPort.rows = HOTT_TEXTMODE_DISPLAY_ROWS;
 129     hottDisplayPort.cols = HOTT_TEXTMODE_DISPLAY_COLUMNS;
 130     return &hottDisplayPort;
 131 }
 132
 133 void hottDisplayportRegister(void)
 134 {
 135     cmsDisplayPortRegister(displayPortHottInit());
 136 }
 137
 138 void hottCmsOpen(void)
 139 {
 140     if (!cmsInMenu) {
 141         cmsDisplayPortSelect(&hottDisplayPort);
 142         cmsMenuOpen();
 143     }
 144 }
 145
 146 void hottSetCmsKey(uint8_t hottKey, bool keepCmsOpen)
 147 {
 148     switch (hottKey) {
 149         case HOTTV4_BUTTON_DEC:
 150             cmsSetExternKey(CMS_KEY_UP);
 151             break;
 152         case HOTTV4_BUTTON_INC:
 153             cmsSetExternKey(CMS_KEY_DOWN);
 154             break;
 155         case HOTTV4_BUTTON_SET:
 156             if (cmsInMenu) {
 157                 cmsMenuExit(cmsDisplayPortGetCurrent(), (void*)CMS_EXIT_SAVE);
 158             }
 159             cmsSetExternKey(CMS_KEY_NONE);
 160             break;
 161         case HOTTV4_BUTTON_NEXT:
 162             cmsSetExternKey(CMS_KEY_RIGHT);
 163             break;
 164         case HOTTV4_BUTTON_PREV:
 165             cmsSetExternKey(CMS_KEY_LEFT);
 166             if (keepCmsOpen) { // Make sure CMS is open until textmode is closed.
 167                 cmsMenuOpen();
 168             }
 169             break;
 170          default:
 171             cmsSetExternKey(CMS_KEY_NONE);
 172             break;
 173         }
 174 }
 175
 176 #endif