#include "XbeeTools.h"

//Robot B code (Robot B is the receiving robot)

task main()
{
  InitRS485(); //Initialize the Xbee Radio

  string messageReceived; //Create a string to fill with message
  ReceiveString(messageReceived); //Wait to receive message

  if (StringFind(messageReceived, "Fwd") >= 0)
  {
    motor[motorB] = 100;
    motor[motorC] = 100;
    wait1Msec(2000);
  }
  else if (StringFind(messageReceived, "TurnL") >= 0)
  {
    motor[motorB] = 50;
    motor[motorC] = -50;
    wait1Msec(250);
  }
  else if (StringFind(messageReceived, "TurnR") >= 0)
  {
    motor[motorB] = -50;
    motor[motorC] = 50;
    wait1Msec(250);
  }
}