BIPBIP CARRE

Dependencies:   mbed

main.cpp

Committer:
syasya
Date:
2017-06-06
Revision:
0:929b9389852e

File content as of revision 0:929b9389852e:

#include "mbed.h"
#define periode 0.0001
#define tourne 0.81
#define dist 2.27

DigitalIn fdc(D2);
DigitalIn jack(D3);
PwmOut motg(D6);
PwmOut motd(D8);
DigitalOut Smot1(D7);
DigitalOut Smot2(D9);

int main()

{
    int ib,dist=ib;
    motg.period(periode);
    motd.period(periode);

    if(jack.read()==1) {

        Smot1.write(1);
        Smot2.write(1);

        //roule

        motd.pulsewidth(0.00007);
        motg.pulsewidth(0.00007);
        wait(dist);
        motd.pulsewidth(0.00007);
        motg.pulsewidth(0.0001);
        wait(tourne);

        motd.pulsewidth(0.00007);
        motg.pulsewidth(0.00007);
        wait(dist);
        motd.pulsewidth(0.00007);
        motg.pulsewidth(0.0001);
        wait(tourne);

        motd.pulsewidth(0.00007);
        motg.pulsewidth(0.00007);
        wait(dist);
        motd.pulsewidth(0.00007);
        motg.pulsewidth(0.0001);
        wait(tourne);

        motd.pulsewidth(0.00007);
        motg.pulsewidth(0.00007);
        wait(dist);
        motd.pulsewidth(0.00007);
        motg.pulsewidth(0.0001);
        wait(tourne);

        motd.pulsewidth(0.0001);
        motg.pulsewidth(0.0001);
        wait(100000);
    }
}