#include <SoftwareSerial.h>
SoftwareSerial lexo(PD0, PD1); // RX | TX   D I 

//Top
int top1=10; //J  10
int top2=9; //K  9

//Bot
int bot1=8; //L  8
int bot2=PD7; //M 7

//Emergency
int out1=PD6; //N  6
int out2=PD5; //N  5

int mk=11;//A

int count=0;

char value;


void setup() {
  lexo.begin(9600);
//Top Outputs
pinMode(top1,OUTPUT);
pinMode(top2,OUTPUT);

//Bot Outputs
pinMode(bot1,OUTPUT);
pinMode(bot2,OUTPUT);

//Emergency Outputs
pinMode(out1,OUTPUT);
pinMode(out2,OUTPUT);

pinMode(mk,INPUT);

//Initialize all system "Extended"
digitalWrite(top1,HIGH); 
digitalWrite(top2,HIGH);
digitalWrite(bot1,HIGH); 
digitalWrite(bot2,HIGH);
digitalWrite(out1,LOW); 
digitalWrite(out2,LOW); 
}


void loop() {
  if (lexo.available()>0)  //If Bluetooth port
  {
    value = lexo.read();  //Read the message sent
  
if (value == 'B' and count==0)   //When it's press "BOTTOM" from the App just Bottom Actuator moves
    {    
            digitalWrite(top1,HIGH); 
            digitalWrite(top2,HIGH); 
            
            digitalWrite(bot1,LOW); 
            digitalWrite(bot2,LOW); 

            digitalWrite(out1,LOW); 
            digitalWrite(out2,LOW);
     }
     if (value == 'C' and count==0)   //When it's press "TO COMPRESS" from the App contracts the leg
    {
            digitalWrite(top1,LOW); 
            digitalWrite(top2,LOW); 
            
            digitalWrite(bot1,LOW); 
            digitalWrite(bot2,LOW); 

            digitalWrite(out1,LOW); 
            digitalWrite(out2,LOW); 
     }    
     if (value == 'E' and count==0)   //When it's press "TO EXPAND" from the App expands the leg
    {
            digitalWrite(top1,HIGH); 
            digitalWrite(top2,HIGH); 
            
            digitalWrite(bot1,HIGH); 
            digitalWrite(bot2,HIGH); 

            digitalWrite(out1,LOW); 
            digitalWrite(out2,LOW); 
     }    
     if (value == 'M')   //When it's press "EMERGENCY" from the App just Stops all system and blocking the current, it was created to save the patient
    {
            digitalWrite(out1,HIGH); 
            digitalWrite(out2,HIGH);
            count=1;
     }   
     if (value=='R')   //When it's press "RELEASE EMERGENCY STATUS" from the App return all to initial status: extend and ready to start
    {
            digitalWrite(top1,HIGH); 
            digitalWrite(top2,HIGH); 
            
            digitalWrite(bot1,HIGH); 
            digitalWrite(bot2,HIGH); 

            digitalWrite(out1,LOW); 
            digitalWrite(out2,LOW); 
            count=0;
     }   
     if (value == 'T' and count==0)   //When it's press "TOP" from the App just Top Actuator moves
    {
            digitalWrite(top1,LOW); 
            digitalWrite(top2,LOW); 
            
            digitalWrite(bot1,HIGH); 
            digitalWrite(bot2,HIGH); 
            
            digitalWrite(out1,LOW); 
            digitalWrite(out2,LOW); 
     }
     
  }
  if (mk == LOW)   //When it's press "TOP" from the App just Top Actuator moves
    {
            
            
            digitalWrite(out1,HIGH); 
            digitalWrite(out2,HIGH); 
           
     }
}