summaryrefslogtreecommitdiff
path: root/n/es/src/main.c
diff options
context:
space:
mode:
Diffstat (limited to 'n/es/src/main.c')
-rw-r--r--n/es/src/main.c21
1 files changed, 15 insertions, 6 deletions
diff --git a/n/es/src/main.c b/n/es/src/main.c
index 10bd497..15eecb7 100644
--- a/n/es/src/main.c
+++ b/n/es/src/main.c
@@ -60,6 +60,7 @@ uint8_t ascenseur;
uint8_t ventouse;
// capteur de front
uint8_t capteurf = 0;
+uint8_t capteurf_cpt_cpt = 255;
uint8_t capteurf_cpt = 0;
uint8_t pont;
@@ -91,7 +92,6 @@ int main (void)
uint8_t temp_sens = 1;
uint8_t compteur = 0;
uint16_t tableau_sharp[3];
- uint8_t cpt;
uint8_t renvoie_tourelle;
/// intialisation
@@ -287,12 +287,19 @@ int main (void)
if (capteurf)
{
- for(cpt=0;cpt<capteurf_cpt;cpt++)
+ // if cpt = 255 don't send anything
+ if (capteurf_cpt_cpt != 255)
{
- read_capteurf();
- proto_send2w('C',capteurf_gauche,capteurf_droit);
+ // else give mesure
+ capteurf_cpt_cpt--;
+ if (capteurf_cpt_cpt == 0)
+ {
+ read_capteurf();
+ proto_send3w
+ ('C',capteurf_gauche,capteurf_droit,capteurf_bas);
+ capteurf_cpt_cpt = capteurf_cpt;
+ }
}
-
}
@@ -364,7 +371,9 @@ void proto_callback (uint8_t cmd, uint8_t size,uint8_t* args)
case c ('C',1): { // parametre le nombre de
// mesure à faire dans une
// boucle
- capteurf_cpt = args[0];
+ // 255 diseable this
+ // capteur
+ capteurf_cpt_cpt = capteurf_cpt = args[0];
}break;
/* generic */
case c ('F',1): {