Automatic Parallel Parking: Path Planning, Path Tracking & Control
This repository contains a python implementation of an automatic parallel parking system in a virtual environment that includes path planning, path tracking, and parallel parking. The agent navigates its route through the environment and is directed to the assigned park location by the MPC controller. You can find the article on Towards Data Science.
Envroinment
The first step to develop an auto park system is to design and develop an environment capable of giving visual render using OpenCV library. The environment is implemented in environment.py as a class and receives obstacles at the beginning env = Environment(obs). The agent can be placed using env.render(x,y,angle). A sample of the environment is displayed below. You can choose the parking spot from 1 to 24.
Path Planning
A* Algorithm
The agent will find a path from start to its goal using A*. This implementation of A* from PythonRobotics considers parameters like obstacles and robot radius.
Interpolating Path With B-spline
After finding a path in a discrete 100*100 space, the path is smoothed and scaled to 1000*1000 space of environment using b-spline. The result is a set of points to guide our agent!
Path Tracking
The kinematic model of the car is:
x' = v . cos(ψ)
y' = v . sin(ψ)
v' = a
ψ' = v . tan(δ)/L
a: acceleration, δ: steering angle, ψ: yaw angle, L: wheelbase, x: x-position, y: y-position, v: velocity
The state vector is:
z=[x,y,v,ψ]
x: x-position, y: y-position, v: velocity, ψ: yaw angle
The input vector is:
u=[a,δ]
a: acceleration, δ: steering angle
Control
The MPC controller controls vehicle speed and steering based on the model and the car is directed through the path. There is an option for using the linearized model for MPC. In this case MPC linearizes the kinematic model around the operating point and then does the optimization.
Parallel Parking
This part consists of 4 rules that the agent must choose according to parking position. At first, the agent will find a path to park position then it will compute the arriving angle. Based on the arriving angle, the agent chooses a coordinate as ensure1. After that, the parking path is planned from ensure1 to ensure2 using 2 circle equations as mentioned below. MPC controls the agent and car parks in ensure2 coordinate.
Inference
Run the code using this command:
$ python main_autopark.py --x_start 0 --y_start 90 --psi_start 0 --parking 7
About Us
We as Team Pandas won 1st place in the National Rahneshan competition 2020-2021 for autonomous vehicles. This contest has been one of the most competitive and challenging contests in the Rahneshan tournaments with more than 15 teams competing from top universities in Iran.
Contact
Feel free to contact us via email or connect with us on linkedin.
1 Nov 1, 2021
1 Nov 8, 2021
3 Jul 9, 2022
106 Dec 19, 2022
6 Aug 22, 2021
3 Aug 8, 2021
3 Sep 29, 2022
1 Dec 5, 2021
2 Jan 12, 2022
19 Oct 20, 2022
2 Jan 08, 2022
1.7k Dec 30, 2022
28 Oct 31, 2022
21 Jun 14, 2021
77 Nov 04, 2022
353 Jan 04, 2023
1.2k Dec 28, 2022
2 Jan 18, 2022
7 Dec 24, 2022
2 Jan 10, 2022
1 Jan 02, 2022
1 Jan 20, 2022
12 Jan 03, 2023
1 Nov 19, 2021
2 Jan 09, 2022
136 Dec 23, 2022
2 Dec 09, 2021
43 Nov 23, 2022
407 Nov 17, 2022