autopep8
Streamline controlability matrix calculation
Streamlined calcs, not sure about results
Fixed syntax error