put state machine initialization in robotInit()