aggiornato con servomotore e display

Dependencies:   mbed Servo mbed-rtos beep hcsr04 TextLCD

main.cpp

Committer:
huntR
Date:
2017-04-28
Revision:
0:650a24681467
Child:
1:13556d8b4a34

File content as of revision 0:650a24681467:

#include "mbed.h"
#include "rtos.h"
#include "hcsr04.h"
#include "beep.h"
/******************************/
//bluetooth
Serial blue(D10,D2);//tx e rx
/******************************/
//sensori ad ultrasuoni
HCSR04 sensor1(D15, D14);
HCSR04 sensor2(D12, D13);
HCSR04 sensor3(D11, D9);
/******************************/
//dichiarazioni led
//Led per le macchine
DigitalOut rossoC(PA_0);
DigitalOut gialloC(D5);
DigitalOut verdeC(D3);
/******************************/
//led per i pedoni
DigitalOut rossoP(D6);
DigitalOut gialloP(D7);
DigitalOut verdeP(D8);
/******************************/
//buzzer
Beep buzzer(D4);
/******************************/
/******************************/
//dichiarazione funzioni
void giallo();
void semafori();
/******************************/
//variabili
int i=0;
char riceviBlue = '0';
bool gianello= false;
bool visto = false;
/******************************/ 
 
//sensore semaforo 1
/******************************/
void sensori(){
    while(!visto && !gianello){
        sensor1.start();
        wait_ms(100);
        sensor2.start();
        wait_ms(100);
        if(sensor1.get_dist_cm()<10||sensor2.get_dist_cm()<10){
            wait(4);
            sensor1.start();
            wait_ms(100);
            sensor2.start();
            wait_ms(100);
            if(sensor1.get_dist_cm()<10||sensor2.get_dist_cm()<10&&!gianello){
               visto = true;
                blue.putc('A');                
                wait_ms(100);
                semafori();
                visto=false;
            }
        }
    }     
}
/******************************/
//controllo borini 
/******************************/
void borini (void const *args){
    while(true){
        if(blue.readable()){
            riceviBlue = blue.getc();
        }
        if(riceviBlue == 'B')
        {
            gianello=true;
            riceviBlue='0';
            semafori();
            riceviBlue='0';
            gianello=false;
            visto=false;
        }
    }
}
/******************************/
int main(){
   //inizializzazione
   /******************************/
   rossoP=1;
   verdeP=0;
   gialloP=0;
   gialloC=0;
   rossoC=0;
   verdeC=1;
   blue.baud(38400);
   /******************************/
Thread th1(borini);  
    while(1){
       if(!gianello){
            sensori();
        }
    }  
}
void giallo(){
    int n;
    int cont =0;
    do{
            n=0;
            verdeP=0;
            gialloP=1;       
           //bippata del buzzer
           /******************************/
            for(i=0;i<10;i++){
                buzzer.beep(1500,50);
                wait_ms(200);
                buzzer.nobeep();
                buzzer.beep(2000,50);
                wait_ms(200);
                buzzer.nobeep();                                
            } 
            /******************************/
            sensor3.start();
            wait_ms(100);
            if(sensor3.get_dist_cm()<48){
               cont++;
               if(cont<=2)
                blue.putc('L');
               n=1;               
            }
            wait_ms(100);            
    }while(n==1&&cont<=2);
    blue.putc('0');      
    wait_ms(200);
}
void semafori(){
    //giallo per le macchine, rosso per i pedoni       
            verdeC=0;
            gialloC=1;
            rossoC=0;
            wait(4);
            //rosso per le macchine, verde per i pedoni
            buzzer.beep(1200,50);  
            gialloC=0;
            rossoC=1;            
            rossoP=0;
            verdeP=1;            
            wait(10);
            buzzer.nobeep();
            //giallo per i pedoni e rosso per le macchine   
            giallo();
            //rosso ai pedoni e verde alle automobili
            gialloP=0;
            rossoP=1; 
            rossoC=0;
            verdeC=1;
            wait_ms(5000);
}