--- np2/io/serial.c 2004/03/30 07:12:03 1.15 +++ np2/io/serial.c 2004/04/01 13:19:00 1.20 @@ -1,4 +1,5 @@ #include "compiler.h" +#include "cpucore.h" #include "commng.h" #include "pccore.h" #include "iocore.h" @@ -7,45 +8,46 @@ // ---- Keyboard -static void keyboard_int(BOOL absolute) { - - if ((keybrd.ctrls) || (keybrd.buffers)) { - if (!(keybrd.status & 2)) { - keybrd.status |= 2; - if (keybrd.ctrls) { - keybrd.ctrls--; - keybrd.data = keybrd.ctr[keybrd.ctrpos]; - keybrd.ctrpos = (keybrd.ctrpos + 1) & KB_CTRMASK; - } - else if (keybrd.buffers) { - keybrd.buffers--; - keybrd.data = keybrd.buf[keybrd.bufpos]; - keybrd.bufpos = (keybrd.bufpos + 1) & KB_BUFMASK; - } - } - pic_setirq(1); - nevent_set(NEVENT_KEYBOARD, keybrd.xferclock, - keyboard_callback, absolute); - } -} - void keyboard_callback(NEVENTITEM item) { if (item->flag & NEVENT_SETEVENT) { - keyboard_int(NEVENT_RELATIVE); + if ((keybrd.ctrls) || (keybrd.buffers)) { + if (!(keybrd.status & 2)) { + keybrd.status |= 2; + if (keybrd.ctrls) { + keybrd.ctrls--; + keybrd.data = keybrd.ctr[keybrd.ctrpos]; + keybrd.ctrpos = (keybrd.ctrpos + 1) & KB_CTRMASK; + } + else if (keybrd.buffers) { + keybrd.buffers--; + keybrd.data = keybrd.buf[keybrd.bufpos]; + keybrd.bufpos = (keybrd.bufpos + 1) & KB_BUFMASK; + } + TRACEOUT(("recv -> %02x", keybrd.data)); + } + pic_setirq(1); + nevent_set(NEVENT_KEYBOARD, keybrd.xferclock, + keyboard_callback, NEVENT_RELATIVE); + } } } static void IOOUTCALL keyboard_o41(UINT port, REG8 dat) { if (keybrd.cmd & 1) { - keystat_ctrl(dat); + TRACEOUT(("send -> %02x", dat)); + keystat_ctrlsend(dat); + } + else { + keybrd.mode = dat; } (void)port; } static void IOOUTCALL keyboard_o43(UINT port, REG8 dat) { + TRACEOUT(("out43 -> %02x %.4x:%.8x", dat, CPU_CS, CPU_EIP)); if ((!(dat & 0x08)) && (keybrd.cmd & 0x08)) { keyboard_resetsignal(); } @@ -60,13 +62,16 @@ static REG8 IOINPCALL keyboard_i41(UINT (void)port; keybrd.status &= ~2; + pic_resetirq(1); + TRACEOUT(("in41 -> %02x %.4x:%.8x", keybrd.data, CPU_CS, CPU_EIP)); return(keybrd.data); } static REG8 IOINPCALL keyboard_i43(UINT port) { (void)port; - return(keybrd.status); + TRACEOUT(("in43 -> %02x %.4x:%.8x", keybrd.status, CPU_CS, CPU_EIP)); + return(keybrd.status | 0x85); } @@ -83,10 +88,12 @@ void keyboard_reset(void) { ZeroMemory(&keybrd, sizeof(keybrd)); keybrd.data = 0xff; + keybrd.mode = 0x5e; } void keyboard_bind(void) { + keystat_ctrlreset(); keybrd.xferclock = pccore.realclock / 1920; iocore_attachsysoutex(0x0041, 0x0cf1, keybrdo41, 2); iocore_attachsysinpex(0x0041, 0x0cf1, keybrdi41, 2); @@ -94,10 +101,12 @@ void keyboard_bind(void) { void keyboard_resetsignal(void) { + nevent_reset(NEVENT_KEYBOARD); keybrd.cmd = 0; keybrd.status = 0; + keybrd.ctrls = 0; keybrd.buffers = 0; - keybrd.bufpos = 0; + keystat_ctrlreset(); keystat_resendstat(); } @@ -110,7 +119,8 @@ void keyboard_ctrl(REG8 data) { keybrd.ctr[(keybrd.ctrpos + keybrd.ctrls) & KB_CTRMASK] = data; keybrd.ctrls++; if (!nevent_iswork(NEVENT_KEYBOARD)) { - keyboard_int(NEVENT_ABSOLUTE); + nevent_set(NEVENT_KEYBOARD, keybrd.xferclock, + keyboard_callback, NEVENT_ABSOLUTE); } } } @@ -121,7 +131,8 @@ void keyboard_send(REG8 data) { keybrd.buf[(keybrd.bufpos + keybrd.buffers) & KB_BUFMASK] = data; keybrd.buffers++; if (!nevent_iswork(NEVENT_KEYBOARD)) { - keyboard_int(NEVENT_ABSOLUTE); + nevent_set(NEVENT_KEYBOARD, keybrd.xferclock, + keyboard_callback, NEVENT_ABSOLUTE); } } else {