Added a very very simple test case for the HFSM. Everything seems to check out so-far.
Also added wrapper actions/conditions for debugging purposes.