Parking AI confused in large parking lots

TLM/Benchmarks/LoopUtilPerfTests.cs

@@ -7,7 +7,7 @@ public class LoopUtilPerfTests {
         [Benchmark]
         public void GenerateSpiralGridCoordsClockwise_Once_Radius17() {
             var radius = 17;
-            var coords = LoopUtil.GenerateSpiralGridCoordsClockwise().Take(radius * radius);
+            var coords = LoopUtil.GenerateSpiralGridCoordsCounterclockwise().Take(radius * radius);
             foreach (var coord in coords) {
             }
         }
@@ -16,7 +16,7 @@ public void GenerateSpiralGridCoordsClockwise_Once_Radius17() {
         public void GenerateSpiralGridCoordsClockwise_10Times_Radius17() {
             var radius = 17;
             for (int i = 0; i < 10; i++) {
-                var coords = LoopUtil.GenerateSpiralGridCoordsClockwise().Take(radius * radius);
+                var coords = LoopUtil.GenerateSpiralGridCoordsCounterclockwise().Take(radius * radius);
                 foreach (var coord in coords) {
                 }
             }

TLM/Benchmarks/SpiralPerfTests.cs

@@ -9,7 +9,7 @@ public class SpiralPerfTests {
         public void SpiralGetCoords_Once_Radius17() {
             var radius = 17;
             var spiral = new Spiral(radius);
-            var coords = spiral.GetCoords(radius);
+            var coords = spiral.GetCoordsCounterclockwise(radius);
             for (int i = 0; i < coords.Count; i++) {
                 var coord = coords[i];
             }
@@ -20,7 +20,7 @@ public void SpiralGetCoords_10Times_Radius17() {
             var radius = 17;
             var spiral = new Spiral(radius);
             for (int i = 0; i < 10; i++) {
-                var coords = spiral.GetCoords(radius);
+                var coords = spiral.GetCoordsCounterclockwise(radius);
                 for (int j = 0; j < coords.Count; j++) {
                     var coord = coords[j];
                 }
@@ -30,7 +30,7 @@ public void SpiralGetCoords_10Times_Radius17() {
         [Benchmark]
         public void SpiralGetCoords_Once_Radius17_Precached() {
             var radius = 17;
-            var coords = _cachedSpiral17.GetCoords(radius);
+            var coords = _cachedSpiral17.GetCoordsCounterclockwise(radius);
             for (int i = 0; i < coords.Count; i++) {
                 var coord = coords[i];
             }
@@ -40,7 +40,7 @@ public void SpiralGetCoords_Once_Radius17_Precached() {
         public void SpiralGetCoords_10Times_Radius17_Precached() {
             var radius = 17;
             for (int i = 0; i < 10; i++) {
-                var coords = _cachedSpiral17.GetCoords(radius);
+                var coords = _cachedSpiral17.GetCoordsCounterclockwise(radius);
                 for (int j = 0; j < coords.Count; j++) {
                     var coord = coords[j];
                 }

TLM/TLM/Manager/Impl/AdvancedParkingManager.cs

@@ -22,6 +22,7 @@ public class AdvancedParkingManager
           IAdvancedParkingManager
     {
         private readonly Spiral _spiral;
+        private Randomizer _randomizer;
 
         public static readonly AdvancedParkingManager Instance
             = new AdvancedParkingManager(SingletonLite<Spiral>.instance);
@@ -32,6 +33,7 @@ public static readonly AdvancedParkingManager Instance
 
         public AdvancedParkingManager(Spiral spiral) {
             _spiral = spiral ?? throw new ArgumentNullException(nameof(spiral));
+            _randomizer = new Randomizer();
 
             _findParkingSpaceDelegate = GameConnectionManager.Instance.PassengerCarAIConnection.FindParkingSpace;
             _findParkingSpacePropDelegate = GameConnectionManager.Instance.PassengerCarAIConnection.FindParkingSpaceProp;
@@ -1930,7 +1932,7 @@ public bool FindParkingSpaceForCitizen(Vector3 endPos,
                     // found a building with parking space
                     if (Constants.ManagerFactory.ExtPathManager.FindPathPositionWithSpiralLoop(
                         parkPos,
-                        endPos,
+                        knownParkingSpaceLocationId.ToBuilding().m_position,
                         ItemClass.Service.Road,
                         NetInfo.LaneType.Pedestrian,
                         VehicleInfo.VehicleType.None,
@@ -1946,10 +1948,10 @@ public bool FindParkingSpaceForCitizen(Vector3 endPos,
                     if (logParkingAi) {
                         Log._Debug(
                             $"Navigating citizen instance {extDriverInstance.instanceId} to parking " +
-                            $"building {knownParkingSpaceLocationId}! segment={endPathPos.m_segment}, " +
+                            $"building {knownParkingSpaceLocationId}, parkPos={parkPos}! segment={endPathPos.m_segment}, " +
                             $"laneIndex={endPathPos.m_lane}, offset={endPathPos.m_offset}. " +
                             $"CurrentPathMode={extDriverInstance.pathMode} " +
-                            $"calculateEndPos={calculateEndPos}");
+                            $"calculateEndPos={calculateEndPos}, endPos={endPos}");
                     }
 
                     return true;
@@ -2382,14 +2384,10 @@ bool LoopHandler(int i, int j) {
 
                     // randomize target position to allow for opposite road-side parking
                     ParkingAI parkingAiConf = GlobalConfig.Instance.ParkingAI;
-                    segCenter.x +=
-                        Singleton<SimulationManager>.instance.m_randomizer.Int32(
-                            parkingAiConf.ParkingSpacePositionRand) -
+                    segCenter.x += rng.Int32(parkingAiConf.ParkingSpacePositionRand) -
                         (parkingAiConf.ParkingSpacePositionRand / 2u);
 
-                    segCenter.z +=
-                        Singleton<SimulationManager>.instance.m_randomizer.Int32(
-                            parkingAiConf.ParkingSpacePositionRand) -
+                    segCenter.z += rng.Int32(parkingAiConf.ParkingSpacePositionRand) -
                         (parkingAiConf.ParkingSpacePositionRand / 2u);
 
                     if (netSegment.GetClosestLanePosition(
@@ -2458,7 +2456,7 @@ bool LoopHandler(int i, int j) {
                 return true;
             }
 
-            var coords = _spiral.GetCoords(radius);
+            var coords = _spiral.GetCoordsRandomDirection(radius, ref _randomizer);
             for (int i = 0; i < radius * radius; i++) {
                 if (!LoopHandler((int)(centerI + coords[i].x), (int)(centerJ + coords[i].y))) {
                     break;
@@ -2569,7 +2567,7 @@ bool LoopHandler(int i, int j) {
                 return true;
             }
 
-            var coords = _spiral.GetCoords(radius);
+            var coords = _spiral.GetCoordsRandomDirection(radius, ref _randomizer);
             for (int i = 0; i < radius * radius; i++) {
                 if (!LoopHandler((int)(centerI + coords[i].x), (int)(centerJ + coords[i].y))) {
                     break;

TLM/TLM/Manager/Impl/ExtPathManager.cs

@@ -1,7 +1,7 @@
 namespace TrafficManager.Manager.Impl {
-    using ColossalFramework;
     using System;
-    using System.Linq;
+    using ColossalFramework;
+    using ColossalFramework.Math;
     using State;
     using TrafficManager.API.Manager;
     using TrafficManager.Util;
@@ -13,12 +13,14 @@ public class ExtPathManager
           IExtPathManager
     {
         private readonly Spiral _spiral;
+        private Randomizer _randomizer;
 
         public static readonly ExtPathManager Instance =
             new ExtPathManager(SingletonLite<Spiral>.instance);
 
         private ExtPathManager(Spiral spiral) {
             _spiral = spiral ?? throw new ArgumentNullException(nameof(spiral));
+            _randomizer = new Randomizer();
         }
 
         /// <summary>
@@ -324,7 +326,7 @@ bool FindHelper(int i, int j) {
 
                 int spiralDist = Math.Max(Math.Abs(i - centerI), Math.Abs(j - centerJ)); // maximum norm
 
-                if (found && spiralDist > lastSpiralDist) {
+                if (found && lastSpiralDist > 0 && spiralDist > lastSpiralDist) {
                     // last iteration
                     return false;
                 }
@@ -379,8 +381,8 @@ bool FindHelper(int i, int j) {
                                 out float laneOffsetB))
                             {
                                 float dist = Vector3.SqrMagnitude(position - posA);
-                                if (secondaryPosition != null) {
-                                    dist += Vector3.SqrMagnitude((Vector3)secondaryPosition - posA);
+                                if (secondaryPosition.HasValue) {
+                                    dist += Vector3.SqrMagnitude(secondaryPosition.Value - posA);
                                 }
 
                                 if (dist < minDist) {
@@ -396,9 +398,9 @@ bool FindHelper(int i, int j) {
                                     myDistanceSqrA = dist;
 
                                     dist = Vector3.SqrMagnitude(position - posB);
-                                    if (secondaryPosition != null) {
+                                    if (secondaryPosition.HasValue) {
                                         dist += Vector3.SqrMagnitude(
-                                            (Vector3)secondaryPosition - posB);
+                                            secondaryPosition.Value - posB);
                                     }
 
                                     if (laneIndexB < 0) {
@@ -433,7 +435,7 @@ bool FindHelper(int i, int j) {
                 return true;
             }
 
-            var coords = _spiral.GetCoords(radius);
+            var coords = _spiral.GetCoordsRandomDirection(radius, ref _randomizer);
             for (int i = 0; i < radius * radius; i++) {
                 if (!FindHelper((int)(centerI + coords[i].x), (int)(centerJ + coords[i].y))) {
                     break;

TLM/TLM/Patch/_CitizenAI/_HumanAI/SimulationStepPatch.cs

@@ -270,7 +270,8 @@ ref data.m_citizen.ToCitizen(),
 
             data.m_flags &= ~(CitizenInstance.Flags.HangAround
                                       | CitizenInstance.Flags.Panicking
-                                      | CitizenInstance.Flags.SittingDown);
+                                      | CitizenInstance.Flags.SittingDown
+                                      | CitizenInstance.Flags.Cheering);
             ArriveAtDestination(__instance, instanceID, ref data, false);
             citizenManager.ReleaseCitizenInstance(instanceID);
 

TLM/TLM/Util/LoopUtil.cs

@@ -11,7 +11,7 @@ public static IEnumerable<Vector2> GenerateSpiralGridCoordsClockwise() {
             var cursorX = 0;
             var cursorY = 0;
 
-            var directionX = 1;
+            var directionX = -1;
             var directionY = 0;
 
             var segmentLength = 1;
@@ -30,6 +30,44 @@ public static IEnumerable<Vector2> GenerateSpiralGridCoordsClockwise() {
                 segmentsPassed = 0; //start of new segment
 
                 //rotate clockwise
+                var buffer = -directionX;
+                directionX = directionY;
+                directionY = buffer;
+
+                //increase segmentLength every second time
+                if (directionY == 0) {
+                    segmentLength++;
+                }
+            }
+        }
+
+        /// <summary>
+        /// Generates a stream of spiral grid coordinates counterclockwise.
+        /// </summary>
+        /// <returns>Stream of spiral grid coordinates until int.MaxValue + 1 elements were returned.</returns>
+        public static IEnumerable<Vector2> GenerateSpiralGridCoordsCounterclockwise() {
+            var cursorX = 0;
+            var cursorY = 0;
+
+            var directionX = 1;
+            var directionY = 0;
+
+            var segmentLength = 1;
+            var segmentsPassed = 0;
+
+            for (var n = 0; n <= int.MaxValue; n++) {
+                yield return new Vector2(cursorX, cursorY);
+
+                cursorX += directionX;
+                cursorY += directionY;
+
+                segmentsPassed++;
+                if (segmentsPassed != segmentLength) {
+                    continue; //if segment is not full yet
+                }
+                segmentsPassed = 0; //start of new segment
+
+                //rotate counterClockwise
                 var buffer = directionX;
                 directionX = -directionY;
                 directionY = buffer;

TLM/TLM/Util/Spiral.cs

@@ -4,6 +4,8 @@
 using UnityEngine;
 
 namespace TrafficManager.Util {
+    using ColossalFramework.Math;
+
     /// <summary>
     /// A spiral coords generator that will cache all previously generated values,
     /// and only generate new ones if necessary.
@@ -12,9 +14,12 @@ public class Spiral {
         private readonly string radiusOutOfRangeMessage = "Must be in the range [1,int.MaxValue]";
 
         private int _maxRadius;
-        private IEnumerator<Vector2> _enumerator;
-        private List<Vector2> _spiralCoords;
-        private ReadOnlyCollection<Vector2> _spiralCoordsReadOnly;
+        private IEnumerator<Vector2> _enumeratorClockwise;
+        private IEnumerator<Vector2> _enumeratorCounterClockwise;
+        private List<Vector2> _spiralCoordsClockwise;
+        private List<Vector2> _spiralCoordsCounterclockwise;
+        private ReadOnlyCollection<Vector2> _spiralCoordsClockwiseReadOnly;
+        private ReadOnlyCollection<Vector2> _spiralCoordsCounterclockwiseReadOnly;
 
         /// <summary>
         /// Initializes a new instance of the <see cref="Spiral"/> class.
@@ -38,10 +43,14 @@ public Spiral(int radius) {
             }
 
             _maxRadius = 0;
-            _enumerator = LoopUtil.GenerateSpiralGridCoordsClockwise()
+            _enumeratorClockwise = LoopUtil.GenerateSpiralGridCoordsClockwise()
+                .GetEnumerator();
+            _enumeratorCounterClockwise = LoopUtil.GenerateSpiralGridCoordsCounterclockwise()
                 .GetEnumerator();
-            _spiralCoords = new List<Vector2>(radius * radius);
-            _spiralCoordsReadOnly = new ReadOnlyCollection<Vector2>(_spiralCoords);
+            _spiralCoordsClockwise = new List<Vector2>(radius * radius);
+            _spiralCoordsCounterclockwise = new List<Vector2>(radius * radius);
+            _spiralCoordsClockwiseReadOnly = new ReadOnlyCollection<Vector2>(_spiralCoordsCounterclockwise);
+            _spiralCoordsCounterclockwiseReadOnly = new ReadOnlyCollection<Vector2>(_spiralCoordsCounterclockwise);
 
             Ensure(radius);
         }
@@ -52,7 +61,43 @@ public Spiral(int radius) {
         public int MaxRadius => _maxRadius;
 
         /// <summary>
-        /// Gets spiral coords and ensures that the given radius is satisfied.
+        /// Gets spiral in random direction and ensired that the giver radius is satisfied
+        /// </summary>
+        /// <param name="radius">Needed radius for the spiral coords.</param>
+        /// <param name="r">Randomizer instance to perform randomization</param>
+        /// <returns>
+        /// A readonly collection of spiral coords.
+        /// The result won't generate a new collection for performance reasons,
+        /// meaning it will return a reference to the same mutable underlying collection.
+        /// The returned collection will always contain the coords for 'MaxRadius',
+        /// the largest radius it was ever passed.
+        /// </returns>
+        public ReadOnlyCollection<Vector2> GetCoordsRandomDirection(int radius, ref Randomizer r) {
+            return r.Int32(2) == 0 ? GetCoordsCounterclockwise(radius) : GetCoordsClockwise(radius);
+        }
+
+        /// <summary>
+        /// Gets spiral coords clockwise and ensures that the given radius is satisfied.
+        /// </summary>
+        /// <param name="radius">Needed radius for the spiral coords.</param>
+        /// <returns>
+        /// A readonly collection of spiral coords.
+        /// The result won't generate a new collection for performance reasons,
+        /// meaning it will return a reference to the same mutable underlying collection.
+        /// The returned collection will always contain the coords for 'MaxRadius',
+        /// the largest radius it was ever passed.
+        /// </returns>
+        public ReadOnlyCollection<Vector2> GetCoordsClockwise(int radius) {
+            if (radius < 1) {
+                throw new ArgumentOutOfRangeException(nameof(radius), radiusOutOfRangeMessage);
+            }
+
+            Ensure(radius);
+            return _spiralCoordsClockwiseReadOnly;
+        }
+
+        /// <summary>
+        /// Gets spiral coords counterclockwise and ensures that the given radius is satisfied.
         /// </summary>
         /// <param name="radius">Needed radius for the spiral coords.</param>
         /// <returns>
@@ -62,13 +107,13 @@ public Spiral(int radius) {
         /// The returned collection will always contain the coords for 'MaxRadius',
         /// the largest radius it was ever passed.
         /// </returns>
-        public ReadOnlyCollection<Vector2> GetCoords(int radius) {
+        public ReadOnlyCollection<Vector2> GetCoordsCounterclockwise(int radius) {
             if (radius < 1) {
                 throw new ArgumentOutOfRangeException(nameof(radius), radiusOutOfRangeMessage);
             }
 
             Ensure(radius);
-            return _spiralCoordsReadOnly;
+            return _spiralCoordsCounterclockwiseReadOnly;
         }
 
         private void Ensure(int radius) {
@@ -77,11 +122,20 @@ private void Ensure(int radius) {
             }
 
             var enumerateCount = radius * radius;
-            _spiralCoords.Capacity = enumerateCount;
-            for (int i = _spiralCoords.Count; i < enumerateCount; i++) {
-                var hasNext = _enumerator.MoveNext();
+
+            _spiralCoordsClockwise.Capacity = enumerateCount;
+            for (int i = _spiralCoordsClockwise.Count; i < enumerateCount; i++) {
+                var hasNext = _enumeratorClockwise.MoveNext();
+                if (hasNext) {
+                    _spiralCoordsClockwise.Add(_enumeratorClockwise.Current);
+                }
+            }
+
+            _spiralCoordsCounterclockwise.Capacity = enumerateCount;
+            for (int i = _spiralCoordsCounterclockwise.Count; i < enumerateCount; i++) {
+                var hasNext = _enumeratorCounterClockwise.MoveNext();
                 if (hasNext) {
-                    _spiralCoords.Add(_enumerator.Current);
+                    _spiralCoordsCounterclockwise.Add(_enumeratorCounterClockwise.Current);
                 }
             }