Add height values for FESTO 1
Fix (too small) token goes into wrong state
Fix switch not closing after exit safe state