#include <dummy.h>

#include "esp_camera.h"
#include <WiFi.h>

//
// WARNING!!! Make sure that you have either selected ESP32 Wrover Module,
//            or another board which has PSRAM enabled
//

// Select camera model
//#define CAMERA_MODEL_WROVER_KIT
//#define CAMERA_MODEL_ESP_EYE
//#define CAMERA_MODEL_M5STACK_PSRAM
//#define CAMERA_MODEL_M5STACK_WIDE
#define CAMERA_MODEL_AI_THINKER

/*
#define MAX_RUNNING_TIME 50000 //50s
#define MAX_RUNNING_TIME 100000 //100s
#define MAX_RUNNING_TIME 3600000 //1hour
#define MAX_RUNNING_TIME 7200000 //2hours
#define MAX_RUNNING_TIME 10800000 //3hours
#define MAX_RUNNING_TIME 14400000 //4 hours
#define MAX_RUNNING_TIME 18000000 //5 hours
#define MAX_RUNNING_TIME 21600000 //6 hours
#define MAX_RUNNING_TIME 25200000 //7 hours
#define MAX_RUNNING_TIME 28800000 //8 hours
#define MAX_RUNNING_TIME 32400000 //9 hours
#define MAX_RUNNING_TIME 36000000 //10 hours
#define MAX_RUNNING_TIME 39600000 //11 hours
#define MAX_RUNNING_TIME 43200000 //12 hours
*/
#define MAX_RUNNING_TIME 21600000 //6 hours
#include "camera_pins.h"

//-----------------------------------------------------------------------------------
//Wifi Constants
//-----------------------------------------------------------------------------------
String WiFiIP;
typedef struct _ssid_list_t {
  const char* ssid;
  const char* password;
} ssid_list_t;

//#define _TEST
#ifndef _TEST
const int MAX_CNX_RETRIES = 10;
ssid_list_t aplist[]={
  {"WIFIName", "WIFIpassword"},  
  {NULL,NULL}
};
#else
const int MAX_CNX_RETRIES = 1;
ssid_list_t aplist[]={
  {"Phony", "phonyaccount"},
  {NULL,NULL}
};
#endif //_TEST
byte WiFiConnect() {
  WiFiIP = "No IP";
  WiFi.disconnect(true);
  delay(2000);
  WiFi.mode(WIFI_STA);
  WiFi.setAutoConnect(true);

  byte i = 0;
  while(aplist[i].ssid!= NULL) {
    WiFi.begin(aplist[i].ssid, aplist[i].password);
    byte count = 0;
    Serial.print("WiFiConnect: Connecting to ");
    Serial.print(aplist[i].ssid);
    while(WiFi.status() != WL_CONNECTED && count < MAX_CNX_RETRIES)
    {
      count ++;
      delay(500);
      Serial.print(".");
    }
    if( WiFi.status() == WL_CONNECTED ) {
      Serial.println("");
      IPAddress ip = WiFi.localIP();
      WiFiIP =  String(ip[0]) + '.' + String(ip[1]) + '.' + String(ip[2]) + '.' + String(ip[3]);
      Serial.println("WiFiConnect: "+WiFiIP);
      break;
    }
    if(WiFi.status() != WL_CONNECTED)
    {
      Serial.println("WiFiConnect: Failed");
    }
    i++;
  }
  return (WiFi.status() == WL_CONNECTED) ? 1 : 0;
}

void startCameraServer();

void setup() {
  Serial.begin(115200);
  Serial.setDebugOutput(true);
  Serial.println();

  camera_config_t config;
  config.ledc_channel = LEDC_CHANNEL_0;
  config.ledc_timer = LEDC_TIMER_0;
  config.pin_d0 = Y2_GPIO_NUM;
  config.pin_d1 = Y3_GPIO_NUM;
  config.pin_d2 = Y4_GPIO_NUM;
  config.pin_d3 = Y5_GPIO_NUM;
  config.pin_d4 = Y6_GPIO_NUM;
  config.pin_d5 = Y7_GPIO_NUM;
  config.pin_d6 = Y8_GPIO_NUM;
  config.pin_d7 = Y9_GPIO_NUM;
  config.pin_xclk = XCLK_GPIO_NUM;
  config.pin_pclk = PCLK_GPIO_NUM;
  config.pin_vsync = VSYNC_GPIO_NUM;
  config.pin_href = HREF_GPIO_NUM;
  config.pin_sscb_sda = SIOD_GPIO_NUM;
  config.pin_sscb_scl = SIOC_GPIO_NUM;
  config.pin_pwdn = PWDN_GPIO_NUM;
  config.pin_reset = RESET_GPIO_NUM;
  config.xclk_freq_hz = 20000000;
  config.pixel_format = PIXFORMAT_JPEG;
  //init with high specs to pre-allocate larger buffers
  if (psramFound()) {
    config.frame_size = FRAMESIZE_UXGA;
    config.jpeg_quality = 10;
    config.fb_count = 2;
  } else {
    config.frame_size = FRAMESIZE_SVGA;
    config.jpeg_quality = 12;
    config.fb_count = 1;
  }

#if defined(CAMERA_MODEL_ESP_EYE)
  pinMode(13, INPUT_PULLUP);
  pinMode(14, INPUT_PULLUP);
#endif

  // camera init
  Serial.println("DEBUG: esp_camera_init Before");
  esp_err_t err = esp_camera_init(&config);
  if (err != ESP_OK) {
    Serial.printf("Camera init failed with error 0x%x", err);
    return;
  }
  Serial.println("DEBUG: esp_camera_init After");
  sensor_t * s = esp_camera_sensor_get();
  //initial sensors are flipped vertically and colors are a bit saturated
  if (s->id.PID == OV3660_PID) {
    s->set_vflip(s, 1);//flip it back
    s->set_brightness(s, 1);//up the blightness just a bit
    s->set_saturation(s, -2);//lower the saturation
  }
  //drop down frame size for higher initial frame rate
  s->set_framesize(s, FRAMESIZE_QVGA);

#if defined(CAMERA_MODEL_M5STACK_WIDE)
  s->set_vflip(s, 1);
  s->set_hmirror(s, 1);
#endif

  WiFiConnect();
  startCameraServer();

  Serial.print("Camera Ready! Use 'http://");
  Serial.print(WiFi.localIP());
  Serial.println("' to connect");
}

void loop() {
  // put your main code here, to run repeatedly:
  unsigned long time;
  delay(10000);
  time = millis();
  Serial.println(time);
  if( time > MAX_RUNNING_TIME ) {
    Serial.println("Triggered reboot");
    ESP.restart();
  }
}