The segments should have guards instead of a too early timer
I think this implementation makes more sense. This will be
only implemented on FSM 1 for testing purpose. (Not fully implemented yet)
Implement guard for FSM 2 (untested)