Video of pathfinding loop

Code I'm using:

(pedEnteringVehicle bool is redundant atm, was experimenting with it)

Methods class:

Not been able to figure out why the Ped is getting stuck in this infinite pathfinding loop. Maybe something I'm just glossing over? Any help would be greatly appreciated.

EDIT: Thought I'd also add the PedVehicleChecks method which is being called regularly.

EDIT 2: Upon posting this just figured, if its calling the PedEnterVehicle method whenever the Ped stops entering the vehicle, it's going to choose a new random seat causing the Ped to be confused. Will try this fix and remove this topic if this is the case.

SOLUTION: My second edit has corrected the issue! However I'll leave this up in the event someone else runs into this same issue.

@JohnFromGWN The ped has a SET_FLAG_VALUE that can modify their size. However entities don't seem to have anything of the sort!

How would I go about changing a props/entities size by accessing its size in the memory/bytes or by using the matrix function or using quaternions.

I want to take a prop/entity from the map, and edit its size.

Setting a waypoint too far away, or getting SafestCoordForPed will always set the waypoint in the same place no matter how far away or close you wanted the waypoint to be.

SafestCoordForPed:

World.GetNextPositionOnStreet(Game.Player.Character.Position.Around(realDistance));
Vector3 finalCoords = World.GetSafeCoordForPed(safeCoords);
myPed = World.CreateRandomPed(finalCoords);

Real distance being a random number generator of 350 to 650.

Waypoint:

 int distance = rnd.Next(7500, 14000); //maybe too far for the games limits?

 Vector3 spawn = 
 World.GetNextPositionOnSidewalk(Game.Player.Character.Position.Around(distance));
 locationBlip = World.CreateBlip(spawn);

Probably an obvious solution I'm missing, any help would be greatly appreciated.