/* 
 *  B3 
 *  Control solenoids and lights through Wi-Fi network (UDP)
 *  Website : http://reso-nance.org/projets/b3/accueil
 *  
 *  Setup : Pure Data > "linksys" Wi-Fi router > ESP8266 modules
 *  Message : Id (0,1,2) Delay (0-120).
 *  ID 0 = pin 11, ID 1 = pin 12, ID 2 = pin 13
 *  
 *  Author : Jerome Abel / http://jeromeabel.net
 *  Licence : GNU/GPL3
 */
 
#include <ESP8266WiFi.h>
#include <WiFiUdp.h>
#include "Solenoid.h"
 
const boolean DEBUG = false;
 
// NETWORK SETUP
char ssid[] = "linksys"; // Name of the Wi-Fi network
char pass[] = ""; // No password
IPAddress ip(192, 168, 0, 111);  // Local IP (static)   
IPAddress gateway(192, 168, 0, 1); // Router IP
const unsigned int localPort = 8888;  // Local Port
 
// OTHER SETUP
IPAddress subnet(255, 255, 255, 0);
char packetBuffer[255]; // Incoming
String data[2]; // Store incoming data
int status = WL_IDLE_STATUS;
WiFiUDP udp;
 
// ---- CONFIGURATIONS ---- //
const int PINS[] = {12, 13, 14}; // Pins for ESP8266 Wemos like 11, 12, 13 Arduino pins
const int DELAY_MAX = 50;
const int NB = 3;
const int TEMPO = 10; // Sampling tempo
 
// ---- SOLENOIDS --------- //
Solenoid solenoids[NB];
int solenoid_id, solenoid_delay;
unsigned long current = 0;
 
void setup() {
 
  // Output
  for (int i=0; i < NB; i++) {
     solenoids[i].init(PINS[i], DELAY_MAX, DEBUG);
  }
 
  // WiFi Connection
  WiFi.config(ip, gateway, subnet); // Static IP Address
  WiFi.begin(ssid, pass);
  while (WiFi.status() != WL_CONNECTED) 
  {
   delay(500);
  }
 
  // UDP Connection
  udp.begin(localPort);
 
  if (DEBUG) 
  {
    Serial.begin(115200);
    Serial.print("IP: ");
    Serial.println(WiFi.localIP());
  }
}
 
void loop() {
 
  // UPDATE TIME
  current = millis();
 
  // Read data if available
  int packetSize = udp.parsePacket();
  if (packetSize) 
  {
    // Read the packet into packetBuffer
    int len = udp.read(packetBuffer, 255);
    if (len > 0) packetBuffer[len] = 0;
 
    // Parse with space delimiter ' ' and fill data[]
    String strData(packetBuffer);
    splitString(strData, ' ');
 
    solenoid_id = data[0].toInt(); // get ID
    solenoid_delay = data[1].toInt(); // get Delay
 
    // MOTOR ON
    if( solenoids[solenoid_id].isOn() == false ) solenoids[solenoid_id].on(current, solenoid_delay);
  }
 
    // MOTOR OFF
  for (int i=0; i < NB; i++) {
     if( solenoids[i].isOn() ) solenoids[i].off(current);
  }
}
 
// Méthode pour découper le message avec un séparateur (ou "parser")
// Split string messages with a separator character
void splitString(String message, char separator) {
  int index = 0;
  int cnt = 0;
    do {
      index = message.indexOf(separator); 
      // s'il y a bien un caractère séparateur
      if(index != -1) { 
          // on découpe la chaine et on stocke le bout dans le tableau
          data[cnt] = message.substring(0,index); 
          cnt++;
          // on enlève du message le bout stocké
          message = message.substring(index+1, message.length());
      } else {
         // après le dernier espace   
         // on s'assure que la chaine n'est pas vide
         if(message.length() > 0) { 
           data[cnt] = message.substring(0,index); // dernier bout
           cnt++;
         }
      }
   } while(index >=0); // tant qu'il y a bien un séparateur dans la chaine
}