ROBOTIC COMPETITION PARIS 2017

Dependencies:   CMPS03 mbed

Fork of _test_suivi_mur by christophe vermaelen

Committer:
syasya
Date:
Wed May 31 12:17:59 2017 +0000
Revision:
7:64bfecbb3000
Parent:
3:b91371837109
Child:
10:1a69a6f659bd
with bearing;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
vermaelen 2:82b72fa8dbcd 1 #include "mbed.h"
syasya 7:64bfecbb3000 2 #include "CMPS03.h"
vermaelen 2:82b72fa8dbcd 3 BusOut leds(LED1,LED2,LED3,LED4);
syasya 7:64bfecbb3000 4 CMPS03 boussole(p9,p10,CMPS03_DEFAULT_I2C_ADDRESS);
vermaelen 2:82b72fa8dbcd 5 DigitalOut trigger1(p14);
vermaelen 2:82b72fa8dbcd 6 DigitalOut trigger2(p16);
vermaelen 2:82b72fa8dbcd 7 DigitalOut trigger3(p18);
vermaelen 2:82b72fa8dbcd 8 InterruptIn echo(p11);
vermaelen 2:82b72fa8dbcd 9 AnalogIn AnaG(p17);
vermaelen 2:82b72fa8dbcd 10 AnalogIn AnaAV(p15);
vermaelen 2:82b72fa8dbcd 11 PwmOut MD(p21); //vitesse moteur gauche
vermaelen 2:82b72fa8dbcd 12 PwmOut MG(p24); //vitesse moteur droit
vermaelen 2:82b72fa8dbcd 13 DigitalOut sensMG(p23); // sens moteur gauche
vermaelen 2:82b72fa8dbcd 14 DigitalOut sensMD(p26); // sens moteur droit
syasya 7:64bfecbb3000 15 Timer temp,t,t2,t3;
vermaelen 2:82b72fa8dbcd 16 Ticker tic1,tic2;
vermaelen 2:82b72fa8dbcd 17
vermaelen 2:82b72fa8dbcd 18 int drap=1,flag1=0,flag2=0,flag3=0,flag4=0,flag5=0;
vermaelen 2:82b72fa8dbcd 19 float US1,US2,US3,AN1,AN2,US1_av=50,US2_av=50,US3_av=50,AN1_av=50,AN2_av=50;
syasya 7:64bfecbb3000 20 float E_av,E,iE=0,E0=0,E1=0;
vermaelen 2:82b72fa8dbcd 21 float cmdG=0,cmdD=0;
vermaelen 2:82b72fa8dbcd 22 int etat=0;
vermaelen 2:82b72fa8dbcd 23 float iecart=0,ecart_av,ecart;
syasya 7:64bfecbb3000 24 float bearing,bearing_set;
vermaelen 2:82b72fa8dbcd 25