This is an implementation of an Iterative Linear Quadratic Regulator (iLQR) to generate trajectories for a quadrotor model. This model is interesting as the configuration space of the quadrotor is
For more details on the applicable lie theory see this handy reference: A micro Lie theory for state estimation is robotics. For more information on iLQR see Tassa et al..
src/quadrotor_ilqr.py creates a quadrotor model, a desired trajectory, runs the optimizer via it's python binding, and plots the optimized trajectory. You can run the quadrotor trajectory planner via the command bazel run //src:quadrotor_ilqr -- --show_plots
. This should produce the following animation: