Colony

#ifndef INTERNALS_H

#define INTERNALS_H

#define LS 0

#define LD 1

#define RS 2

#define RD 3

#define FORWARD 1

#define BACKWARD 0

#define SENDER 1

#define RECEIVER 0

#define INFINITE -1

#define L 10.0

#define DT .1

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

#define LOOK_AHEAD              1

#define LOOK_AHEAD_ERR_THRES    0.05

#define VELOCITY                1

typedef struct state

{

        double x;

        double y;

        double theta;

        short vl;

        short vr;

        int vl_ref;

        int vr_ref;

} state;

typedef struct {

    double *x;

    double *y;

} curv_t;

state robot;

void updatePosition();

void setAttriv(int file);

void pos_control_curv(curv_t *ref, int len);

void velocityControl(double*, double*);

#endif