CRAC Team / CRAC-Strat_2017_homologation_gros_rob

homologation gros robot

Fork of CRAC-Strat_2017_HOMOLOGATION_PETIT_ROBOT by CRAC Team

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){