summaryrefslogtreecommitdiffhomepage
path: root/digital/io/src/filterbridge_cb.c
diff options
context:
space:
mode:
Diffstat (limited to 'digital/io/src/filterbridge_cb.c')
-rw-r--r--digital/io/src/filterbridge_cb.c5
1 files changed, 4 insertions, 1 deletions
diff --git a/digital/io/src/filterbridge_cb.c b/digital/io/src/filterbridge_cb.c
index 9393a702..a94260a1 100644
--- a/digital/io/src/filterbridge_cb.c
+++ b/digital/io/src/filterbridge_cb.c
@@ -29,6 +29,8 @@
#include "servo_pos.h"
#include "aquajim.h"
#include "filterbridge.h"
+#include "top.h"
+#include "cylinder.h"
/*
* IDLE =start=>
@@ -128,7 +130,8 @@ fsm_branch_t
filterbridge__TEMPO_ELVETATOR_COMMUNICATION__state_timeout (void)
{
++elvt_nb_puck;
- --fb_nb_puck;
+ if(fb_nb_puck) --fb_nb_puck;
+ top_puck_inside_bot = cylinder_nb_puck + fb_nb_puck + elvt_nb_puck;
elvt_new_puck = 1;
servo_pos_move_to(SERVO_FINGER_ID, SERVO_FINGER_IDLE);
servo_pos_move_to(SERVO_DOOR_ID, SERVO_DOOR_CLOSE);