Done for the night

Need to change planning algo for square to go right to left.

ConsoleApp/PathPlanners/IPathPlanner.cs

@@ -0,0 +1,12 @@
+using System.Collections.Generic;
+using ConsoleApp.Maps;
+
+namespace ConsoleApp.PathPlanners
+{
+    public interface IPathPlanner
+    {
+        Queue<ICell> GenerateOptimalSquarePath(SquareMap map, IVehicle vehicle);
+        Queue<ICell> GenerateOptimalHexPath(HexMap hexMap, IVehicle vehicle);
+    }
+    
+}

ConsoleApp/PathPlanners/PathPlanner.cs

@@ -0,0 +1,61 @@
+using System;
+using System.Collections.Generic;
+using ConsoleApp.Maps;
+
+namespace ConsoleApp.PathPlanners
+{
+    public class PathPlanner : IPathPlanner
+    {
+        public Queue<ICell> GenerateOptimalSquarePath(SquareMap map, IVehicle vehicle)
+        {
+            var path = new Queue<ICell>();
+            var myCell = map.StartingCell;
+            var finished = false;
+            var width_cm = (double)(vehicle.DetectorWidth) * 100;
+            var swathOffset = (int)Math.Floor((decimal) (width_cm) / 25) + 1;
+            var currentHeading = GlobalDirection.North;
+            while (!finished)
+            {
+                var availableMoves = map.PossibleMoves(myCell);
+                if (availableMoves.Contains(GlobalDirection.North) && currentHeading == GlobalDirection.North &&
+                    myCell.Y != map.Height)
+                {
+                    path.Enqueue(map[myCell.X, myCell.Y + 1]);
+                    myCell = map[myCell.X, myCell.Y + 1];
+                }
+                else if (availableMoves.Contains(GlobalDirection.South) && currentHeading == GlobalDirection.South && myCell.Y != 0)
+                {
+                    path.Enqueue(map[myCell.X, myCell.Y - 1]);
+                    myCell = map[myCell.X, myCell.Y - 1];
+                }
+                else
+                {
+                    if (myCell.X + swathOffset >= map.Width)
+                    {
+                        finished = true;
+                    }
+                    else
+                    {
+                        for (int i = myCell.X; i < myCell.X + swathOffset; i++)
+                        {
+                            path.Enqueue(map[i, myCell.Y]);
+                        }
+                        myCell = map[myCell.X+swathOffset, myCell.Y];
+                        if (currentHeading == GlobalDirection.North)
+                            currentHeading = GlobalDirection.South;
+                        else if (currentHeading == GlobalDirection.South)
+                            currentHeading = GlobalDirection.North;
+                    }
+                }
+
+            }
+
+            return path;
+        }
+
+        public Queue<ICell> GenerateOptimalHexPath(HexMap hexMap, IVehicle vehicle)
+        {
+            throw new NotImplementedException();
+        }
+    }
+}