Corrected state controllability function

Corrected the calculation of the input pole vectors