Dependencies:   mbed

main.cpp

Committer:
Ridaz
Date:
2015-01-25
Revision:
0:4987246c96a1

File content as of revision 0:4987246c96a1:

#include "mbed.h"

// --Entrées--//
//Capteurs ligne :
DigitalIn gext_CAPTEURS_LIGNE (A0); // Capteur gauche exterieur
DigitalIn gmid_CAPTEURS_LIGNE (A1); // Capteur gauche milieu
DigitalIn dmid_CAPTEURS_LIGNE (A2); // Capteur droit milieu
DigitalIn dext_CAPTEURS_LIGNE (A3); // Capteur Droit exterieur
//Capteurs Vitesse :
AnalogIn CptVitesse_1 (D9);
AnalogIn CptVitesse_2(D8);
//Jack :
DigitalIn Jack(D5);
//Bouton poussoir :
DigitalIn BpPoussoir(D2);
//Fin de course :
DigitalIn Fdc(D4);
//Capteur Ultra Son :
AnalogIn IN_US(D1);

//--Sorties--//
//Moteurs :
PwmOut Moteur_gauche(D6);
PwmOut Moteur_Droit(D7);
//Capteur Ultra Son
PwmOut OUT_US(D0);


PwmOut led_BLUE(LED_BLUE);
PwmOut led_GREEN(LED_GREEN);
PwmOut led_RED(LED_RED);

double rp_cycl_droit = 0, rp_cycl_gauche = 0;
int valid = 0;
int main()
{
    led_GREEN = 1;
    led_RED = 0;
    led_BLUE = 1;

    while(Jack);
    while ( rp_cycl_droit < 0.6) {
        rp_cycl_droit +=0.05;
        rp_cycl_gauche += 0.05;
        wait (0.25);
        led_GREEN = 0;
        led_RED = 1;
        led_BLUE = 1;
        wait_ms(0.25);
    }
    while(!Fdc) {

        if (dext_CAPTEURS_LIGNE == 1 && gext_CAPTEURS_LIGNE == 1) { //Si tous les capteurs captent...
            rp_cycl_droit = 0.6;
            rp_cycl_gauche = 0.6;
        } else { //...Sinon...
            rp_cycl_droit = (1 / (1 + dext_CAPTEURS_LIGNE))/10*6;
            rp_cycl_gauche = (1/ (1 + gext_CAPTEURS_LIGNE))/10*6;
        }
        //Arret des moteurs
        rp_cycl_droit = 0;
        rp_cycl_gauche = 0;


    }

}