[Feature] Point to point PID Autos (GompeiPlanner)

[ananthgomattam]

• Simple PID drive to point autonomous driving algorithm.
• A series of points are connected to form a complete auto “path”