Did some testing with ARE solver, will add a controllable mode reduction to a "safe" LQR solver.