The goal of this project is to track the generated trajectory from the path planning module using model predictive control algorithm to steer and accelerate the vehicle on a simulator track. CppAD and Ipopt packages are used to solve the model predictive control problem.
Sample Output screenshot of the simulator.
Vehicle model used in the project is kinematic bicycle model. The equations for the model are shown below.
The state [x,y,psi,v,cte,epsi]
consist of x-y position, heading angle, cross track error, and error in heading direction respectively. Actuator [delta, a]
are steering angle and throttle values with constraints [-25,25] degrees and [-1,1] respectively.
N
time step Length and dt
time step duration allows to predict till t = Ndt
sec ahead with N
points. In this project N = 10
and dt = 0.1
were optimal enough for prediction with less computations when compared to N = 25
and dt = 0.05
which had twice the computations for the same time t
.
Before polynomial fitting the trajectory waypoints needed to be converted to the vehicles co-ordinate system(refer main.cpp line 120). Velocity is converted to meter/s from miles/h to make sure the units of co-ordinate system match. Third degree polynomial is used to fit transformed waypoints.
To include the latency effect, the next state of the vehicle for the period of latency is predicted with the current actuator values and used to solve the model predictive control problem (refer main.cpp line 137).
-
cmake >= 3.5
-
All OSes: click here for installation instructions
-
make >= 4.1(mac, linux), 3.81(Windows)
- Linux: make is installed by default on most Linux distros
- Mac: install Xcode command line tools to get make
- Windows: Click here for installation instructions
-
gcc/g++ >= 5.4
- Linux: gcc / g++ is installed by default on most Linux distros
- Mac: same deal as make - [install Xcode command line tools]((https://developer.apple.com/xcode/features/)
- Windows: recommend using MinGW
-
- Run either
install-mac.sh
orinstall-ubuntu.sh
. - If you install from source, checkout to commit
e94b6e1
, i.e.Some function signatures have changed in v0.14.x. See this PR for more details.git clone https://github.com/uWebSockets/uWebSockets cd uWebSockets git checkout e94b6e1
- Run either
-
Ipopt and CppAD: Please refer to this document for installation instructions.
-
Eigen. This is already part of the repo so you shouldn't have to worry about it.
-
Simulator. You can download these from the releases tab.
-
Not a dependency but read the DATA.md for a description of the data sent back from the simulator.
- Clone this repo.
- Make a build directory:
mkdir build && cd build
- Compile:
cmake .. && make
- Run it:
./mpc
.
- It's recommended to test the MPC on basic examples to see if your implementation behaves as desired. One possible example is the vehicle starting offset of a straight line (reference). If the MPC implementation is correct, after some number of timesteps (not too many) it should find and track the reference line.
- The
lake_track_waypoints.csv
file has the waypoints of the lake track. You could use this to fit polynomials and points and see of how well your model tracks curve. NOTE: This file might be not completely in sync with the simulator so your solution should NOT depend on it. - For visualization this C++ matplotlib wrapper could be helpful.)
- Tips for setting up your environment are available here
- VM Latency: Some students have reported differences in behavior using VM's ostensibly a result of latency. Please let us know if issues arise as a result of a VM environment.
Please (do your best to) stick to Google's C++ style guide.