Path planning

[KhaledBasiony]

You have to plot a path for parallel parking and represent as a mathematical function .
It would be preferred to represent other paths such as perpendicular parking .

[KhaledBasiony]

general interface with the motion planning part is done with the implementation for a simple two circles Parallel Backwards parking algorithm

[KhaledBasiony]

TODO:

• calculate parameter values based on current location and environment.
• implement more algorithms for PeB and PeF