// EyeBot Demo Program: Drive, T. Bräunl, Nov. 2015
#include "eyebot.h"

int main()
{ int x, y, phi;

  LCDMenu("","","","END");
  VWSetPosition(0,0,0);

  VWDrive(200,  50,  100); VWWait(); // deviate 50 from straight
  VWGetPosition(&x, &y, &phi);
  LCDPrintf("pos %d %d ori %d\n", x,y,phi);
  
  VWDrive(200,-200,  100); VWWait(); //  deviate back 200 
  VWGetPosition(&x, &y, &phi);
  LCDPrintf("pos %d %d ori %d\n", x,y,phi);
  
  VWDrive(200,   0,  100); VWWait(); //  deviate back 200 
  VWGetPosition(&x, &y, &phi);
  LCDPrintf("pos %d %d ori %d\n", x,y,phi);
  KEYWait(KEY4);
}
