// Use the Parola library to scroll text on the display
//
// Demonstrates the use of the scrolling function to display text received
// from the serial interface
//
// User can enter text on the serial monitor and this will display as a
// scrolling message on the display.
// Speed for the display is controlled by a pot on SPEED_IN analog in.
// Scrolling direction is controlled by a switch on DIRECTION_SET digital in.
// Invert ON/OFF is set by a switch on INVERT_SET digital in.
//
// UISwitch library can be found at https://github.com/MajicDesigns/MD_UISwitch
// MD_MAX72XX library can be found at https://github.com/MajicDesigns/MD_MAX72XX
//

#include <MD_Parola.h>
#include <MD_MAX72xx.h>
#include <SPI.h>

// set to 1 if we are implementing the user interface pot, switch, etc
#define USE_UI_CONTROL 0

#if USE_UI_CONTROL
#include <MD_UISwitch.h>
#endif

// Turn on debug statements to the serial output
#define DEBUG 0

#if DEBUG
#define PRINT(s, x) { Serial.print(F(s)); Serial.print(x); }
#define PRINTS(x) Serial.print(F(x))
#define PRINTX(x) Serial.println(x, HEX)
#else
#define PRINT(s, x)
#define PRINTS(x)
#define PRINTX(x)
#endif

// Define the number of devices we have in the chain and the hardware interface
// NOTE: These pin numbers will probably not work with your hardware and may
// need to be adapted
#define HARDWARE_TYPE MD_MAX72XX::PAROLA_HW
#define MAX_DEVICES 11
#define CLK_PIN   13
#define DATA_PIN  11
#define CS_PIN    10

int PinAzul = 3;
int PinVerde = 4;
int PinRojo = 5;
int trigPIN = 6;
int echoPIN = 7;

long duracion, distancia;


MD_Parola P = MD_Parola(HARDWARE_TYPE, CS_PIN, MAX_DEVICES);



#if USE_UI_CONTROL
const uint8_t SPEED_IN = A5;
const uint8_t DIRECTION_SET = 8;  
const uint8_t INVERT_SET = 9;     

const uint8_t SPEED_DEADBAND = 50;
#endif //

uint8_t scrollSpeed = 250;   
textEffect_t scrollEffect = PA_SCROLL_LEFT;
textPosition_t scrollAlign = PA_LEFT;
uint16_t scrollPause = 2000; 


#define	BUF_SIZE	75
char curMessage[BUF_SIZE] = { "" };



char newMessage[BUF_SIZE] = { "Alarma: <10cm" };
bool newMessageAvailable = true;


#if USE_UI_CONTROL

MD_UISwitch_Digital uiDirection(DIRECTION_SET);
MD_UISwitch_Digital uiInvert(INVERT_SET);

void doUI(void)
{
  
  {
    int16_t speed = map(analogRead(SPEED_IN), 0, 1023, 10, 150);

    if ((speed >= ((int16_t)P.getSpeed() + SPEED_DEADBAND)) ||
        (speed <= ((int16_t)P.getSpeed() - SPEED_DEADBAND)))
    {
      P.setSpeed(speed);
      scrollSpeed = speed;
      PRINT("\nChanged speed to ", P.getSpeed());
    }
  }

  if (uiDirection.read() == MD_UISwitch::KEY_PRESS) 
  {
    PRINTS("\nChanging scroll direction");
    scrollEffect = (scrollEffect == PA_SCROLL_LEFT ? PA_SCROLL_RIGHT : PA_SCROLL_LEFT);
    P.setTextEffect(scrollEffect, scrollEffect);
    P.displayClear();
    P.displayReset();
  }

  if (uiInvert.read() == MD_UISwitch::KEY_PRESS)  
  {
    PRINTS("\nChanging invert mode");
    P.setInvert(!P.getInvert());
  }
}
#endif // USE_UI_CONTROL

void readSerial(void)
{
  static char *cp = newMessage;

  while (Serial.available())
  {
    *cp = (char)Serial.read();
    if ((*cp == '\n') || (cp - newMessage >= BUF_SIZE - 2)) 
    {
      *cp = '\0'; // end the string
     
      cp = newMessage;
      newMessageAvailable = true;
    }
    else  // move char pointer to next position
      cp++;
  }
}

void setup()
{
  Serial.begin(57600);
  pinMode(trigPIN, OUTPUT);
  pinMode(echoPIN, INPUT);

  pinMode(PinRojo, OUTPUT);
  pinMode(PinVerde, OUTPUT);
  pinMode(PinAzul, OUTPUT);
#if USE_UI_CONTROL
  uiDirection.begin();
  uiInvert.begin();
  pinMode(SPEED_IN, INPUT);

  doUI();
#endif // USE_UI_CONTROL

  P.begin();
  P.displayText(curMessage, scrollAlign, scrollSpeed, scrollPause, scrollEffect, scrollEffect);
}

void loop()
{
  digitalWrite(trigPIN, LOW);        
  delay(2);
  digitalWrite(trigPIN, HIGH);
  delay(10);
  digitalWrite(trigPIN, LOW);
  
  duracion = pulseIn(echoPIN, HIGH);       
  distancia = (duracion / 2) / 29;

  if (distancia >=11){ 
    setColor(0, 255, 0);
     Serial.println("Distancia=");
     Serial.print (distancia);
     Serial.println("cm");
     delay(1000);

 }
 if (distancia <=10){ 
    setColor(255, 0, 0);
    Serial.println("Alarma.");
     Serial.println("Estas a <10cm");
     Serial.println();
     Serial.println("Distancia=");
     Serial.print (distancia);
     Serial.println("cm");
     delay(1000);
 }


#if USE_UI_CONTROL
  doUI();
#endif // USE_UI_CONTROL

  if (P.displayAnimate())
  {
    if (newMessageAvailable)
    {
      strcpy(curMessage, newMessage);
      newMessageAvailable = false;
    }
    P.displayReset();
  }
  readSerial();
}

void setColor(int redValue, int greenValue, int blueValue) {
  Serial.println();
  analogWrite(PinRojo, redValue);
  Serial.println(redValue);
  analogWrite(PinVerde, greenValue);
  Serial.println(greenValue);
  analogWrite(PinAzul, blueValue);
  Serial.println(blueValue);
  Serial.println();
}