From d51d7ef789a776741cb4712646c47c7f37b005c2 Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Thu, 13 May 2010 14:02:55 +0200 Subject: digital/io/src: count elements to unload --- digital/io/src/ai_loader_cb.c | 3 +++ 1 file changed, 3 insertions(+) (limited to 'digital/io/src/ai_loader_cb.c') diff --git a/digital/io/src/ai_loader_cb.c b/digital/io/src/ai_loader_cb.c index 2960cdd9..f486bbc6 100644 --- a/digital/io/src/ai_loader_cb.c +++ b/digital/io/src/ai_loader_cb.c @@ -30,6 +30,7 @@ #include "bot.h" #include "main.h" #include "food.h" +#include "loader.h" /* * LOADER_IDLE =start=> @@ -351,6 +352,7 @@ ai__LOADER_ERROR_UPING_OPEN__clamp_succeed (void) * LOADER_LOAD_CLOSING =clamp_succeed=> * full => LOADER_LOAD_UPING * move up + * count one element * empty => LOADER_LOAD_EMPTY_OPEN * open clamp */ @@ -368,6 +370,7 @@ ai__LOADER_LOAD_CLOSING__clamp_succeed (void) position_t robot_position; asserv_get_position (&robot_position); food_taken (robot_position); + loader_elements++; return ai_next_branch (LOADER_LOAD_CLOSING, clamp_succeed, full); } else -- cgit v1.2.3