Control System Toolbox Functions

To be updated soon...