regulator med lqr, fungerar