#include "XbeeTools.h"

task main()
{
  InitRS485();

  string messageReceived;
  int time = 0;

  ReceiveString(messageReceived);

  if (StringFind(messageReceived, "Fwd") >= 0)
  {
    StringDelete(messageReceived, 0, 3);
    time = atoi(messageReceived);
    motor[motorB] = 50;
    motor[motorC] = 50;
    wait1Msec(time);
  }

  ReceiveString(messageReceived);

  if (StringFind(messageReceived, "TurnR") >= 0)
  {
    motor[motorB] = -30;
    motor[motorC] = 30;
    wait1Msec(200);
  }

  ReceiveString(messageReceived);

  if (StringFind(messageReceived, "Fwd") >= 0)
  {
    StringDelete(messageReceived, 0, 3);
    time = atoi(messageReceived);
    motor[motorB] = 50;
    motor[motorC] = 50;
    wait1Msec(time);
  }
}