void
dt_msg_dump(struct dt_msg *msg)
{
int i, l;
l = DT_CTL_LEN(msg->ctl);
printf("hdr: dst=%02x src=%02x p=%02x sub=%02x len=%02x\n",
msg->dst, msg->src, DT_CTL_P(msg->ctl), DT_CTL_SUBADDR(msg->ctl),
l);
printf("body: ");
for (i = 0; i < l && i < 20; i++)
printf("%02x ", msg->body[i]);
if (i < l) {
printf("\n");
for (; i < l; i++)
printf("%02x ", msg->body[i]);
}
printf("\n");
}
void
dt_dispatch(void *cookie)
{
struct dt_softc *sc;
struct dt_msg *msg;
int s, other, mouse;
struct dt_device *dtdv;
sc = cookie;
msg = NULL;
other = DT_ADDR_KBD;
mouse = 0;
for (;;) {
s = spltty();
if (msg != NULL) {
SLIST_INSERT_HEAD(&sc->sc_free, msg, chain.slist);
if (mouse) {
dt_ms_addr = msg->src;
dt_kbd_addr = other;
} else {
dt_kbd_addr = msg->src;
dt_ms_addr = other;
}
}
msg = SIMPLEQ_FIRST(&sc->sc_queue);
if (msg != NULL)
SIMPLEQ_REMOVE_HEAD(&sc->sc_queue, chain.simpleq);
splx(s);
if (msg == NULL)
break;
if (msg->src == DT_ADDR_MOUSE)
other = DT_ADDR_KBD;
else if (msg->src == DT_ADDR_KBD)
other = DT_ADDR_MOUSE;
else {
printf("%s: message from unknown dev 0x%x\n",
sc->sc_dv.dv_xname, sc->sc_msg.src);
dt_msg_dump(msg);
continue;
}
if (DT_CTL_P(msg->ctl) != 0) {
printf("%s: received control message\n",
sc->sc_dv.dv_xname);
dt_msg_dump(msg);
continue;
}
/*
* 1. Mouse should have no more than eight buttons.
* 2. Mouse should always send full locator report.
* 3. Keyboard should never report all-up (0x00) in
* a packet with size > 1.
*/
if (DT_CTL_LEN(msg->ctl) == sizeof(struct dt_locator_msg) &&
msg->body[0] == 0) {
mouse = 1;
dtdv = &dt_ms_dv;
} else {
mouse = 0;
dtdv = &dt_kbd_dv;
}
if (dtdv->dtdv_handler != NULL)
(*dtdv->dtdv_handler)(dtdv->dtdv_dv, msg);
}
}
int
dt_msg_get(struct dt_msg *msg, int intr)
{
volatile u_int *poll, *data;
uint8_t c;
int max;
poll = dt_state.ds_poll;
data = dt_state.ds_data;
/*
* The interface does not hand us the first byte, which is our
* address and cannot ever be anything else but 0x50.
*/
if (dt_state.ds_state == 0) {
dt_state.ds_escaped = 0;
dt_state.ds_ptr = 0;
}
for (;;) {
max = DT_MAX_POLL;
while (!DT_RX_AVAIL(poll)) {
if (intr)
return (DT_GET_NOTYET);
if (max-- <= 0)
break;
DELAY(1);
}
if (max <= 0) {
if (dt_state.ds_state != 0) {
dt_state.ds_bad_pkts++;
dt_state.ds_state = 0;
}
return (DT_GET_ERROR);
}
c = DT_GET_BYTE(data);
if (dt_state.ds_escaped) {
switch (c) {
case 0xe8:
case 0xe9:
case 0xea:
case 0xeb:
c += 0x10;
break;
}
if (c == 'O') {
dt_state.ds_bad_pkts++;
dt_state.ds_state = 0;
return (DT_GET_ERROR);
}
dt_state.ds_escaped = 0;
} else if (c == DT_ESC_CHAR) {
dt_state.ds_escaped = 1;
continue;
}
if (dt_state.ds_state == 0) {
msg->src = c;
dt_state.ds_state = 1;
} else if (dt_state.ds_state == 1) {
msg->ctl = c;
dt_state.ds_state = 2;
dt_state.ds_len = DT_CTL_LEN(msg->ctl) + 1;
if (dt_state.ds_len > sizeof(msg->body))
printf("dt_msg_get: msg truncated: %d\n",
dt_state.ds_len);
} else /* if (dt_state.ds_state == 2) */ {
if (dt_state.ds_ptr < sizeof(msg->body))
msg->body[dt_state.ds_ptr++] = c;
if (dt_state.ds_ptr >= dt_state.ds_len)
break;
}
}
msg->dst = DT_ADDR_HOST;
dt_state.ds_state = 0;
return (DT_GET_DONE);
}
void
dt_dispatch(void *cookie)
{
struct dt_softc *sc;
struct dt_msg *msg;
int s;
struct dt_device *dtdv;
sc = cookie;
msg = NULL;
for (;;) {
s = spltty();
if (msg != NULL)
SLIST_INSERT_HEAD(&sc->sc_free, msg, chain.slist);
msg = SIMPLEQ_FIRST(&sc->sc_queue);
if (msg != NULL)
SIMPLEQ_REMOVE_HEAD(&sc->sc_queue, chain.simpleq);
splx(s);
if (msg == NULL)
break;
if (msg->src != DT_ADDR_MOUSE && msg->src != DT_ADDR_KBD) {
printf("%s: message from unknown dev 0x%x\n",
device_xname(sc->sc_dev), sc->sc_msg.src);
dt_msg_dump(msg);
continue;
}
if (DT_CTL_P(msg->ctl) != 0) {
printf("%s: received control message\n",
device_xname(sc->sc_dev));
dt_msg_dump(msg);
continue;
}
/*
* 1. Mouse should have no more than eight buttons, so first
* 8 bits of body will be zero.
* 2. Mouse should always send full locator report.
* Note: my mouse does not send 'z' data, so the size
* did not match the size of struct dt_locator_msg - mhitch
* 3. Keyboard should never report all-up (0x00) in
* a packet with size > 1.
*/
if (DT_CTL_LEN(msg->ctl) >= 6 &&
msg->body[0] == 0 && msg->src != dt_ms_addr) {
dt_kbd_addr = dt_ms_addr;
dt_ms_addr = msg->src;
} else if (DT_CTL_LEN(msg->ctl) < 6 && msg->body[0] != 0 &&
msg->src != dt_kbd_addr) {
dt_ms_addr = dt_kbd_addr;
dt_kbd_addr = msg->src;
}
if (msg->src == dt_kbd_addr)
dtdv = &dt_kbd_dv;
else
dtdv = &dt_ms_dv;
if (dtdv->dtdv_handler != NULL)
(*dtdv->dtdv_handler)(dtdv->dtdv_arg, msg);
}
}
