#include <Adafruit_NeoPixel.h>
#define LED_PIN 18
#define LED_COUNT 2

Adafruit_NeoPixel strip(LED_COUNT, LED_PIN, NEO_GRB + NEO_KHZ800);

#include <WiFi.h>
#include <Servo.h>


Servo myservo;
Servo myservo2;

// GPIO the servo is attached to
static const int servoPin = 13;

// Replace with your network credentials
const char* ssid     = "ssid network";
const char* password = "ssid password";

// Set web server port number to 80
WiFiServer server(80);

// Variable to store the HTTP request
String header;
unsigned long lastTimer = 0;
unsigned long lastTimer2 = 0;

// Decode HTTP GET value
String valueString = String(5);
int pos1 = 0;
int pos2 = 0;

// Current time
unsigned long currentTime = millis();
// Previous time
unsigned long previousTime = 0;
// Define timeout time in milliseconds (example: 2000ms = 2s)
const long timeoutTime = 2000;
int pos = 90;

void setup() {
  Serial.begin(115200);
  pinMode(0, OUTPUT);
  pinMode(1, OUTPUT);
  pinMode(2, OUTPUT);
  pinMode(3, OUTPUT);
  pinMode(4, OUTPUT);
  pinMode(5, OUTPUT);
  pinMode(6, OUTPUT);
  pinMode(7, OUTPUT);
  pinMode(16, OUTPUT);
  pinMode(17, OUTPUT);
  pinMode(26, OUTPUT);
  pinMode(27, OUTPUT);


  strip.begin();           // INITIALIZE NeoPixel strip object (REQUIRED)
  strip.show();            // Turn OFF all pixels ASAP
  strip.setBrightness(50); // Set BRIGHTNESS to about 1/5 (max = 255)

  myservo.attach(15);
  myservo2.attach(14);

  // Connect to Wi-Fi network with SSID and password
  Serial.print("Connecting to ");
  Serial.println(ssid);
  WiFi.begin(ssid, password);
  while (WiFi.status() != WL_CONNECTED) {
    delay(500);
    Serial.print(".");
  }
  // Print local IP address and start web server
  Serial.println("");
  Serial.println("WiFi connected.");
  Serial.println("IP address: ");
  Serial.println(WiFi.localIP());
  server.begin();
}

void loop() {
  WiFiClient client = server.available();   // Listen for incoming clients

  int tt = 50;
  int color = map(pos, 0, 180, 0, 255);

  if ( pos <  20 ) {
    //left signal
    strip.setPixelColor(0, strip.Color(255, 0, 0));
    strip.setPixelColor(1, strip.Color(0, 0, 0));

    digitalWrite(26, HIGH);
    delay(tt);
    digitalWrite(6, HIGH);
    digitalWrite(26, LOW);
    delay(tt);
    digitalWrite(17, HIGH);
    digitalWrite(6, LOW);
    delay(tt);
    digitalWrite(16, HIGH);
    digitalWrite(17, LOW);
    delay(tt);
    digitalWrite(5, HIGH);
    digitalWrite(16, LOW);
    delay(tt);
    digitalWrite(4, HIGH);
    digitalWrite(5, LOW);
    delay(tt);
    digitalWrite(3, HIGH);
    digitalWrite(4, LOW);
    delay(tt);
    digitalWrite(2, HIGH);
    digitalWrite(3, LOW);
    delay(tt);
    digitalWrite(2, LOW);
    delay(tt);

  } else if ( pos > 160 ) {

    // right signal
    strip.setPixelColor(0, strip.Color(0, 0, 0));
    strip.setPixelColor(1, strip.Color(0, 255, 0));

    digitalWrite(2, HIGH);
    delay(tt);
    digitalWrite(3, HIGH);
    digitalWrite(2, LOW);
    delay(tt);
    digitalWrite(4, HIGH);
    digitalWrite(3, LOW);
    delay(tt);
    digitalWrite(5, HIGH);
    digitalWrite(4, LOW);
    delay(tt);
    digitalWrite(16, HIGH);
    digitalWrite(5, LOW);
    delay(tt);
    digitalWrite(17, HIGH);
    digitalWrite(16, LOW);
    delay(tt);
    digitalWrite(6, HIGH);
    digitalWrite(17, LOW);
    delay(tt);
    digitalWrite(26, HIGH);
    digitalWrite(6, LOW);
    delay(tt);
    digitalWrite(26, LOW);
    delay(tt);
  } else {
    strip.setPixelColor(0, strip.Color(0, 0, 0));
    strip.setPixelColor(1, strip.Color(0, 0, 0));
  }

  strip.show();


  if (client) {                             // If a new client connects,
    currentTime = millis();
    previousTime = currentTime;
    Serial.println("New Client.");          // print a message out in the serial port
    String currentLine = "";                // make a String to hold incoming data from the client
    while (client.connected() && currentTime - previousTime <= timeoutTime) { // loop while the client's connected
      currentTime = millis();
      if (client.available()) {             // if there's bytes to read from the client,
        char c = client.read();             // read a byte, then
        Serial.write(c);                    // print it out the serial monitor
        header += c;
        if (c == '\n') {                    // if the byte is a newline character
          // if the current line is blank, you got two newline characters in a row.
          // that's the end of the client HTTP request, so send a response:
          if (currentLine.length() == 0) {
            // HTTP headers always start with a response code (e.g. HTTP/1.1 200 OK)
            // and a content-type so the client knows what's coming, then a blank line:
            client.println("HTTP/1.1 200 OK");
            client.println("Content-type:text/html");
            client.println("Connection: close");
            client.println();

            // Display the HTML web page
            client.println("<!DOCTYPE html><html>");
            client.println("<head><meta name=\"viewport\" content=\"width=device-width, initial-scale=1\">");
            client.println("<link rel=\"icon\" href=\"data:,\">");
            // CSS to style the on/off buttons
            // Feel free to change the background-color and font-size attributes to fit your preferences
            client.println("<style>body { text-align: center; font-family: \"Trebuchet MS\", Arial; margin-left:auto; margin-right:auto;}");
            client.println(".slider { width: 300px; }</style>");
            client.println("<script src=\"https://ajax.googleapis.com/ajax/libs/jquery/3.3.1/jquery.min.js\"></script>");

            // Web Page
            client.println("</head><body><h1>Cytron ROBO PICO with Servo</h1>");
            client.println("<p>Position: <span id=\"servoPos\"></span></p>");
            client.println("<input type=\"range\" min=\"0\" max=\"180\" class=\"slider\" id=\"servoSlider\" onchange=\"servo(this.value)\" value=\"" + valueString + "\"/><P>");

            client.println("<script>");
            client.println("var slider = document.getElementById(\"servoSlider\");");
            client.println("var servoP = document.getElementById(\"servoPos\"); servoP.innerHTML = slider.value;");
            client.println("slider.oninput = function() { slider.value = this.value; servoP.innerHTML = this.value; }");
            client.println("$.ajaxSetup({timeout:1000}); function servo(pos) { ");
            client.println("$.get(\"/?value=\" + pos + \"&\"); {Connection: close};}");
            client.println("</script>");

            client.println("</body></html>");

            //GET /?value=180& HTTP/1.1
            if (header.indexOf("GET /?value=") >= 0) {
              pos1 = header.indexOf('=');
              pos2 = header.indexOf('&');
              valueString = header.substring(pos1 + 1, pos2);

              // Save pos for LED use
              pos = valueString.toInt();

              //Rotate the servo
              myservo.write(valueString.toInt());
              myservo2.write(valueString.toInt());
              Serial.println(valueString);
            }
            // The HTTP response ends with another blank line
            client.println();
            // Break out of the while loop
            break;
          } else { // if you got a newline, then clear currentLine
            currentLine = "";
          }
        } else if (c != '\r') {  // if you got anything else but a carriage return character,
          currentLine += c;      // add it to the end of the currentLine
        }
      }
    }
    // Clear the header variable
    header = "";
    // Close the connection
    client.stop();
    Serial.println("Client disconnected.");
    Serial.println("");
  }
}