Renamed LQR functions.
Added some functions for analysing controllability