ok

Dependencies:   mbed

Fork of _test_suivi_mur by christophe vermaelen

Committer:
pirottealex
Date:
Fri Jun 23 11:19:58 2017 +0000
Revision:
7:2f4660e9cf92
Parent:
3:b91371837109
pixy_ok2;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
vermaelen 2:82b72fa8dbcd 1 #include "mbed.h"
pirottealex 7:2f4660e9cf92 2 #include "Pixy.h"
pirottealex 7:2f4660e9cf92 3 #include "PixyLink.h"
vermaelen 2:82b72fa8dbcd 4 BusOut leds(LED1,LED2,LED3,LED4);
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);
pirottealex 7:2f4660e9cf92 11 PwmOut MD(p24); //vitesse moteur gauche
pirottealex 7:2f4660e9cf92 12 PwmOut MG(p21); //vitesse moteur droit
pirottealex 7:2f4660e9cf92 13 DigitalOut sensMG(p26); // sens moteur gauche
pirottealex 7:2f4660e9cf92 14 DigitalOut sensMD(p23); // sens moteur droit
pirottealex 7:2f4660e9cf92 15 Timer temp,t,t2,tr,tb,to;
vermaelen 2:82b72fa8dbcd 16 Ticker tic1,tic2;
pirottealex 7:2f4660e9cf92 17 DigitalIn jack(p25);
pirottealex 7:2f4660e9cf92 18 DigitalIn capb1 (p29), capb2 (p30);
pirottealex 7:2f4660e9cf92 19 PwmOut servo(p22);
vermaelen 2:82b72fa8dbcd 20
pirottealex 7:2f4660e9cf92 21
pirottealex 7:2f4660e9cf92 22 uint16_t blocks;
pirottealex 7:2f4660e9cf92 23 int j=0,capg,capd ;
pirottealex 7:2f4660e9cf92 24 int errorX = 0, errorY = 0,start_memo_pixy;
pirottealex 7:2f4660e9cf92 25 float capt_m,capt_d,capt_g,capt_ed,capt_eg;
vermaelen 2:82b72fa8dbcd 26 int drap=1,flag1=0,flag2=0,flag3=0,flag4=0,flag5=0;
vermaelen 2:82b72fa8dbcd 27 float US1,US2,US3,AN1,AN2,US1_av=50,US2_av=50,US3_av=50,AN1_av=50,AN2_av=50;
vermaelen 3:b91371837109 28 float E_av,E,iE=0,E0=0,E1=0,E2=0,E3=0;
pirottealex 7:2f4660e9cf92 29 int etat=0,jck,start_cap_pixy=0;
pirottealex 7:2f4660e9cf92 30 float corg,cord,taille,cmdD,cmdG,erreur_cap;
pirottealex 7:2f4660e9cf92 31 float cap_lum,cap,tot_capt,pixy_cap,turn=0.0;
vermaelen 2:82b72fa8dbcd 32