void GetButton()
{
GotBtn = false;
// Select MUX board
for(MUXidx=0; MUXidx<2; MUXidx++)
{
// Set Ena address on Teensy pins
for(int i = 0; i<2; i++)
{
for(int j=0; j<2; j++)
{
digitalWrite(MUXEnaPin[j], HIGH);
}
digitalWrite(MUXEnaPin[MUXidx], bitRead(MUXidx,i));
}
delayMicroseconds(250);
for(BTNidx=0; BTNidx<16; BTNidx++)
{
// Set Mux address on Teensy pins
for(int k=0; k<4; k++)
{
digitalWrite(MUXPin[k], bitRead(BTNidx,k));
}
delayMicroseconds(250);
if(digitalRead(MUXIOPin) == LOW)
{
Serial.print("Button "); Serial.print(MUXidx); Serial.print(" "); Serial.println(BTNidx);
ResetScreenSaver();
GotBtn = true;
ButtonTime = millis();
ProcessButtons();
return;
}
}
}
}