Generating diagonal paths for a micromouse using a state machine