void xprintf(const char * format, ...)
{
va_list ap;
va_start(ap, format);
int size = vsnprintf(nullptr, 0, format, ap) + 1;
if (size > 0) {
va_end(ap);
va_start(ap, format);
char buf[size + 1];
vsnprintf(buf, size, format, ap);
Serial.write(buf);
}
va_end(ap);
}
void printHelp()
{
xprintf("\e[93m\n\nPS/2 Keyboard Studio\r\n");
xprintf("Chip Revision: %d Chip Frequency: %d MHz\r\n", ESP.getChipRevision(), ESP.getCpuFreqMHz());
printInfo();
xprintf("Commands:\r\n");
xprintf(" 1 = US Layout 2 = UK Layout 3 = DE Layout\r\n");
xprintf(" 4 = IT Layout 5 = ES Layout\r\n");
xprintf(" r = Reset s = Scancode Mode a = VirtualKey/ASCII Mode\r\n");
xprintf(" l = Test LEDs\r\n");
xprintf("Various:\r\n");
xprintf(" h = Print This help\r\n\n");
xprintf("Use Serial Monitor to issue commands\r\n\n");
}
void printInfo()
{
auto keyboard = PS2Controller.
keyboard();
if (keyboard->isKeyboardAvailable()) {
xprintf("Device Id = ");
switch (keyboard->identify()) {
case PS2DeviceType::OldATKeyboard:
xprintf("\"Old AT Keyboard\"");
break;
case PS2DeviceType::MouseStandard:
xprintf("\"Standard Mouse\"");
break;
case PS2DeviceType::MouseWithScrollWheel:
xprintf("\"Mouse with scroll wheel\"");
break;
case PS2DeviceType::Mouse5Buttons:
xprintf("\"5 Buttons Mouse\"");
break;
case PS2DeviceType::MF2KeyboardWithTranslation:
xprintf("\"MF2 Keyboard with translation\"");
break;
case PS2DeviceType::M2Keyboard:
xprintf("\"MF2 keyboard\"");
break;
default:
xprintf("\"Unknown\"");
break;
}
xprintf(" Keyboard Layout: \"%s\"\r\n", keyboard->getLayout()->name);
} else
xprintf("Keyboard Error!\r\n");
}
void setup()
{
Serial.begin(115200);
delay(500);
Serial.write("\r\n\nReset\r\n");
DisplayController.
begin();
Terminal.
begin(&DisplayController);
PS2Controller.
begin(PS2Preset::KeyboardPort0);
printHelp();
}
void loop()
{
auto keyboard = PS2Controller.
keyboard();
static char mode = 'a';
if (Serial.available() > 0) {
char c = Serial.read();
switch (c) {
case 'h':
printHelp();
break;
case '1':
keyboard->setLayout(&fabgl::USLayout);
printInfo();
break;
case '2':
keyboard->setLayout(&fabgl::UKLayout);
printInfo();
break;
case '3':
keyboard->setLayout(&fabgl::GermanLayout);
printInfo();
break;
case '4':
keyboard->setLayout(&fabgl::ItalianLayout);
printInfo();
break;
case '5':
keyboard->setLayout(&fabgl::SpanishLayout);
printInfo();
break;
case 'r':
keyboard->reset();
printInfo();
break;
case 's':
mode = 's';
keyboard->suspendVirtualKeyGeneration(true);
xprintf("Scancode mode\r\n");
break;
case 'a':
mode = 'a';
keyboard->suspendVirtualKeyGeneration(false);
xprintf("VirtualKey/ASCII mode\r\n");
break;
case 'l':
{
for (int i = 0; i < 8; ++i) {
keyboard->setLEDs(i & 1, i & 2, i & 4);
delay(1000);
}
delay(2000);
if (keyboard->setLEDs(0, 0, 0))
xprintf("OK\r\n");
break;
}
}
}
if (mode == 's' && keyboard->scancodeAvailable()) {
xprintf("Scancode = 0x%02X\r\n", keyboard->getNextScancode());
} else if (keyboard->virtualKeyAvailable()) {
bool down;
auto vk = keyboard->getNextVirtualKey(&down);
xprintf("VirtualKey = %s", keyboard->virtualKeyToString(vk));
int c = keyboard->virtualKeyToASCII(vk);
if (c > -1) {
xprintf("\tASCII = 0x%02X\t", c);
if (c >= ' ')
xprintf("%c", c);
}
if (!down)
xprintf("\tUP");
xprintf("\r\n");
}
}