Capteur_US

Dependencies:   mbed DRV8825

Committer:
Nanaud
Date:
Wed Jul 08 19:51:28 2020 +0000
Revision:
0:dc036b67c87c
Child:
1:2fe8c402ee79
Code principal du projet

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Nanaud 0:dc036b67c87c 1 #include "pins.h"
Nanaud 0:dc036b67c87c 2
Nanaud 0:dc036b67c87c 3 void AresUltrasonsInit(){tps.start();}
Nanaud 0:dc036b67c87c 4
Nanaud 0:dc036b67c87c 5 void AresUltrasons(){
Nanaud 0:dc036b67c87c 6 tps.reset();
Nanaud 0:dc036b67c87c 7 trigger=1;
Nanaud 0:dc036b67c87c 8 wait(0.00002);
Nanaud 0:dc036b67c87c 9 trigger=0;
Nanaud 0:dc036b67c87c 10 }
Nanaud 0:dc036b67c87c 11
Nanaud 0:dc036b67c87c 12 void echoRise1(){us_out[0]=tps.read_us();}
Nanaud 0:dc036b67c87c 13 void echoFall1(){us_out[0]=(tps.read_us()-us_out[0])/2;}
Nanaud 0:dc036b67c87c 14
Nanaud 0:dc036b67c87c 15 void echoRise2(){us_out[1]=tps.read_us();}
Nanaud 0:dc036b67c87c 16 void echoFall2(){us_out[1]=(tps.read_us()-us_out[1])/2;}
Nanaud 0:dc036b67c87c 17
Nanaud 0:dc036b67c87c 18 void echoRise3(){us_out[2]=tps.read_us();}
Nanaud 0:dc036b67c87c 19 void echoFall3(){us_out[2]=(tps.read_us()-us_out[2])/2;}
Nanaud 0:dc036b67c87c 20
Nanaud 0:dc036b67c87c 21 void echoRise4(){us_out[3]=tps.read_us();}
Nanaud 0:dc036b67c87c 22 void echoFall4(){us_out[3]=(tps.read_us()-us_out[3])/2;}
Nanaud 0:dc036b67c87c 23
Nanaud 0:dc036b67c87c 24 void echoRise5(){us_out[4]=tps.read_us();}
Nanaud 0:dc036b67c87c 25 void echoFall5(){us_out[4]=(tps.read_us()-us_out[4])/2;}
Nanaud 0:dc036b67c87c 26
Nanaud 0:dc036b67c87c 27 void echoRise6(){us_out[5]=tps.read_us();}
Nanaud 0:dc036b67c87c 28 void echoFall6(){us_out[5]=(tps.read_us()-us_out[5])/2;}