Commented out all files not currently part of the project (threads and bluetooth).
Optimised pathing performance - smaller circRadius tested with higher speed/ increased car size to mimic real vehicle.
Current speed set to 4, highest speed tested at 20 (still working fine in simulation).