Corrected state controllability function in MIMO_Tools

Corrected the calculation of the input pole vectors