This repository is used for sharing all the PathTracking method.

1. Casadi
2. NumPy
3. Matplotlib
4. BeizerPath

1. We use PID for point to point by tracking all error between set point and the state feedback from the system.
2. We also use PID for trajectory tracking by also tracking all the error between each point from the trajectory and the state feedback system.

$$output = k_{p}e(t) + k_{i}\int_{t_{1}}^{t_{2}}e(t)dt + k_{d}\frac{d e(t)}{dt}$$

Which $k_{p}, k_{i}, k_{d}$ is the proportional, integral, derivative gain respectively. Tracking error at each sampling time $$e(t) = target - feedback$$

1. Point to Point

We use nonlinear optimization to solve the quadratic cost from sum of tracking error between trajectory tracking and input control.

which

We use Continuation/Generalized Minimal Residual method for calculate optimal input