2020-10-26 06:58:00 +11:00
|
|
|
#include "ps2_kbd.h"
|
2020-10-25 02:18:48 +11:00
|
|
|
|
|
|
|
|
void kbd_init(Kbd *kbd, Tristate *TH)
|
|
|
|
|
{
|
|
|
|
|
kbd->kc = 0;
|
|
|
|
|
kbd->breaking = false;
|
|
|
|
|
kbd->TH = TH;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void kbd_pressshift(Kbd *kbd, bool ispressed)
|
|
|
|
|
{
|
|
|
|
|
kbd->kc = 0x12; // shift keycode
|
|
|
|
|
kbd->breaking = !ispressed;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void kbd_presskey(Kbd *kbd, uint8_t key)
|
|
|
|
|
{
|
|
|
|
|
kbd->kc = 0;
|
|
|
|
|
switch (key) {
|
|
|
|
|
case '\t': kbd->kc = 0xd; break;
|
|
|
|
|
case '`': kbd->kc = 0xe; break;
|
|
|
|
|
case 'q': kbd->kc = 0x15; break;
|
|
|
|
|
case '1': kbd->kc = 0x16; break;
|
|
|
|
|
case 'z': kbd->kc = 0x1a; break;
|
|
|
|
|
case 's': kbd->kc = 0x1b; break;
|
|
|
|
|
case 'a': kbd->kc = 0x1c; break;
|
|
|
|
|
case 'w': kbd->kc = 0x1d; break;
|
|
|
|
|
case '2': kbd->kc = 0x1e; break;
|
|
|
|
|
case 'c': kbd->kc = 0x21; break;
|
|
|
|
|
case 'x': kbd->kc = 0x22; break;
|
|
|
|
|
case 'd': kbd->kc = 0x23; break;
|
|
|
|
|
case 'e': kbd->kc = 0x24; break;
|
|
|
|
|
case '4': kbd->kc = 0x25; break;
|
|
|
|
|
case '3': kbd->kc = 0x26; break;
|
|
|
|
|
case ' ': kbd->kc = 0x29; break;
|
|
|
|
|
case 'v': kbd->kc = 0x2a; break;
|
|
|
|
|
case 'f': kbd->kc = 0x2b; break;
|
|
|
|
|
case 't': kbd->kc = 0x2c; break;
|
|
|
|
|
case 'r': kbd->kc = 0x2d; break;
|
|
|
|
|
case '5': kbd->kc = 0x2e; break;
|
|
|
|
|
case 'n': kbd->kc = 0x31; break;
|
|
|
|
|
case 'b': kbd->kc = 0x32; break;
|
|
|
|
|
case 'h': kbd->kc = 0x33; break;
|
|
|
|
|
case 'g': kbd->kc = 0x34; break;
|
|
|
|
|
case 'y': kbd->kc = 0x35; break;
|
|
|
|
|
case '6': kbd->kc = 0x36; break;
|
|
|
|
|
case 'm': kbd->kc = 0x3a; break;
|
|
|
|
|
case 'j': kbd->kc = 0x3b; break;
|
|
|
|
|
case 'u': kbd->kc = 0x3c; break;
|
|
|
|
|
case '7': kbd->kc = 0x3d; break;
|
|
|
|
|
case '8': kbd->kc = 0x3e; break;
|
|
|
|
|
case ',': kbd->kc = 0x41; break;
|
|
|
|
|
case 'k': kbd->kc = 0x42; break;
|
|
|
|
|
case 'i': kbd->kc = 0x43; break;
|
|
|
|
|
case 'o': kbd->kc = 0x44; break;
|
|
|
|
|
case '0': kbd->kc = 0x45; break;
|
|
|
|
|
case '9': kbd->kc = 0x46; break;
|
|
|
|
|
case '.': kbd->kc = 0x49; break;
|
|
|
|
|
case '/': kbd->kc = 0x4a; break;
|
|
|
|
|
case 'l': kbd->kc = 0x4b; break;
|
|
|
|
|
case ';': kbd->kc = 0x4c; break;
|
|
|
|
|
case 'p': kbd->kc = 0x4d; break;
|
|
|
|
|
case '-': kbd->kc = 0x4e; break;
|
|
|
|
|
case '\'': kbd->kc = 0x52; break;
|
|
|
|
|
case '[': kbd->kc = 0x54; break;
|
|
|
|
|
case '=': kbd->kc = 0x55; break;
|
|
|
|
|
case '\r': kbd->kc = 0x5a; break;
|
|
|
|
|
case ']': kbd->kc = 0x5b; break;
|
|
|
|
|
case '\\': kbd->kc = 0x5d; break;
|
|
|
|
|
case '\b': kbd->kc = 0x66; break;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
uint8_t kbd_rd(Kbd *kbd)
|
|
|
|
|
{
|
|
|
|
|
// There are 3 modes for reading the kbd:
|
|
|
|
|
// 1. TH = highz: we're polling the the existence of a KC
|
|
|
|
|
// 2. TH = low: return low nibble
|
|
|
|
|
// 3. TH = high: return high nibble and reset KC
|
|
|
|
|
uint8_t res = 0;
|
|
|
|
|
uint8_t tosend = kbd->kc;
|
|
|
|
|
if (kbd->breaking) {
|
|
|
|
|
tosend = 0xf0;
|
|
|
|
|
}
|
|
|
|
|
if (*kbd->TH == TRI_HIGHZ) { // polling
|
|
|
|
|
if (!kbd->kc) {
|
|
|
|
|
res = 0x10; // indicate KC absence;
|
|
|
|
|
}
|
|
|
|
|
} else if (*kbd->TH == TRI_LOW) { // TH selected
|
|
|
|
|
res = tosend & 0xf;
|
|
|
|
|
} else {
|
|
|
|
|
res = tosend >> 4;
|
|
|
|
|
if (kbd->breaking) {
|
|
|
|
|
kbd->breaking = false;
|
|
|
|
|
} else {
|
|
|
|
|
kbd->kc = 0;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
return res;
|
|
|
|
|
}
|
|
|
|
|
|
