code petit robot pour homologation
Fork of CRAC-Strat_2017_HOMOLOGATION_PETIT_ROBOT by
Diff: peripheriques/capteurs.cpp
- Revision:
- 18:cc5fec34ed9c
- Parent:
- 16:7321fb3bb396
--- a/peripheriques/capteurs.cpp Fri May 19 17:14:07 2017 +0000 +++ b/peripheriques/capteurs.cpp Mon May 22 15:01:49 2017 +0000 @@ -27,8 +27,9 @@ return couleurOK; } -short dataTelemetre(void){ - return telemetre.read_u16(); +unsigned short dataTelemetre(void){ + float distance = telemetre.read()*3.3*1159.6-687.5+98; + return (unsigned short)distance; } bool dataPressionGauche(void){