LQR are only tested for squared (nx=nu) systems

The tests should be corrected to have NX and NU different.