I forgot you were using the Watson code rather than the IFI default code.
In Teleop, if you're changing the OI LEDs, then be sure to comment out the line
To use a counter to time things just:
- Declare an unsigned int counter=0;
- Add a line to increase it by 1 every loop, e.g., counter++;
- Check to see if's a multiple of 38 (for one second or equal to 38 & reset it to zero).
- If it is a multiple then toggle the light state, e.g., Switch1_LED = !Switch1_LED;