#include "eyebot.h"
#define SCANSIZE 180
#define SAFE     100
#define PSD_FL     5
#define PSD_FR     6
#define PSD_FFL    7
#define PSD_FFR    8

int main ()
{ int F,L,R,FL,FR, FFL,FFR;

 LCDMenu("", "", "", "END");
  while (KEYRead()!=KEY4)
  { F  =PSDGet(PSD_FRONT);
    L  =PSDGet(PSD_LEFT); R  =PSDGet(PSD_RIGHT);
    FL =PSDGet(PSD_FL);   FR =PSDGet(PSD_FR);
    FFL=PSDGet(PSD_FFL);  FFR=PSDGet(PSD_FFR);
    LCDSetPrintf(0,0, "F%4d -- L%4d FL%4d FFL%4d -- R%4d FR%4d FFR%4d\n", F, L,FL,FFL, R,FR,FFR);
    OSWait(500); // 0.1 sec
  }
}
