public void FindSoution()
{
var plateauFinished = false;
while (!plateauFinished)
{
var lastLocation = PreviousCoordinates.LastOrDefault();
var previousLocation = PreviousCoordinates[PreviousCoordinates.Count - 2];
var glassInLocation =
Plateau.Glasses.FirstOrDefault(g => g.Coordinate.X == lastLocation.X && g.Coordinate.Y == lastLocation.Y);
glassInLocation.GlassState = GlassStateEnum.Removed;
var previousOrientation = PreviousOrientations[PreviousOrientations.Count - 2];
Coordinate.X = previousLocation.X;
Coordinate.Y = previousLocation.Y;
Orientation = previousOrientation;
IsInsidePlateau = true;
while (IsInsidePlateau)
{
Move();
}
plateauFinished = Plateau.Glasses.Count(x => x.GlassState != GlassStateEnum.Full) == 0;
}
}
internal void Move()
{
var currentCoordinate = new Coordinate(Coordinate.X, Coordinate.Y);
PreviousCoordinates.Add(currentCoordinate);
PreviousOrientations.Add(Orientation);
//get the plateau and the glasses inside
var plateau = Plateau;
var glasses = plateau.Glasses;
var glassInCoordinate = glasses.FirstOrDefault(x => x.Coordinate.X == Coordinate.X && x.Coordinate.Y == Coordinate.Y);
//if there is not any glass in the specified coordinate or if the glass is half full, turn left
//if glass is empty turn right
//if glass is full the robot does not need to turn
switch (glassInCoordinate.GlassState)
{
case GlassStateEnum.Empty:
glassInCoordinate.Fill();
TurnClockwise();
break;
case GlassStateEnum.HalfFull:
glassInCoordinate.Fill();
TurnCounterClockwise();
break;
case GlassStateEnum.Full:
break;
case GlassStateEnum.Removed:
TurnCounterClockwise();
break;
default:
throw new ArgumentOutOfRangeException();
}
switch (Orientation)
{
case OrientationEnum.North:
Coordinate.Y--;
break;
case OrientationEnum.West:
Coordinate.X++;
break;
case OrientationEnum.South:
Coordinate.Y++;
break;
case OrientationEnum.East:
Coordinate.X--;
break;
default:
throw new ArgumentOutOfRangeException();
}
if (Coordinate.X > Plateau.Coordinate.X || Coordinate.Y > Plateau.Coordinate.Y || Coordinate.X < 0 || Coordinate.Y < 0)
{
IsInsidePlateau = false;
}
}
