public void Discover() { currentDegToOpp = Mathematics.getSlope(p1, p2); double curr = Mathematics.Degree(OwnRobots.CurrentRobot); //double Blockdist = Mathematics.Distance(p1, Objects.Block); slope = Mathematics.DegreeToOpp(OwnRobots.CurrentRobot, OppRobots.CurrentRobot); ExploreCommander.GoForward(); // ExploreCommander.Turn(slope, Command.Forward); ExploreCommander.Turn(curr + 45, Command.Forward); Thread.Sleep(400); while (true) { Dist = Mathematics.Distance(OwnRobots.CurrentRobot, OppRobots.CurrentRobot); p1 = OwnRobots.CurrentRobot; p2 = OppRobots.CurrentRobot; slope = Mathematics.DegreeToOpp(OwnRobots.CurrentRobot, OppRobots.CurrentRobot); if (Consts.LastCommand != Command.Forward) { ExploreCommander.GoForward(); Consts.LastCommand = Command.Forward; } ExploreCommander.Turn(slope, Command.Forward); Follow(); } }
private static void SelectedCommand(Command cmd) { switch (cmd) { case Command.Forward: ExploreCommander.GoForward(); break; case Command.Backward: ExploreCommander.GoBackward(); break; } }