An implementation of the papers in the docs folder.

Basically this: https://studywolf.wordpress.com/2016/02/03/the-iterative-linear-quadratic-regulator-method/ augmented to handle obstacles / forbidden regions and actuator constraints.