Debugged controller for correct behaviour of termination including one
new state.
Modified testbench accordingly but commented most of the code for the
mean time.