From 370fa5662360eaa582bed9d55e092b627aef8920 Mon Sep 17 00:00:00 2001 From: NĂ©lio Laranjeiro Date: Thu, 10 Apr 2008 13:51:28 +0200 Subject: Start to fill the FSMs. (not finished). --- digital/io/src/top_cb.c | 16 ++++++++++++++++ 1 file changed, 16 insertions(+) (limited to 'digital/io/src/top_cb.c') diff --git a/digital/io/src/top_cb.c b/digital/io/src/top_cb.c index 52a5129d..bf92b204 100644 --- a/digital/io/src/top_cb.c +++ b/digital/io/src/top_cb.c @@ -7,7 +7,9 @@ */ #include "common.h" #include "fsm.h" +#include "top.h" #include "top_cb.h" +#include "getsamples.h" /* * START =ok=> @@ -17,6 +19,20 @@ fsm_branch_t top__START__ok (void) { + // Call the get samples state machine. + + // Blue color. + if (top_data.team_color == BLUE_TEAM) + { + getsamples_start (BLUE_DISTRIBUTOR_X, BLUE_DISTRIBUTOR_Y, + top_data.sequence); + } + else + { + getsamples_start (RED_DISTRIBUTOR_X, RED_DISTRIBUTOR_Y, + top_data.sequence); + } + return top_next (START, ok); } -- cgit v1.2.3