#include <string.h>
#include "kd.h"
#include <mach/i386/vm_param.h>
#define at386_io_lock_state()
#define at386_io_lock(op) (TRUE)
#define at386_io_unlock()
typedef unsigned short i386_ioport_t;
extern unsigned char inb(
i386_ioport_t port);
extern void outb(
i386_ioport_t port,
unsigned char datum);
extern __inline__ unsigned char inb(
i386_ioport_t port)
{
unsigned char datum;
__asm__ volatile("inb %1, %0" : "=a" (datum) : "d" (port));
return(datum);
}
extern __inline__ void outb(
i386_ioport_t port,
unsigned char datum)
{
__asm__ volatile("outb %0, %1" : : "a" (datum), "d" (port));
}
extern void kd_sendcmd(unsigned char ch);
extern void kdreboot(void);
extern int kd_dogetc(int wait);
extern void kd_handle_ack(void);
extern void kd_resend(void);
extern int do_modifier(
int state,
Scancode c,
int up);
extern int kdcheckmagic(
Scancode sc,
int * regs);
extern int kdstate2idx(
int state,
int extended);
extern void kdinit(void);
extern void kd_belloff(void);
extern void kd_bellon(void);
extern void kd_senddata(unsigned char c);
extern unsigned char kd_getdata(void);
extern unsigned char kd_cmdreg_read(void);
extern void set_kd_state(
int newstate);
extern unsigned char state2leds(
int state);
extern void kd_setleds1(
unsigned char val);
extern void kd_setleds2(void);
extern void cnsetleds(
unsigned char val);
extern int kd_kbd_magic(
int scancode);
extern int cngetc(void);
extern int cnmaygetc(void);
extern void kdreboot(void);
extern int kd_dogetc(int wait);
extern int rebootflag;
int kbdkdbflag = 1;
int kbdmouseflag = 0;
int kd_state = KS_NORMAL;
int kb_mode = KB_ASCII;
int kd_kbd_mouse = 0;
int kd_kbd_magic_scale = 6;
int kd_kbd_magic_button = 0;
enum why_ack {NOT_WAITING, SET_LEDS, DATA_ACK};
enum why_ack kd_ack = NOT_WAITING;
unsigned char last_sent = 0;
unsigned char kd_nextled = 0;
int kd_initialized = FALSE;
int kd_extended = FALSE;
unsigned char key_map[NUMKEYS][WIDTH_KMAP] = {
{NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC},
{K_ESC,NC,NC, K_ESC,NC,NC, K_ESC,NC,NC, K_ESC,NC,NC, K_ESC,NC,NC},
{K_ONE,NC,NC, K_BANG,NC,NC, K_ONE,NC,NC, 0x1b,0x4e,0x31, 0x1b,0x4e,0x21},
{K_TWO,NC,NC, K_ATSN,NC,NC, K_NUL,NC,NC, 0x1b,0x4e,0x32, 0x1b,0x4e,0x40},
{K_THREE,NC,NC, K_POUND,NC,NC, K_THREE,NC,NC, 0x1b,0x4e,0x33, 0x1b,0x4e,0x23},
{K_FOUR,NC,NC, K_DOLLAR,NC,NC, K_FOUR,NC,NC, 0x1b,0x4e,0x34, 0x1b,0x4e,0x24},
{K_FIVE,NC,NC, K_PERC,NC,NC, K_FIVE,NC,NC, 0x1b,0x4e,0x35, 0x1b,0x4e,0x25},
{K_SIX,NC,NC, K_CARET,NC,NC, K_RS,NC,NC, 0x1b,0x4e,0x36, 0x1b,0x4e,0x5e},
{K_SEVEN,NC,NC, K_AMPER,NC,NC, K_SEVEN,NC,NC, 0x1b,0x4e,0x37, 0x1b,0x4e,0x26},
{K_EIGHT,NC,NC, K_ASTER,NC,NC, K_EIGHT,NC,NC, 0x1b,0x4e,0x38, 0x1b,0x4e,0x2a},
{K_NINE,NC,NC, K_LPAREN,NC,NC, K_NINE,NC,NC, 0x1b,0x4e,0x39,0x1b,0x4e,0x28},
{K_ZERO,NC,NC, K_RPAREN,NC,NC, K_ZERO,NC,NC, 0x1b,0x4e,0x30,0x1b,0x4e,0x29},
{K_MINUS,NC,NC, K_UNDSC,NC,NC, K_US,NC,NC, 0x1b,0x4e,0x2d, 0x1b,0x4e,0x5f},
{K_EQL,NC,NC, K_PLUS,NC,NC, K_EQL,NC,NC, 0x1b,0x4e,0x3d, 0x1b,0x4e,0x2b},
{K_BS,NC,NC, K_BS,NC,NC, K_BS,NC,NC, K_BS,NC,NC, K_BS,NC,NC},
{K_HT,NC,NC, K_GS,NC,NC, K_HT,NC,NC, K_HT,NC,NC, K_GS,NC,NC},
{K_q,NC,NC, K_Q,NC,NC, K_DC1,NC,NC, 0x1b,0x4e,0x71, 0x1b,0x4e,0x51},
{K_w,NC,NC, K_W,NC,NC, K_ETB,NC,NC, 0x1b,0x4e,0x77, 0x1b,0x4e,0x57},
{K_e,NC,NC, K_E,NC,NC, K_ENQ,NC,NC, 0x1b,0x4e,0x65, 0x1b,0x4e,0x45},
{K_r,NC,NC, K_R,NC,NC, K_DC2,NC,NC, 0x1b,0x4e,0x72, 0x1b,0x4e,0x52},
{K_t,NC,NC, K_T,NC,NC, K_DC4,NC,NC, 0x1b,0x4e,0x74, 0x1b,0x4e,0x54},
{K_y,NC,NC, K_Y,NC,NC, K_EM,NC,NC, 0x1b,0x4e,0x79, 0x1b,0x4e,0x59},
{K_u,NC,NC, K_U,NC,NC, K_NAK,NC,NC, 0x1b,0x4e,0x75, 0x1b,0x4e,0x55},
{K_i,NC,NC, K_I,NC,NC, K_HT,NC,NC, 0x1b,0x4e,0x69, 0x1b,0x4e,0x49},
{K_o,NC,NC, K_O,NC,NC, K_SI,NC,NC, 0x1b,0x4e,0x6f, 0x1b,0x4e,0x4f},
{K_p,NC,NC, K_P,NC,NC, K_DLE,NC,NC, 0x1b,0x4e,0x70, 0x1b,0x4e,0x50},
{K_LBRKT,NC,NC, K_LBRACE,NC,NC, K_ESC,NC,NC, 0x1b,0x4e,0x5b, 0x1b,0x4e,0x7b},
{K_RBRKT,NC,NC, K_RBRACE,NC,NC, K_GS,NC,NC, 0x1b,0x4e,0x5d, 0x1b,0x4e,0x7d},
{K_CR,NC,NC, K_CR,NC,NC, K_CR,NC,NC, K_CR,NC,NC, K_CR,NC,NC},
{K_SCAN,K_CTLSC,NC, K_SCAN,K_CTLSC,NC, K_SCAN,K_CTLSC,NC, K_SCAN,K_CTLSC,NC,
K_SCAN,K_CTLSC,NC},
{K_a,NC,NC, K_A,NC,NC, K_SOH,NC,NC, 0x1b,0x4e,0x61, 0x1b,0x4e,0x41},
{K_s,NC,NC, K_S,NC,NC, K_DC3,NC,NC, 0x1b,0x4e,0x73, 0x1b,0x4e,0x53},
{K_d,NC,NC, K_D,NC,NC, K_EOT,NC,NC, 0x1b,0x4e,0x65, 0x1b,0x4e,0x45},
{K_f,NC,NC, K_F,NC,NC, K_ACK,NC,NC, 0x1b,0x4e,0x66, 0x1b,0x4e,0x46},
{K_g,NC,NC, K_G,NC,NC, K_BEL,NC,NC, 0x1b,0x4e,0x67, 0x1b,0x4e,0x47},
{K_h,NC,NC, K_H,NC,NC, K_BS,NC,NC, 0x1b,0x4e,0x68, 0x1b,0x4e,0x48},
{K_j,NC,NC, K_J,NC,NC, K_LF,NC,NC, 0x1b,0x4e,0x6a, 0x1b,0x4e,0x4a},
{K_k,NC,NC, K_K,NC,NC, K_VT,NC,NC, 0x1b,0x4e,0x6b, 0x1b,0x4e,0x4b},
{K_l,NC,NC, K_L,NC,NC, K_FF,NC,NC, 0x1b,0x4e,0x6c, 0x1b,0x4e,0x4c},
{K_SEMI,NC,NC, K_COLON,NC,NC, K_SEMI,NC,NC, 0x1b,0x4e,0x3b, 0x1b,0x4e,0x3a},
{K_SQUOTE,NC,NC,K_DQUOTE,NC,NC,K_SQUOTE,NC,NC,0x1b,0x4e,0x27,0x1b,0x4e,0x22},
{K_GRAV,NC,NC, K_TILDE,NC,NC, K_RS,NC,NC, 0x1b,0x4e,0x60, 0x1b,0x4e,0x7e},
{K_SCAN,K_LSHSC,NC, K_SCAN,K_LSHSC,NC, K_SCAN,K_LSHSC,NC, K_SCAN,K_LSHSC,NC,
K_SCAN,K_LSHSC,NC},
{K_BSLSH,NC,NC, K_PIPE,NC,NC, K_FS,NC,NC, 0x1b,0x4e,0x5c, 0x1b,0x4e,0x7c},
{K_z,NC,NC, K_Z,NC,NC, K_SUB,NC,NC, 0x1b,0x4e,0x7a, 0x1b,0x4e,0x5a},
{K_x,NC,NC, K_X,NC,NC, K_CAN,NC,NC, 0x1b,0x4e,0x78, 0x1b,0x4e,0x58},
{K_c,NC,NC, K_C,NC,NC, K_ETX,NC,NC, 0x1b,0x4e,0x63, 0x1b,0x4e,0x43},
{K_v,NC,NC, K_V,NC,NC, K_SYN,NC,NC, 0x1b,0x4e,0x76, 0x1b,0x4e,0x56},
{K_b,NC,NC, K_B,NC,NC, K_STX,NC,NC, 0x1b,0x4e,0x62, 0x1b,0x4e,0x42},
{K_n,NC,NC, K_N,NC,NC, K_SO,NC,NC, 0x1b,0x4e,0x6e, 0x1b,0x4e,0x4e},
{K_m,NC,NC, K_M,NC,NC, K_CR,NC,NC, 0x1b,0x4e,0x6d, 0x1b,0x4e,0x4d},
{K_COMMA,NC,NC, K_LTHN,NC,NC, K_COMMA,NC,NC, 0x1b,0x4e,0x2c, 0x1b,0x4e,0x3c},
{K_PERIOD,NC,NC, K_GTHN,NC,NC, K_PERIOD,NC,NC,0x1b,0x4e,0x2e,0x1b,0x4e,0x3e},
{K_SLASH,NC,NC, K_QUES,NC,NC, K_SLASH,NC,NC, 0x1b,0x4e,0x2f, 0x1b,0x4e,0x3f},
{K_SCAN,K_RSHSC,NC, K_SCAN,K_RSHSC,NC, K_SCAN,K_RSHSC,NC, K_SCAN,K_RSHSC,NC,
K_SCAN,K_RSHSC,NC},
{K_ASTER,NC,NC, K_ASTER,NC,NC, K_ASTER,NC,NC, 0x1b,0x4e,0x2a,0x1b,0x4e,0x2a},
{K_SCAN,K_ALTSC,NC, K_SCAN,K_ALTSC,NC, K_SCAN,K_ALTSC,NC, K_SCAN,K_ALTSC,NC,
K_SCAN,K_ALTSC,NC},
{K_SPACE,NC,NC, K_SPACE,NC,NC, K_NUL,NC,NC, K_SPACE,NC,NC, K_SPACE,NC,NC},
{K_SCAN,K_CLCKSC,NC, K_SCAN,K_CLCKSC,NC, K_SCAN,K_CLCKSC,NC,
K_SCAN,K_CLCKSC,NC, K_SCAN,K_CLCKSC,NC},
{K_F1, K_F1S, K_F1, K_F1, K_F1S},
{K_F2, K_F2S, K_F2, K_F2, K_F2S},
{K_F3, K_F3S, K_F3, K_F3, K_F3S},
{K_F4, K_F4S, K_F4, K_F4, K_F4S},
{K_F5, K_F5S, K_F5, K_F5, K_F5S},
{K_F6, K_F6S, K_F6, K_F6, K_F6S},
{K_F7, K_F7S, K_F7, K_F7, K_F7S},
{K_F8, K_F8S, K_F8, K_F8, K_F8S},
{K_F9, K_F9S, K_F9, K_F9, K_F9S},
{K_F10, K_F10S, K_F10, K_F10, K_F10S},
{K_SCAN,K_NLCKSC,NC, K_SCAN,K_NLCKSC,NC, K_SCAN,K_NLCKSC,NC,
K_SCAN,K_NLCKSC,NC, K_SCAN,K_NLCKSC,NC},
{K_SCRL, K_NUL,NC,NC, K_SCRL, K_SCRL, K_NUL,NC,NC},
{K_HOME, K_SEVEN,NC,NC, K_HOME, K_HOME, 0x1b,0x4e,0x37},
{K_UA, K_EIGHT,NC,NC, K_UA, K_UA, 0x1b,0x4e,0x38},
{K_PUP, K_NINE,NC,NC, K_PUP, K_PUP, 0x1b,0x4e,0x39},
{0x1b,0x5b,0x53, K_MINUS,NC,NC, 0x1b,0x5b,0x53,0x1b,0x5b,0x53,0x1b,0x4e,0x2d},
{K_LA, K_FOUR,NC,NC, K_LA, K_LA, 0x1b,0x4e,0x34},
{0x1b,0x5b,0x47,K_FIVE,NC,NC,0x1b,0x5b,0x47, 0x1b,0x5b,0x47, 0x1b,0x4e,0x35},
{K_RA, K_SIX,NC,NC, K_RA, K_RA, 0x1b,0x4e,0x36},
{0x1b,0x5b,0x54,K_PLUS,NC,NC, 0x1b,0x5b,0x54, 0x1b,0x5b,0x54, 0x1b,0x4e,0x2b},
{K_END, K_ONE,NC,NC, K_END, K_END, 0x1b,0x4e,0x31},
{K_DA, K_TWO,NC,NC, K_DA, K_DA, 0x1b,0x4e,0x32},
{K_PDN, K_THREE,NC,NC, K_PDN, K_PDN, 0x1b,0x4e,0x33},
{K_INS, K_ZERO,NC,NC, K_INS, K_INS, 0x1b,0x4e,0x30},
{K_DEL,NC,NC, K_PERIOD,NC,NC, K_DEL,NC,NC, K_DEL,NC,NC, 0x1b,0x4e,0x2e},
{NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC},
{NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC},
{NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC,NC},
{K_F11, K_F11S, K_F11, K_F11, K_F11S},
{K_F12, K_F12S, K_F12, K_F12, K_F12S}
};
extern void cnputc(unsigned char ch);
int kd_pollc = 0;
int (*cgetc)(
int wait) = kd_dogetc;
void (*cputc)(
char ch) = cnputc;
int
cngetc(void)
{
int ret;
ret = (*cgetc)(TRUE);
return ret;
}
int
cnmaygetc(void)
{
int ret;
ret = (*cgetc)(FALSE);
return ret;
}
int
kd_dogetc(
int wait)
{
unsigned char c;
unsigned char scancode;
unsigned int char_idx;
int up;
kdinit();
kd_extended = FALSE;
for ( ; ; ) {
while (!(inb(K_STATUS) & K_OBUF_FUL))
if (!wait)
return (-1);
up = FALSE;
if ((inb(K_STATUS) & 0x20) == 0x20) {
printf("M%xP", inb(K_RDWR));
continue;
}
scancode = inb(K_RDWR);
if (scancode == K_EXTEND) {
kd_extended = TRUE;
continue;
} else if (scancode == K_RESEND) {
kd_resend();
continue;
} else if (scancode == K_ACKSC) {
kd_handle_ack();
continue;
}
if (scancode & K_UP) {
up = TRUE;
scancode &= ~K_UP;
}
if (kd_kbd_mouse)
kd_kbd_magic(scancode);
if (scancode < NUMKEYS) {
char_idx = kdstate2idx(kd_state, kd_extended);
c = key_map[scancode][char_idx];
if (c == K_SCAN) {
c = key_map[scancode][++char_idx];
kd_state = do_modifier(kd_state, c, up);
#ifdef notdef
cnsetleds(state2leds(kd_state));
#endif
} else if (!up) {
if (c == K_CR)
c = K_LF;
#ifdef notdef
splx(o_pri);
#endif
return(c & 0177);
}
}
}
}
int old_kb_mode;
#if MACH_KDB
#define poll_spl() db_splhigh()
#define poll_splx(s) db_splx(s)
#else
#define poll_spl() SPLKD()
#define poll_splx(s) splx(s)
#endif
void
cnpollc(
int on)
{
int old_spl;
if (cpu_number()) {
return;
}
if (on) {
old_spl = poll_spl();
old_kb_mode = kb_mode;
kb_mode = KB_ASCII;
poll_splx(old_spl);
kd_pollc++;
} else {
--kd_pollc;
old_spl = poll_spl();
kb_mode = old_kb_mode;
poll_splx(old_spl);
}
}
void
kd_handle_ack(void)
{
switch (kd_ack) {
case SET_LEDS:
kd_setleds2();
kd_ack = DATA_ACK;
break;
case DATA_ACK:
kd_ack = NOT_WAITING;
break;
case NOT_WAITING:
printf("unexpected ACK from keyboard\n");
break;
default:
panic("bogus kd_ack\n");
break;
}
}
void
kd_resend(void)
{
if (kd_ack == NOT_WAITING)
printf("unexpected RESEND from keyboard\n");
else
kd_senddata(last_sent);
}
int
do_modifier(
int state,
Scancode c,
int up)
{
switch (c) {
case (K_ALTSC):
if (up)
state &= ~KS_ALTED;
else
state |= KS_ALTED;
kd_extended = FALSE;
break;
#ifndef ORC
case (K_CLCKSC):
#endif
case (K_CTLSC):
if (up)
state &= ~KS_CTLED;
else
state |= KS_CTLED;
kd_extended = FALSE;
break;
#ifdef ORC
case (K_CLCKSC):
if (!up)
state ^= KS_CLKED;
break;
#endif
case (K_NLCKSC):
if (!up)
state ^= KS_NLKED;
break;
case (K_LSHSC):
case (K_RSHSC):
if (up)
state &= ~KS_SHIFTED;
else
state |= KS_SHIFTED;
kd_extended = FALSE;
break;
}
return(state);
}
int
kdcheckmagic(
Scancode scancode,
int *regs)
{
static int magic_state = KS_NORMAL;
int up = FALSE;
extern int rebootflag;
if (scancode == 0x46 && kbdmouseflag)
{
kd_kbd_mouse = !kd_kbd_mouse;
kd_kbd_magic_button = 0;
return(TRUE);
}
if (scancode & K_UP) {
up = TRUE;
scancode &= ~K_UP;
}
magic_state = do_modifier(magic_state, scancode, up);
if ((magic_state&(KS_CTLED|KS_ALTED)) == (KS_CTLED|KS_ALTED)) {
switch (scancode) {
#if MACH_KDB
case K_dSC:
if (!kbdkdbflag)
return(FALSE);
kdb_kintr();
(void)SPLKD();
magic_state = KS_NORMAL;
if (kb_mode == KB_ASCII)
kd_state = KS_NORMAL;
return(TRUE);
break;
#endif
case K_DELSC:
if (rebootflag)
kdreboot();
break;
}
}
return(FALSE);
}
int
kdstate2idx(
int state,
int extended)
{
int state_idx = NORM_STATE;
if ((!extended) && state != KS_NORMAL) {
if ((state&(KS_SHIFTED|KS_ALTED)) == (KS_SHIFTED|KS_ALTED))
state_idx = SHIFT_ALT;
else if (state&KS_SHIFTED)
state_idx = SHIFT_STATE;
else if (state&KS_ALTED)
state_idx = ALT_STATE;
else if (state&KS_CTLED)
state_idx = CTRL_STATE;
}
return (CHARIDX(state_idx));
}
void
kdinit(void)
{
unsigned char k_comm;
unsigned char kd_stat;
if (kd_initialized)
return;
kd_initialized = TRUE;
if (inb(K_STATUS) & K_OBUF_FUL)
(void)inb(K_RDWR);
cnsetleds(kd_state = KS_NORMAL);
kd_sendcmd(KC_CMD_READ);
k_comm = kd_getdata();
k_comm &= ~K_CB_DISBLE;
k_comm |= K_CB_ENBLIRQ;
kd_sendcmd(KC_CMD_WRITE);
kd_senddata(k_comm);
(void)inb(K_RDWR);
}
void
kd_belloff(void)
{
unsigned char status;
status = (inb(K_PORTB) & ~(K_SPKRDATA | K_ENABLETMR2));
outb(K_PORTB, status);
}
void
kd_bellon(void)
{
unsigned char status;
outb(K_TMRCTL, K_SELTMR2 | K_RDLDTWORD | K_TSQRWAVE | K_TBINARY);
outb(K_TMR2, 1500 & 0xff);
outb(K_TMR2, (int)1500 >> 8);
status = (inb(K_PORTB)| K_ENABLETMR2 | K_SPKRDATA);
outb(K_PORTB, status);
return;
}
void
kd_senddata(
unsigned char ch)
{
while (inb(K_STATUS) & K_IBUF_FUL);
outb(K_RDWR, ch);
last_sent = ch;
}
void
kd_sendcmd(
unsigned char ch)
{
while (inb(K_STATUS) & K_IBUF_FUL);
outb(K_CMD, ch);
}
unsigned char
kd_getdata(void)
{
while ((inb(K_STATUS) & K_OBUF_FUL) == 0);
return(inb(K_RDWR));
}
unsigned char
kd_cmdreg_read(void)
{
int ch=KC_CMD_READ;
while (inb(K_STATUS) & (K_IBUF_FUL | K_OBUF_FUL));
outb(K_CMD, ch);
while ((inb(K_STATUS) & K_OBUF_FUL) == 0);
return(inb(K_RDWR));
}
void
kd_cmdreg_write(
unsigned char val)
{
int ch=KC_CMD_WRITE;
while (inb(K_STATUS) & K_IBUF_FUL);
outb(K_CMD, ch);
while (inb(K_STATUS) & K_IBUF_FUL);
outb(K_RDWR, val);
}
int kd_mouse_write_no_ack = 0;
int
kd_mouse_write(
unsigned char val)
{
int ch=0xd4;
int ret = 0;
while (inb(K_STATUS) & K_IBUF_FUL);
outb(K_CMD, ch);
while (inb(K_STATUS) & K_IBUF_FUL);
outb(K_RDWR, val);
if (kd_mouse_write_no_ack) goto done;
while ((inb(K_STATUS) & K_OBUF_FUL) == 0);
if ((inb(K_STATUS) & 0x20) == 0x20) {
switch (ret = inb(K_RDWR)) {
case 0xfa:
break;
case 0xfe:
case 0xfc:
default:
printf("kd_mouse_write: saw %x for %x\n",
ret, val);
}
} else {
printf("kd_mouse_write: sync error ??? on %x\n", val);
}
done:
return ret;
}
void
kd_mouse_read(
int no,
char *buf)
{
while (no-- > 0) {
while ((inb(K_STATUS) & K_OBUF_FUL) == 0);
if ((inb(K_STATUS) & 0x20) == 0x20) {
*buf++ = (unsigned char)inb(K_RDWR);
} else {
int junk = inb(K_RDWR);
printf("kd_mouse_read: sync error, received: 0x%x\n",
junk);
break;
}
}
}
void
kd_mouse_drain(void)
{
int i;
while(inb(K_STATUS) & K_IBUF_FUL);
while((i = inb(K_STATUS)) & K_OBUF_FUL)
printf("kbd: S = %x D = %x\n", i, inb(K_RDWR));
}
void
set_kd_state(
int newstate)
{
kd_state = newstate;
kd_setleds1(state2leds(newstate));
}
unsigned char
state2leds(
int state)
{
unsigned char result = 0;
if (state & KS_NLKED)
result |= K_LED_NUMLK;
if (state & KS_CLKED)
result |= K_LED_CAPSLK;
return(result);
}
void
kd_setleds1(
unsigned char val)
{
if (kd_ack != NOT_WAITING) {
printf("kd_setleds1: unexpected state (%d)\n", kd_ack);
return;
}
kd_ack = SET_LEDS;
kd_nextled = val;
kd_senddata(K_CMD_LEDS);
}
void
kd_setleds2(void)
{
kd_senddata(kd_nextled);
}
void
cnsetleds(
unsigned char val)
{
kd_senddata(K_CMD_LEDS);
(void)kd_getdata();
kd_senddata(val);
(void)kd_getdata();
}
void
kdreboot(void)
{
kd_sendcmd(0xFE);
cpu_shutdown();
}
int
kd_kbd_magic(
int scancode)
{
int new_button = 0;
if (kd_kbd_mouse == 2)
printf("sc = %x\n", scancode);
switch (scancode) {
case 0x3d:
new_button++;
case 0x3c:
new_button++;
case 0x3b:
new_button++;
if (kd_kbd_magic_button && (new_button != kd_kbd_magic_button)) {
}
if (kd_kbd_magic_button == new_button) {
kd_kbd_magic_button = 0;
} else {
kd_kbd_magic_button = new_button;
}
break;
default:
return 0;
}
return 1;
}