The wallfollowing works in general, but the parameters need tweaking.
Find out if following a single wall or following both walls performs better. One of them should be removed.
Test how fast the car can go (tweak maximum speed)
Tweak parameters, including PID values, angles, distances
Think about improvements to the algorithm
Improve the LIDAR sampling strategy. Currently, for each angle only one LIDAR point is considered. Instead, we could read multiple points and use the minimum or average.
The wallfollowing works in general, but the parameters need tweaking.