public void Fire()
{
p1 = OwnRobots.CurrentRobot;
p2 = OppRobots.CurrentRobot;
slope = Mathematics.DegreeToOpp(OwnRobots.CurrentRobot, OppRobots.CurrentRobot);
double currentDeg = Mathematics.Degree(p1), dist = Mathematics.Distance(OwnRobots.CurrentRobot, OppRobots.CurrentRobot);
if (Mathematics.IsEqual(currentDeg, slope, 4))
{
FireCommander.Fire();
if (dist > 1000)
{
FireCommander.Shoot();
}
Thread.Sleep(100);
}
}
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");
// }
//}
}
