PyAdvancedControl Python Codes for Advanced Control lqr_sample Linear-Quadratic Regulator sample code finite_horizon_optimal_control finite horizon optimal control sample code