Modified HFSM to bring it up to latest code update.
Still needs some work, though. The update meant that a lot
of code will have to be redone.

Will probably work on it over the weekend.
Merge branch 'master' of https://github.com/mrunderhill89/CMPS146-Assignment1