/* main.c */ /* {{{ * * Copyright (C) 2008 NĂ©lio Laranjeiro * * APBTeam: * Web: http://apbteam.org/ * Email: team AT apbteam DOT org * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. * * }}} */ #include "common.h" #include "../../fsm.h" #include "../../getsamples.h" #include void getsamples_print_test (fsm_t *getsamples) { printf ("STATE "); switch (getsamples->state_current) { case GETSAMPLES_STATE_START: printf ("START"); break; case GETSAMPLES_STATE_PREPARE_ARM: printf ("PREPEARE_ARM"); break; case GETSAMPLES_STATE_END: printf ("END"); break; case GETSAMPLES_STATE_FORWARD_CONTROL: printf ("FORWARD_CONTROL"); break; case GETSAMPLES_STATE_TAKE_SAMPLES: printf ("TAKE_SAMPLES"); break; case GETSAMPLES_STATE_BACKWARD: printf ("BACKWARD"); break; case GETSAMPLES_STATE_GO_TO_POSITION: printf ("GO_TO_POSITION"); break; case GETSAMPLES_STATE_NB: printf ("STATE_NB"); } printf ("\n"); } int main (void) { fsm_init (&getsamples_fsm); getsamples_print_test (&getsamples_fsm); getsamples_start (700, 2100, 3); /* Implicit: fsm_handle_event (&getsamples_fsm, GETSAMPLES_EVENT_ok); */ getsamples_print_test (&getsamples_fsm); fsm_handle_event (&getsamples_fsm, GETSAMPLES_EVENT_position_failed); getsamples_print_test (&getsamples_fsm); fsm_handle_event (&getsamples_fsm, GETSAMPLES_EVENT_position_reached); getsamples_print_test (&getsamples_fsm); fsm_handle_event (&getsamples_fsm, GETSAMPLES_EVENT_arm_moved); getsamples_print_test (&getsamples_fsm); fsm_handle_event (&getsamples_fsm, GETSAMPLES_EVENT_position_reached); getsamples_print_test (&getsamples_fsm); //TODO: samples should be decremented by the FSM transitions. for (getsamples_data.samples--; getsamples_data.samples; getsamples_data.samples--) { fsm_handle_event (&getsamples_fsm, GETSAMPLES_EVENT_sample_took); getsamples_print_test (&getsamples_fsm); } fsm_handle_event (&getsamples_fsm, GETSAMPLES_EVENT_sample_took); getsamples_print_test (&getsamples_fsm); fsm_handle_event (&getsamples_fsm, GETSAMPLES_EVENT_position_reached); getsamples_print_test (&getsamples_fsm); return 0; } void asserv_set_x_position (uint32_t position) { printf ("X position : %d\n", position); } void asserv_move_arm (uint16_t position, uint8_t speed) { printf ("Move arm, position : %d, speed : %d\n", position, speed); } void asserv_set_y_position (int32_t y) { printf ("Y position : %d\n", y); } void trap_open_rear_panel(void) { printf ("Open rear panel\n"); } void trap_close_rear_panel (void) { printf ("Close rear panel\n"); }