firmware/src/graphics/tftSetup.cpp

#if HAS_TFT

#include "SPILock.h"
#include "sleep.h"

#include "api/PacketAPI.h"
#include "comms/PacketClient.h"
#include "comms/PacketServer.h"
#include "graphics/DeviceScreen.h"
#include "graphics/driver/DisplayDriverConfig.h"

#ifdef ARCH_PORTDUINO
#include "PortduinoGlue.h"
#include <thread>
#endif

DeviceScreen *deviceScreen = nullptr;

#ifdef ARCH_ESP32
// Get notified when the system is entering light sleep
CallbackObserver<DeviceScreen, void *> tftSleepObserver =
    CallbackObserver<DeviceScreen, void *>(deviceScreen, &DeviceScreen::prepareSleep);
CallbackObserver<DeviceScreen, esp_sleep_wakeup_cause_t> endSleepObserver =
    CallbackObserver<DeviceScreen, esp_sleep_wakeup_cause_t>(deviceScreen, &DeviceScreen::wakeUp);
#endif

void tft_task_handler(void *param = nullptr)
{
    while (true) {
        spiLock->lock();
        deviceScreen->task_handler();
        spiLock->unlock();
        deviceScreen->sleep();
    }
}

void tftSetup(void)
{
#ifndef ARCH_PORTDUINO
    deviceScreen = &DeviceScreen::create();
    PacketAPI::create(PacketServer::init());
    deviceScreen->init(new PacketClient);
#else
    if (settingsMap[displayPanel] != no_screen) {
        DisplayDriverConfig displayConfig;
        static char *panels[] = {"NOSCREEN", "X11",     "FB",      "ST7789",  "ST7735",  "ST7735S",
                                 "ST7796",   "ILI9341", "ILI9342", "ILI9486", "ILI9488", "HX8357D"};
        static char *touch[] = {"NOTOUCH", "XPT2046", "STMPE610", "GT911", "FT5x06"};
#if defined(USE_X11)
        if (settingsMap[displayPanel] == x11) {
            if (settingsMap[displayWidth] && settingsMap[displayHeight])
                displayConfig = DisplayDriverConfig(DisplayDriverConfig::device_t::X11, (uint16_t)settingsMap[displayWidth],
                                                    (uint16_t)settingsMap[displayHeight]);
            else
                displayConfig.device(DisplayDriverConfig::device_t::X11);
        } else
#elif defined(USE_FRAMEBUFFER)
        if (settingsMap[displayPanel] == fb) {
            if (settingsMap[displayWidth] && settingsMap[displayHeight])
                displayConfig = DisplayDriverConfig(DisplayDriverConfig::device_t::FB, (uint16_t)settingsMap[displayWidth],
                                                    (uint16_t)settingsMap[displayHeight]);
            else
                displayConfig.device(DisplayDriverConfig::device_t::FB);
        } else
#endif
        {
            displayConfig.device(DisplayDriverConfig::device_t::CUSTOM_TFT)
                .panel(DisplayDriverConfig::panel_config_t{.type = panels[settingsMap[displayPanel]],
                                                           .panel_width = (uint16_t)settingsMap[displayWidth],
                                                           .panel_height = (uint16_t)settingsMap[displayHeight],
                                                           .rotation = (bool)settingsMap[displayRotate],
                                                           .pin_cs = (int16_t)settingsMap[displayCS],
                                                           .pin_rst = (int16_t)settingsMap[displayReset],
                                                           .offset_x = (uint16_t)settingsMap[displayOffsetX],
                                                           .offset_y = (uint16_t)settingsMap[displayOffsetY],
                                                           .offset_rotation = (uint8_t)settingsMap[displayOffsetRotate],
                                                           .invert = settingsMap[displayInvert] ? true : false,
                                                           .rgb_order = (bool)settingsMap[displayRGBOrder],
                                                           .dlen_16bit = settingsMap[displayPanel] == ili9486 ||
                                                                         settingsMap[displayPanel] == ili9488})
                .bus(DisplayDriverConfig::bus_config_t{.freq_write = (uint32_t)settingsMap[displayBusFrequency],
                                                       .freq_read = 16000000,
                                                       .spi{.pin_dc = (int8_t)settingsMap[displayDC],
                                                            .use_lock = true,
                                                            .spi_host = (uint16_t)settingsMap[displayspidev]}})
                .input(DisplayDriverConfig::input_config_t{.keyboardDevice = settingsStrings[keyboardDevice],
                                                           .pointerDevice = settingsStrings[pointerDevice]})
                .light(DisplayDriverConfig::light_config_t{.pin_bl = (int16_t)settingsMap[displayBacklight],
                                                           .pwm_channel = (int8_t)settingsMap[displayBacklightPWMChannel],
                                                           .invert = (bool)settingsMap[displayBacklightInvert]});
            if (settingsMap[touchscreenI2CAddr] == -1) {
                displayConfig.touch(
                    DisplayDriverConfig::touch_config_t{.type = touch[settingsMap[touchscreenModule]],
                                                        .freq = (uint32_t)settingsMap[touchscreenBusFrequency],
                                                        .pin_int = (int16_t)settingsMap[touchscreenIRQ],
                                                        .offset_rotation = (uint8_t)settingsMap[touchscreenRotate],
                                                        .spi{
                                                            .spi_host = (int8_t)settingsMap[touchscreenspidev],
                                                        },
                                                        .pin_cs = (int16_t)settingsMap[touchscreenCS]});
            } else {
                displayConfig.touch(DisplayDriverConfig::touch_config_t{
                    .type = touch[settingsMap[touchscreenModule]],
                    .freq = (uint32_t)settingsMap[touchscreenBusFrequency],
                    .x_min = 0,
                    .x_max =
                        (int16_t)((settingsMap[touchscreenRotate] & 1 ? settingsMap[displayWidth] : settingsMap[displayHeight]) -
                                  1),
                    .y_min = 0,
                    .y_max =
                        (int16_t)((settingsMap[touchscreenRotate] & 1 ? settingsMap[displayHeight] : settingsMap[displayWidth]) -
                                  1),
                    .pin_int = (int16_t)settingsMap[touchscreenIRQ],
                    .offset_rotation = (uint8_t)settingsMap[touchscreenRotate],
                    .i2c{.i2c_addr = (uint8_t)settingsMap[touchscreenI2CAddr]}});
            }
        }
        deviceScreen = &DeviceScreen::create(&displayConfig);
        PacketAPI::create(PacketServer::init());
        deviceScreen->init(new PacketClient);
    } else {
        LOG_INFO("Running without TFT display!");
    }
#endif

    if (deviceScreen) {
#ifdef ARCH_ESP32
        tftSleepObserver.observe(&notifyLightSleep);
        endSleepObserver.observe(&notifyLightSleepEnd);
        xTaskCreatePinnedToCore(tft_task_handler, "tft", 10240, NULL, 1, NULL, 0);
#elif defined(ARCH_PORTDUINO)
        std::thread *tft_task = new std::thread([] { tft_task_handler(); });
#endif
    }
}

#endif