I’m learning how to write an lcd auton chooser for PROS. I’ve been running into problems though like how to actually test it and not actually knowing what my problem is. My code makes sense (I think it makes sense, but that is making it harder to find the possible mistake), however, when I try to test it (by connecting a joystick and using the competition switch to switch between auton, driver, and pre auton) I only get the default screen where it says: “but 0 0 0”. I think I’m not doing my pre auton correctly because in pros pre auton isn’t a thing, there is only initialize(). You can see how I tried to do pre auton in the code below (warning, the spacing is all jacked up, but should be readable):
#include "main.h"
void initializeIO() {
pinMode(ledOne, OUTPUT);
pinMode(ledTwo, OUTPUT);
pinMode(ledThree, OUTPUT);
pinMode(ledFour, OUTPUT);
pinMode(ledFive, OUTPUT);
pinMode(ledSix, OUTPUT);
pinMode(ledSeven, OUTPUT);
pinMode(ledEight, OUTPUT);
}
void initialize() {
while(!isEnabled() && !isAutonomous()) {
int count = 0;
int minCount = 0;
int maxCount = 7;
lcdInit(uart1);
lcdClear(uart1);
lcdSetBacklight(uart1, true);
while(lcdReadButtons(uart1) != centerButtonPressed) {
switch(count) {
case 0:
lcdSetText(uart1, 1, "ledOneBlinking");
lcdSetText(uart1, 2, "< Enter >");
waitForPress();
if(lcdReadButtons(uart1) == leftButtonPressed)
{
waitForRelease();
count = maxCount;
}
else if(lcdReadButtons(uart1) == rightButtonPressed)
{
waitForRelease();
count++;
}
break;
case 1:
lcdSetText(uart1, 1, "ledTwoBlinking");
lcdSetText(uart1, 2, "< Enter >");
waitForPress();
if(lcdReadButtons(uart1) == leftButtonPressed)
{
waitForRelease();
count--;
}
else if(lcdReadButtons(uart1) == rightButtonPressed)
{
waitForRelease();
count++;
}
break;
case 2:
lcdSetText(uart1, 1, "ledThreeBlinking");
lcdSetText(uart1, 2, "< Enter >");
waitForPress();
if(lcdReadButtons(uart1) == leftButtonPressed)
{
waitForRelease();
count--;
}
else if(lcdReadButtons(uart1) == rightButtonPressed)
{
waitForRelease();
count++;
}
break;
case 3:
lcdSetText(uart1, 1, "ledFourBlinking");
lcdSetText(uart1, 2, "< Enter >");
waitForPress();
if(lcdReadButtons(uart1) == leftButtonPressed)
{
waitForRelease();
count--;
}
else if(lcdReadButtons(uart1) == rightButtonPressed)
{
waitForRelease();
count++;
}
break;
case 4:
lcdSetText(uart1, 1, "ledFiveBlinking");
lcdSetText(uart1, 2, "< Enter >");
waitForPress();
if(lcdReadButtons(uart1) == leftButtonPressed)
{
waitForRelease();
count--;
}
else if(lcdReadButtons(uart1) == rightButtonPressed)
{
waitForRelease();
count++;
}
break;
case 5:
lcdSetText(uart1, 1, "ledSixBlinking");
lcdSetText(uart1, 2, "< Enter >");
waitForPress();
if(lcdReadButtons(uart1) == leftButtonPressed)
{
waitForRelease();
count--;
}
else if(lcdReadButtons(uart1) == rightButtonPressed)
{
waitForRelease();
count++;
}
break;
case 6:
lcdSetText(uart1, 1, "ledSevenBlinking");
lcdSetText(uart1, 2, "< Enter >");
waitForPress();
if(lcdReadButtons(uart1) == leftButtonPressed)
{
waitForRelease();
count--;
}
else if(lcdReadButtons(uart1) == rightButtonPressed)
{
waitForRelease();
count++;
}
break;
case 7:
lcdSetText(uart1, 1, "ledEightBlinking");
lcdSetText(uart1, 2, "< Enter >");
waitForPress();
if(lcdReadButtons(uart1) == leftButtonPressed)
{
waitForRelease();
count--;
}
else if(lcdReadButtons(uart1) == rightButtonPressed)
{
waitForRelease();
count = minCount;
}
break;
default:
count = 0;
break;
}
}
}
}