private static void SelectedCommand(Command cmd)
{
switch (cmd)
{
case Command.Forward:
ExploreCommander.GoForward();
break;
case Command.Backward:
ExploreCommander.GoBackward();
break;
}
}
public void Follow()
{
if (Dist < 400)
{
if (Consts.LastCommand != Command.Backward)
{
ExploreCommander.GoBackward();
Consts.LastCommand = Command.Backward;
}
Thread.Sleep(200);
}
if (Mathematics.IsEqual(slope, Mathematics.Degree(OwnRobots.CurrentRobot), 4))
{
if (Consts.LastCommand != Command.Stop)
{
ExploreCommander.Stop();
//ExploreCommander.GoForward();
Consts.LastCommand = Command.Stop;
}
}
if (!Mathematics.IsEqual(slope, Mathematics.Degree(OwnRobots.CurrentRobot), 4))
{
ExploreCommander.Turn(slope, Command.Stop);
}
if (Dist < 600 && !Mathematics.IsEqual(slope, Mathematics.Degree(OwnRobots.CurrentRobot), 4))
{
ExploreCommander.Turn(slope, Command.Stop);
}
//else if (Mathematics.IsEqual(slope, Mathematics.Degree(OwnRobots.CurrentRobot), 4) && Dist < 700)
//{
// if (Consts.LastCommand != Command.Stop)
// {
// ExploreCommander.Stop();
// Consts.LastCommand = Command.Stop;
// Console.WriteLine("deg==curr && dist<700");
// }
//}
}