#include "XbeeTools.h"

task main()
{
  InitRS485();

  string messageToSend;
  int time = 2500;

  StringFormat(messageToSend, "Fwd%d", time);
  SendString(messageToSend);
  wait1Msec(time + 200);

  messageToSend = "TurnR";
  SendString(messageToSend);
  wait1Msec(500);

  time = 1000;
  StringFormat(messageToSend, "Fwd%d", time);
  SendString(messageToSend);
}