Colony

#ifndef INTERNALS_H

#define INTERNALS_H

#define LEFT 1

#define RIGHT 0

#define SENDER 1

#define RECEIVER 0

#define INFINITE -1

#define L 13.5

//#define DT .102

#define DT .088

#define DIST(x1, y1, x2, y2)    (sqrt(((x1)-(x2))*((x1)-(x2)) + ((y1)-(y2))*((y1)-(y2))))

#define LOOK_AHEAD              30

#define LOOK_AHEAD_ERR_THRES    5

#define VELOCITY                15

typedef struct state

{

        double x;

        double y;

        double theta;

        double vl;

        double vr;

        double vl_ref;

        double vr_ref;

} state;

typedef struct {

    double *x;

    double *y;

} curv_t;

state robot;

void updatePosition();

void setAttriv(int file);

void pos_control_curve(curv_t *ref, int len);

void velocityControl(double*, double*);

#endif