Using Control Toolbox and some utility functions

As discussed in my email...