Revert "Corrected state controllability function"

This reverts commit 3d41aec796ae495aeceb94792d083c2c5a91a411.