Lots of changes. Removed the state space controller stuff and started something new.