DeskControl/src/main.cpp

#include <SPI.h>
#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_ST7789.h>

#include "./include/display.h"
#include "./include/heightsensor.h"
#include "./lib/menu.h"
#include "./lib/vl53l0x.h"


auto display = Adafruit_ST7789(DISPLAY_PORT_CS, DISPLAY_PORT_DC, DISPLAY_PORT_RST);
auto heightSensor = VL53L0X();

auto menu = Menu(&display);


void setup()
{
  display.init(DISPLAY_WIDTH, DISPLAY_HEIGHT, SPI_MODE3);
  display.setRotation(DISPLAY_ROTATION);
  display.fillScreen(ST77XX_BLACK);

  menu.init();

  // TODO draw "initializing" text

  Wire.begin();

  VL53L0XResult result;
  if (!heightSensor.init(HEIGHTSENSOR_I2C_ADDRESS, &result))
  {
    // TODO draw "height sensor error" text

    while(1);
  }

  VL53L0X_Error error;
  if (!heightSensor.setMeasurementTimingBudget(33000, &error))
  {
    // TODO draw "height sensor budget error" text

    while(1);
  }

  display.fillScreen(ST77XX_BLACK);
}

void loop()
{
  // TODO
}