init

Dependencies:   mbed pixy

Committer:
qj604184
Date:
Fri Jun 09 23:20:19 2017 +0000
Revision:
0:98d2bcd7ae29
cachanNRC

Who changed what in which revision?

UserRevisionLine numberNew contents of line
qj604184 0:98d2bcd7ae29 1 #include "mbed.h"
qj604184 0:98d2bcd7ae29 2 char cmdI2C=0xF3 ;// CS vbat x x x SensG SensD CS_G CD_D, sens moteur positif CS à 0.
qj604184 0:98d2bcd7ae29 3 PwmOut MotD(p25);
qj604184 0:98d2bcd7ae29 4 PwmOut MotG(p22);
qj604184 0:98d2bcd7ae29 5
qj604184 0:98d2bcd7ae29 6 BusOut leds(LED1,LED2,LED3,LED4);
qj604184 0:98d2bcd7ae29 7
qj604184 0:98d2bcd7ae29 8 Serial CamPixy(p28,p27);
qj604184 0:98d2bcd7ae29 9
qj604184 0:98d2bcd7ae29 10 DigitalOut trig1(p11);//US1
qj604184 0:98d2bcd7ae29 11 InterruptIn echo1(p12);
qj604184 0:98d2bcd7ae29 12 DigitalOut trig2(p8);//US2
qj604184 0:98d2bcd7ae29 13 InterruptIn echo2(p24);
qj604184 0:98d2bcd7ae29 14 DigitalOut trig3(p26);//US3
qj604184 0:98d2bcd7ae29 15 InterruptIn echo3(p23);
qj604184 0:98d2bcd7ae29 16
qj604184 0:98d2bcd7ae29 17 I2C monI2C(p9,p10);
qj604184 0:98d2bcd7ae29 18 PwmOut Servo(p21);
qj604184 0:98d2bcd7ae29 19
qj604184 0:98d2bcd7ae29 20 AnalogIn SD_1(p19); // capteur de distance courte droite
qj604184 0:98d2bcd7ae29 21 AnalogIn SD_2(p20); // capteur de distance courte gauche
qj604184 0:98d2bcd7ae29 22 AnalogIn LD_1(p17); // capteur de distance longue droite
qj604184 0:98d2bcd7ae29 23 AnalogIn LD_2(p18); // capteur de distance longue gauche
qj604184 0:98d2bcd7ae29 24
qj604184 0:98d2bcd7ae29 25 InterruptIn I_D(p30);
qj604184 0:98d2bcd7ae29 26 InterruptIn I_G(p29);
qj604184 0:98d2bcd7ae29 27
qj604184 0:98d2bcd7ae29 28 SPI spi(p5,p6,p7);
qj604184 0:98d2bcd7ae29 29
qj604184 0:98d2bcd7ae29 30 AnalogIn C1(p15);// capteur de ligne blanche 1
qj604184 0:98d2bcd7ae29 31 AnalogIn C3(p16);// capteur de ligne blanche 3
qj604184 0:98d2bcd7ae29 32 //-- le capteur de ligne 2 est sur un MCP3201(spi) dont le CS est sur p13
qj604184 0:98d2bcd7ae29 33 DigitalOut CS_C2(p13);
qj604184 0:98d2bcd7ae29 34
qj604184 0:98d2bcd7ae29 35
qj604184 0:98d2bcd7ae29 36 int captL1;
qj604184 0:98d2bcd7ae29 37 int captL3;