#include <Sipeed_OV2640.h>
#include <Sipeed_ST7789.h>
#include <stdio.h>

SPIClass spi_(SPI0); // MUST be SPI0 for Maix series on board LCD
Sipeed_ST7789 lcd(320, 240, spi_);

Sipeed_OV2640 camera(FRAMESIZE_QVGA, PIXFORMAT_RGB565);


void setup()
{
    lcd.begin(15000000, COLOR_RED);
    lcd.setRotation(2);
    if(!camera.begin())
      printf("camera init fail\n");
    else
      printf("camera init success\n");
    camera.run(true);
}

void loop()
{
  uint8_t*img = camera.snapshot();
  if(img == nullptr || img==0)
    printf("snap fail\n");
  else
    lcd.drawImage(0, 0, camera.width(), camera.height(), (uint16_t*)img);
}