Colony

// smart_run_around_fsm.h

// required to run Smart Run Around functions

// declare functions and global variables

#ifndef _RUN_AROUND_FSM_H_

#define _RUN_AROUND_FSM_H_

// states (robot shall never move in reverse)

// these constants may be changed (but can't overlap) without effect

#define FORWARD 0   // drive straight forward

#define LEFT 1        // drive forward and to the left

#define RIGHT 2        // drive forward and to the right

#define SPIN 3        // turn without traveling (last resort if otherwise stuck)

/* conditions on rangefinders (in cm) informing state changes

 * naming format: SENSOR_URGENCY

 * changing these constants affects robot operation

 */

#define IR2_DANGER 5        // dangerously close to front

#define IR13_DANGER 10  // dangerously close to sides (looking ahead)

#define IR2_INTEREST 15        // notably close to front

#define IR45_DANGER 5        // dangerously close to sides (looking sideways)

uint8_t state;        // current state of FSM: FORWARD, LEFT, RIGHT, SPIN

int16_t d1, d2, d3, d4, d5; // values returned by rangefinders

// initialize rangefinders and global variables

void run_around_init(void);

/* evaluate rangefinder input and update state

 * call this function as often as possible to avoid collisions

 */

void run_around_FSM(void);

// behave according to current state

void evaluate_state(void);

#endif