pckbport.c revision 1.15 1 1.15 christos /* $NetBSD: pckbport.c,v 1.15 2013/03/06 03:26:17 christos Exp $ */
2 1.1 bjh21
3 1.1 bjh21 /*
4 1.1 bjh21 * Copyright (c) 2004 Ben Harris
5 1.1 bjh21 * Copyright (c) 1998
6 1.1 bjh21 * Matthias Drochner. All rights reserved.
7 1.1 bjh21 *
8 1.1 bjh21 * Redistribution and use in source and binary forms, with or without
9 1.1 bjh21 * modification, are permitted provided that the following conditions
10 1.1 bjh21 * are met:
11 1.1 bjh21 * 1. Redistributions of source code must retain the above copyright
12 1.1 bjh21 * notice, this list of conditions and the following disclaimer.
13 1.1 bjh21 * 2. Redistributions in binary form must reproduce the above copyright
14 1.1 bjh21 * notice, this list of conditions and the following disclaimer in the
15 1.1 bjh21 * documentation and/or other materials provided with the distribution.
16 1.1 bjh21 *
17 1.1 bjh21 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 1.1 bjh21 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 1.1 bjh21 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 1.1 bjh21 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 1.1 bjh21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 1.1 bjh21 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 1.1 bjh21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 1.1 bjh21 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 1.1 bjh21 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 1.1 bjh21 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 1.1 bjh21 */
28 1.1 bjh21
29 1.1 bjh21 #include <sys/cdefs.h>
30 1.15 christos __KERNEL_RCSID(0, "$NetBSD: pckbport.c,v 1.15 2013/03/06 03:26:17 christos Exp $");
31 1.1 bjh21
32 1.1 bjh21 #include <sys/param.h>
33 1.1 bjh21 #include <sys/systm.h>
34 1.1 bjh21 #include <sys/callout.h>
35 1.1 bjh21 #include <sys/kernel.h>
36 1.1 bjh21 #include <sys/proc.h>
37 1.1 bjh21 #include <sys/device.h>
38 1.1 bjh21 #include <sys/malloc.h>
39 1.1 bjh21 #include <sys/errno.h>
40 1.1 bjh21 #include <sys/queue.h>
41 1.1 bjh21
42 1.8 christos #include <dev/pckbport/pckbdreg.h>
43 1.1 bjh21 #include <dev/pckbport/pckbportvar.h>
44 1.1 bjh21
45 1.1 bjh21 #include "locators.h"
46 1.1 bjh21
47 1.1 bjh21 #include "pckbd.h"
48 1.1 bjh21 #if (NPCKBD > 0)
49 1.1 bjh21 #include <dev/pckbport/pckbdvar.h>
50 1.1 bjh21 #endif
51 1.1 bjh21
52 1.1 bjh21 /* descriptor for one device command */
53 1.1 bjh21 struct pckbport_devcmd {
54 1.1 bjh21 TAILQ_ENTRY(pckbport_devcmd) next;
55 1.1 bjh21 int flags;
56 1.1 bjh21 #define KBC_CMDFLAG_SYNC 1 /* give descriptor back to caller */
57 1.1 bjh21 #define KBC_CMDFLAG_SLOW 2
58 1.1 bjh21 u_char cmd[4];
59 1.1 bjh21 int cmdlen, cmdidx, retries;
60 1.1 bjh21 u_char response[4];
61 1.1 bjh21 int status, responselen, responseidx;
62 1.1 bjh21 };
63 1.1 bjh21
64 1.1 bjh21 /* data per slave device */
65 1.1 bjh21 struct pckbport_slotdata {
66 1.1 bjh21 int polling; /* don't process data in interrupt handler */
67 1.1 bjh21 TAILQ_HEAD(, pckbport_devcmd) cmdqueue; /* active commands */
68 1.1 bjh21 TAILQ_HEAD(, pckbport_devcmd) freequeue; /* free commands */
69 1.1 bjh21 #define NCMD 5
70 1.1 bjh21 struct pckbport_devcmd cmds[NCMD];
71 1.1 bjh21 };
72 1.1 bjh21
73 1.1 bjh21 #define CMD_IN_QUEUE(q) (TAILQ_FIRST(&(q)->cmdqueue) != NULL)
74 1.1 bjh21
75 1.2 bjh21 static void pckbport_init_slotdata(struct pckbport_slotdata *);
76 1.2 bjh21 static int pckbportprint(void *, const char *);
77 1.1 bjh21
78 1.1 bjh21 static struct pckbport_slotdata pckbport_cons_slotdata;
79 1.1 bjh21
80 1.2 bjh21 static int pckbport_poll_data1(pckbport_tag_t, pckbport_slot_t);
81 1.2 bjh21 static int pckbport_send_devcmd(struct pckbport_tag *, pckbport_slot_t,
82 1.2 bjh21 u_char);
83 1.2 bjh21 static void pckbport_poll_cmd1(struct pckbport_tag *, pckbport_slot_t,
84 1.2 bjh21 struct pckbport_devcmd *);
85 1.2 bjh21
86 1.2 bjh21 static void pckbport_cleanqueue(struct pckbport_slotdata *);
87 1.2 bjh21 static void pckbport_cleanup(void *);
88 1.2 bjh21 static int pckbport_cmdresponse(struct pckbport_tag *, pckbport_slot_t,
89 1.2 bjh21 u_char);
90 1.2 bjh21 static void pckbport_start(struct pckbport_tag *, pckbport_slot_t);
91 1.1 bjh21
92 1.1 bjh21 static const char * const pckbport_slot_names[] = { "kbd", "aux" };
93 1.1 bjh21
94 1.1 bjh21 static struct pckbport_tag pckbport_cntag;
95 1.1 bjh21
96 1.15 christos #define KBD_DELAY DELAY(8)
97 1.1 bjh21
98 1.15 christos #ifdef PCKBPORTDEBUG
99 1.15 christos #define DPRINTF(a) printf a
100 1.15 christos #else
101 1.15 christos #define DPRINTF(a)
102 1.15 christos #endif
103 1.1 bjh21
104 1.1 bjh21 static int
105 1.2 bjh21 pckbport_poll_data1(pckbport_tag_t t, pckbport_slot_t slot)
106 1.1 bjh21 {
107 1.1 bjh21
108 1.1 bjh21 return t->t_ops->t_poll_data1(t->t_cookie, slot);
109 1.1 bjh21 }
110 1.1 bjh21
111 1.1 bjh21 static int
112 1.2 bjh21 pckbport_send_devcmd(struct pckbport_tag *t, pckbport_slot_t slot, u_char val)
113 1.1 bjh21 {
114 1.1 bjh21
115 1.1 bjh21 return t->t_ops->t_send_devcmd(t->t_cookie, slot, val);
116 1.1 bjh21 }
117 1.1 bjh21
118 1.1 bjh21 pckbport_tag_t
119 1.1 bjh21 pckbport_attach(void *cookie, struct pckbport_accessops const *ops)
120 1.1 bjh21 {
121 1.1 bjh21 pckbport_tag_t t;
122 1.1 bjh21
123 1.1 bjh21 if (cookie == pckbport_cntag.t_cookie &&
124 1.1 bjh21 ops == pckbport_cntag.t_ops)
125 1.1 bjh21 return &pckbport_cntag;
126 1.1 bjh21 t = malloc(sizeof(struct pckbport_tag), M_DEVBUF, M_NOWAIT | M_ZERO);
127 1.1 bjh21 if (t == NULL) return NULL;
128 1.10 ad callout_init(&t->t_cleanup, 0);
129 1.1 bjh21 t->t_cookie = cookie;
130 1.1 bjh21 t->t_ops = ops;
131 1.1 bjh21 return t;
132 1.1 bjh21 }
133 1.1 bjh21
134 1.13 cube device_t
135 1.13 cube pckbport_attach_slot(device_t dev, pckbport_tag_t t,
136 1.2 bjh21 pckbport_slot_t slot)
137 1.1 bjh21 {
138 1.1 bjh21 struct pckbport_attach_args pa;
139 1.1 bjh21 void *sdata;
140 1.13 cube device_t found;
141 1.1 bjh21 int alloced = 0;
142 1.5 drochner int locs[PCKBPORTCF_NLOCS];
143 1.1 bjh21
144 1.1 bjh21 pa.pa_tag = t;
145 1.1 bjh21 pa.pa_slot = slot;
146 1.1 bjh21
147 1.1 bjh21 if (t->t_slotdata[slot] == NULL) {
148 1.1 bjh21 sdata = malloc(sizeof(struct pckbport_slotdata),
149 1.1 bjh21 M_DEVBUF, M_NOWAIT);
150 1.1 bjh21 if (sdata == NULL) {
151 1.13 cube aprint_error_dev(dev, "no memory\n");
152 1.2 bjh21 return 0;
153 1.1 bjh21 }
154 1.1 bjh21 t->t_slotdata[slot] = sdata;
155 1.1 bjh21 pckbport_init_slotdata(t->t_slotdata[slot]);
156 1.1 bjh21 alloced++;
157 1.1 bjh21 }
158 1.1 bjh21
159 1.5 drochner locs[PCKBPORTCF_SLOT] = slot;
160 1.4 drochner
161 1.5 drochner found = config_found_sm_loc(dev, "pckbport", locs, &pa,
162 1.6 drochner pckbportprint, config_stdsubmatch);
163 1.1 bjh21
164 1.1 bjh21 if (found == NULL && alloced) {
165 1.1 bjh21 free(t->t_slotdata[slot], M_DEVBUF);
166 1.1 bjh21 t->t_slotdata[slot] = NULL;
167 1.1 bjh21 }
168 1.1 bjh21
169 1.2 bjh21 return found;
170 1.1 bjh21 }
171 1.1 bjh21
172 1.1 bjh21 int
173 1.2 bjh21 pckbportprint(void *aux, const char *pnp)
174 1.1 bjh21 {
175 1.1 bjh21 struct pckbport_attach_args *pa = aux;
176 1.1 bjh21
177 1.1 bjh21 if (!pnp)
178 1.1 bjh21 aprint_normal(" (%s slot)", pckbport_slot_names[pa->pa_slot]);
179 1.2 bjh21 return QUIET;
180 1.1 bjh21 }
181 1.1 bjh21
182 1.1 bjh21 void
183 1.2 bjh21 pckbport_init_slotdata(struct pckbport_slotdata *q)
184 1.1 bjh21 {
185 1.1 bjh21 int i;
186 1.2 bjh21
187 1.1 bjh21 TAILQ_INIT(&q->cmdqueue);
188 1.1 bjh21 TAILQ_INIT(&q->freequeue);
189 1.1 bjh21
190 1.2 bjh21 for (i = 0; i < NCMD; i++)
191 1.1 bjh21 TAILQ_INSERT_TAIL(&q->freequeue, &(q->cmds[i]), next);
192 1.2 bjh21
193 1.1 bjh21 q->polling = 0;
194 1.1 bjh21 }
195 1.1 bjh21
196 1.1 bjh21 void
197 1.2 bjh21 pckbport_flush(pckbport_tag_t t, pckbport_slot_t slot)
198 1.1 bjh21 {
199 1.1 bjh21
200 1.2 bjh21 (void)pckbport_poll_data1(t, slot);
201 1.1 bjh21 }
202 1.1 bjh21
203 1.1 bjh21 int
204 1.2 bjh21 pckbport_poll_data(pckbport_tag_t t, pckbport_slot_t slot)
205 1.1 bjh21 {
206 1.1 bjh21 struct pckbport_slotdata *q = t->t_slotdata[slot];
207 1.1 bjh21 int c;
208 1.1 bjh21
209 1.1 bjh21 c = pckbport_poll_data1(t, slot);
210 1.2 bjh21 if (c != -1 && q && CMD_IN_QUEUE(q))
211 1.2 bjh21 /*
212 1.2 bjh21 * we jumped into a running command - try to deliver
213 1.2 bjh21 * the response
214 1.2 bjh21 */
215 1.1 bjh21 if (pckbport_cmdresponse(t, slot, c))
216 1.2 bjh21 return -1;
217 1.2 bjh21 return c;
218 1.1 bjh21 }
219 1.1 bjh21
220 1.1 bjh21 /*
221 1.1 bjh21 * switch scancode translation on / off
222 1.1 bjh21 * return nonzero on success
223 1.1 bjh21 */
224 1.1 bjh21 int
225 1.2 bjh21 pckbport_xt_translation(pckbport_tag_t t, pckbport_slot_t slot, int on)
226 1.1 bjh21 {
227 1.1 bjh21
228 1.1 bjh21 return t->t_ops->t_xt_translation(t->t_cookie, slot, on);
229 1.1 bjh21 }
230 1.1 bjh21
231 1.1 bjh21 void
232 1.2 bjh21 pckbport_slot_enable(pckbport_tag_t t, pckbport_slot_t slot, int on)
233 1.1 bjh21 {
234 1.1 bjh21
235 1.1 bjh21 t->t_ops->t_slot_enable(t->t_cookie, slot, on);
236 1.1 bjh21 }
237 1.1 bjh21
238 1.1 bjh21 void
239 1.2 bjh21 pckbport_set_poll(pckbport_tag_t t, pckbport_slot_t slot, int on)
240 1.1 bjh21 {
241 1.1 bjh21
242 1.1 bjh21 t->t_slotdata[slot]->polling = on;
243 1.1 bjh21 t->t_ops->t_set_poll(t->t_cookie, slot, on);
244 1.1 bjh21 }
245 1.1 bjh21
246 1.1 bjh21 /*
247 1.1 bjh21 * Pass command to device, poll for ACK and data.
248 1.1 bjh21 * to be called at spltty()
249 1.1 bjh21 */
250 1.1 bjh21 static void
251 1.2 bjh21 pckbport_poll_cmd1(struct pckbport_tag *t, pckbport_slot_t slot,
252 1.2 bjh21 struct pckbport_devcmd *cmd)
253 1.1 bjh21 {
254 1.1 bjh21 int i, c = 0;
255 1.1 bjh21
256 1.1 bjh21 while (cmd->cmdidx < cmd->cmdlen) {
257 1.1 bjh21 if (!pckbport_send_devcmd(t, slot, cmd->cmd[cmd->cmdidx])) {
258 1.1 bjh21 printf("pckbport_cmd: send error\n");
259 1.1 bjh21 cmd->status = EIO;
260 1.1 bjh21 return;
261 1.1 bjh21 }
262 1.1 bjh21 for (i = 10; i; i--) { /* 1s ??? */
263 1.1 bjh21 c = pckbport_poll_data1(t, slot);
264 1.1 bjh21 if (c != -1)
265 1.1 bjh21 break;
266 1.1 bjh21 }
267 1.15 christos switch (c) {
268 1.15 christos case KBR_ACK:
269 1.1 bjh21 cmd->cmdidx++;
270 1.1 bjh21 continue;
271 1.15 christos case KBR_BAT_DONE:
272 1.15 christos case KBR_BAT_FAIL:
273 1.15 christos case KBR_RESEND:
274 1.15 christos DPRINTF(("%s: %s\n", __func__, c == KBR_RESEND ?
275 1.15 christos "RESEND" : (c == KBR_BAT_DONE ? "BAT_DONE" :
276 1.15 christos "BAT_FAIL")));
277 1.1 bjh21 if (cmd->retries++ < 5)
278 1.1 bjh21 continue;
279 1.1 bjh21 else {
280 1.15 christos DPRINTF(("%s: cmd failed\n", __func__));
281 1.1 bjh21 cmd->status = EIO;
282 1.1 bjh21 return;
283 1.1 bjh21 }
284 1.15 christos case -1:
285 1.15 christos DPRINTF(("%s: timeout\n", __func__));
286 1.1 bjh21 cmd->status = EIO;
287 1.1 bjh21 return;
288 1.1 bjh21 }
289 1.15 christos DPRINTF(("%s: lost 0x%x\n", __func__, c));
290 1.1 bjh21 }
291 1.1 bjh21
292 1.1 bjh21 while (cmd->responseidx < cmd->responselen) {
293 1.1 bjh21 if (cmd->flags & KBC_CMDFLAG_SLOW)
294 1.1 bjh21 i = 100; /* 10s ??? */
295 1.1 bjh21 else
296 1.1 bjh21 i = 10; /* 1s ??? */
297 1.1 bjh21 while (i--) {
298 1.1 bjh21 c = pckbport_poll_data1(t, slot);
299 1.1 bjh21 if (c != -1)
300 1.1 bjh21 break;
301 1.1 bjh21 }
302 1.1 bjh21 if (c == -1) {
303 1.15 christos DPRINTF(("%s: no data\n", __func__));
304 1.1 bjh21 cmd->status = ETIMEDOUT;
305 1.1 bjh21 return;
306 1.1 bjh21 } else
307 1.1 bjh21 cmd->response[cmd->responseidx++] = c;
308 1.1 bjh21 }
309 1.1 bjh21 }
310 1.1 bjh21
311 1.1 bjh21 /* for use in autoconfiguration */
312 1.1 bjh21 int
313 1.14 jakllsch pckbport_poll_cmd(pckbport_tag_t t, pckbport_slot_t slot, const u_char *cmd,
314 1.14 jakllsch int len, int responselen, u_char *respbuf, int slow)
315 1.1 bjh21 {
316 1.1 bjh21 struct pckbport_devcmd nc;
317 1.1 bjh21
318 1.1 bjh21 if ((len > 4) || (responselen > 4))
319 1.1 bjh21 return (EINVAL);
320 1.1 bjh21
321 1.1 bjh21 memset(&nc, 0, sizeof(nc));
322 1.1 bjh21 memcpy(nc.cmd, cmd, len);
323 1.1 bjh21 nc.cmdlen = len;
324 1.1 bjh21 nc.responselen = responselen;
325 1.1 bjh21 nc.flags = (slow ? KBC_CMDFLAG_SLOW : 0);
326 1.1 bjh21
327 1.1 bjh21 pckbport_poll_cmd1(t, slot, &nc);
328 1.1 bjh21
329 1.1 bjh21 if (nc.status == 0 && respbuf)
330 1.1 bjh21 memcpy(respbuf, nc.response, responselen);
331 1.1 bjh21
332 1.2 bjh21 return nc.status;
333 1.1 bjh21 }
334 1.1 bjh21
335 1.1 bjh21 /*
336 1.1 bjh21 * Clean up a command queue, throw away everything.
337 1.1 bjh21 */
338 1.1 bjh21 void
339 1.2 bjh21 pckbport_cleanqueue(struct pckbport_slotdata *q)
340 1.1 bjh21 {
341 1.1 bjh21 struct pckbport_devcmd *cmd;
342 1.1 bjh21
343 1.1 bjh21 while ((cmd = TAILQ_FIRST(&q->cmdqueue))) {
344 1.1 bjh21 TAILQ_REMOVE(&q->cmdqueue, cmd, next);
345 1.1 bjh21 #ifdef PCKBPORTDEBUG
346 1.15 christos printf("%s: removing", __func__);
347 1.15 christos for (int i = 0; i < cmd->cmdlen; i++)
348 1.1 bjh21 printf(" %02x", cmd->cmd[i]);
349 1.1 bjh21 printf("\n");
350 1.1 bjh21 #endif
351 1.1 bjh21 TAILQ_INSERT_TAIL(&q->freequeue, cmd, next);
352 1.1 bjh21 }
353 1.1 bjh21 }
354 1.1 bjh21
355 1.1 bjh21 /*
356 1.1 bjh21 * Timeout error handler: clean queues and data port.
357 1.1 bjh21 * XXX could be less invasive.
358 1.1 bjh21 */
359 1.1 bjh21 void
360 1.2 bjh21 pckbport_cleanup(void *self)
361 1.1 bjh21 {
362 1.1 bjh21 struct pckbport_tag *t = self;
363 1.1 bjh21 int s;
364 1.8 christos u_char cmd[1], resp[2];
365 1.1 bjh21
366 1.1 bjh21 printf("pckbport: command timeout\n");
367 1.1 bjh21
368 1.1 bjh21 s = spltty();
369 1.1 bjh21
370 1.1 bjh21 if (t->t_slotdata[PCKBPORT_KBD_SLOT])
371 1.1 bjh21 pckbport_cleanqueue(t->t_slotdata[PCKBPORT_KBD_SLOT]);
372 1.1 bjh21 if (t->t_slotdata[PCKBPORT_AUX_SLOT])
373 1.1 bjh21 pckbport_cleanqueue(t->t_slotdata[PCKBPORT_AUX_SLOT]);
374 1.1 bjh21
375 1.1 bjh21 #if 0 /* XXXBJH Move to controller driver? */
376 1.1 bjh21 while (bus_space_read_1(t->t_iot, t->t_ioh_c, 0) & KBS_DIB) {
377 1.1 bjh21 KBD_DELAY;
378 1.1 bjh21 (void) bus_space_read_1(t->t_iot, t->t_ioh_d, 0);
379 1.1 bjh21 }
380 1.1 bjh21 #endif
381 1.1 bjh21
382 1.8 christos cmd[0] = KBC_RESET;
383 1.8 christos (void)pckbport_poll_cmd(t, PCKBPORT_KBD_SLOT, cmd, 1, 2, resp, 1);
384 1.8 christos pckbport_flush(t, PCKBPORT_KBD_SLOT);
385 1.1 bjh21
386 1.1 bjh21 splx(s);
387 1.1 bjh21 }
388 1.1 bjh21
389 1.1 bjh21 /*
390 1.1 bjh21 * Pass command to device during normal operation.
391 1.1 bjh21 * to be called at spltty()
392 1.1 bjh21 */
393 1.1 bjh21 void
394 1.2 bjh21 pckbport_start(struct pckbport_tag *t, pckbport_slot_t slot)
395 1.1 bjh21 {
396 1.1 bjh21 struct pckbport_slotdata *q = t->t_slotdata[slot];
397 1.1 bjh21 struct pckbport_devcmd *cmd = TAILQ_FIRST(&q->cmdqueue);
398 1.1 bjh21
399 1.1 bjh21 if (q->polling) {
400 1.1 bjh21 do {
401 1.1 bjh21 pckbport_poll_cmd1(t, slot, cmd);
402 1.1 bjh21 if (cmd->status)
403 1.1 bjh21 printf("pckbport_start: command error\n");
404 1.1 bjh21
405 1.1 bjh21 TAILQ_REMOVE(&q->cmdqueue, cmd, next);
406 1.1 bjh21 if (cmd->flags & KBC_CMDFLAG_SYNC)
407 1.1 bjh21 wakeup(cmd);
408 1.1 bjh21 else {
409 1.1 bjh21 callout_stop(&t->t_cleanup);
410 1.1 bjh21 TAILQ_INSERT_TAIL(&q->freequeue, cmd, next);
411 1.1 bjh21 }
412 1.1 bjh21 cmd = TAILQ_FIRST(&q->cmdqueue);
413 1.1 bjh21 } while (cmd);
414 1.1 bjh21 return;
415 1.1 bjh21 }
416 1.1 bjh21
417 1.1 bjh21 if (!pckbport_send_devcmd(t, slot, cmd->cmd[cmd->cmdidx])) {
418 1.1 bjh21 printf("pckbport_start: send error\n");
419 1.1 bjh21 /* XXX what now? */
420 1.1 bjh21 return;
421 1.1 bjh21 }
422 1.1 bjh21 }
423 1.1 bjh21
424 1.1 bjh21 /*
425 1.1 bjh21 * Handle command responses coming in asynchronously,
426 1.1 bjh21 * return nonzero if valid response.
427 1.1 bjh21 * to be called at spltty()
428 1.1 bjh21 */
429 1.1 bjh21 int
430 1.2 bjh21 pckbport_cmdresponse(struct pckbport_tag *t, pckbport_slot_t slot, u_char data)
431 1.1 bjh21 {
432 1.1 bjh21 struct pckbport_slotdata *q = t->t_slotdata[slot];
433 1.1 bjh21 struct pckbport_devcmd *cmd = TAILQ_FIRST(&q->cmdqueue);
434 1.2 bjh21
435 1.1 bjh21 #ifdef DIAGNOSTIC
436 1.1 bjh21 if (!cmd)
437 1.1 bjh21 panic("pckbport_cmdresponse: no active command");
438 1.1 bjh21 #endif
439 1.1 bjh21 if (cmd->cmdidx < cmd->cmdlen) {
440 1.15 christos if (data != KBR_ACK && data != KBR_RESEND)
441 1.2 bjh21 return 0;
442 1.1 bjh21
443 1.15 christos if (data == KBR_RESEND) {
444 1.2 bjh21 if (cmd->retries++ < 5)
445 1.1 bjh21 /* try again last command */
446 1.1 bjh21 goto restart;
447 1.2 bjh21 else {
448 1.15 christos DPRINTF(("%s: cmd failed\n", __func__));
449 1.1 bjh21 cmd->status = EIO;
450 1.1 bjh21 /* dequeue */
451 1.1 bjh21 }
452 1.1 bjh21 } else {
453 1.1 bjh21 if (++cmd->cmdidx < cmd->cmdlen)
454 1.1 bjh21 goto restart;
455 1.1 bjh21 if (cmd->responselen)
456 1.2 bjh21 return 1;
457 1.1 bjh21 /* else dequeue */
458 1.1 bjh21 }
459 1.1 bjh21 } else if (cmd->responseidx < cmd->responselen) {
460 1.1 bjh21 cmd->response[cmd->responseidx++] = data;
461 1.1 bjh21 if (cmd->responseidx < cmd->responselen)
462 1.2 bjh21 return 1;
463 1.1 bjh21 /* else dequeue */
464 1.1 bjh21 } else
465 1.2 bjh21 return 0;
466 1.1 bjh21
467 1.1 bjh21 /* dequeue: */
468 1.1 bjh21 TAILQ_REMOVE(&q->cmdqueue, cmd, next);
469 1.1 bjh21 if (cmd->flags & KBC_CMDFLAG_SYNC)
470 1.1 bjh21 wakeup(cmd);
471 1.1 bjh21 else {
472 1.1 bjh21 callout_stop(&t->t_cleanup);
473 1.1 bjh21 TAILQ_INSERT_TAIL(&q->freequeue, cmd, next);
474 1.1 bjh21 }
475 1.1 bjh21 if (!CMD_IN_QUEUE(q))
476 1.2 bjh21 return 1;
477 1.1 bjh21 restart:
478 1.1 bjh21 pckbport_start(t, slot);
479 1.2 bjh21 return 1;
480 1.1 bjh21 }
481 1.1 bjh21
482 1.1 bjh21 /*
483 1.1 bjh21 * Put command into the device's command queue, return zero or errno.
484 1.1 bjh21 */
485 1.1 bjh21 int
486 1.14 jakllsch pckbport_enqueue_cmd(pckbport_tag_t t, pckbport_slot_t slot, const u_char *cmd,
487 1.2 bjh21 int len, int responselen, int sync, u_char *respbuf)
488 1.1 bjh21 {
489 1.1 bjh21 struct pckbport_slotdata *q = t->t_slotdata[slot];
490 1.1 bjh21 struct pckbport_devcmd *nc;
491 1.1 bjh21 int s, isactive, res = 0;
492 1.1 bjh21
493 1.1 bjh21 if ((len > 4) || (responselen > 4))
494 1.2 bjh21 return EINVAL;
495 1.1 bjh21 s = spltty();
496 1.1 bjh21 nc = TAILQ_FIRST(&q->freequeue);
497 1.2 bjh21 if (nc)
498 1.1 bjh21 TAILQ_REMOVE(&q->freequeue, nc, next);
499 1.1 bjh21 splx(s);
500 1.1 bjh21 if (!nc)
501 1.2 bjh21 return ENOMEM;
502 1.1 bjh21
503 1.1 bjh21 memset(nc, 0, sizeof(*nc));
504 1.1 bjh21 memcpy(nc->cmd, cmd, len);
505 1.1 bjh21 nc->cmdlen = len;
506 1.1 bjh21 nc->responselen = responselen;
507 1.1 bjh21 nc->flags = (sync ? KBC_CMDFLAG_SYNC : 0);
508 1.1 bjh21
509 1.1 bjh21 s = spltty();
510 1.1 bjh21
511 1.2 bjh21 if (q->polling && sync)
512 1.1 bjh21 /*
513 1.1 bjh21 * XXX We should poll until the queue is empty.
514 1.1 bjh21 * But we don't come here normally, so make
515 1.1 bjh21 * it simple and throw away everything.
516 1.1 bjh21 */
517 1.1 bjh21 pckbport_cleanqueue(q);
518 1.1 bjh21
519 1.1 bjh21 isactive = CMD_IN_QUEUE(q);
520 1.1 bjh21 TAILQ_INSERT_TAIL(&q->cmdqueue, nc, next);
521 1.1 bjh21 if (!isactive)
522 1.1 bjh21 pckbport_start(t, slot);
523 1.1 bjh21
524 1.1 bjh21 if (q->polling)
525 1.1 bjh21 res = (sync ? nc->status : 0);
526 1.1 bjh21 else if (sync) {
527 1.1 bjh21 if ((res = tsleep(nc, 0, "kbccmd", 1*hz))) {
528 1.1 bjh21 TAILQ_REMOVE(&q->cmdqueue, nc, next);
529 1.1 bjh21 pckbport_cleanup(t);
530 1.1 bjh21 } else
531 1.1 bjh21 res = nc->status;
532 1.1 bjh21 } else
533 1.1 bjh21 callout_reset(&t->t_cleanup, hz, pckbport_cleanup, t);
534 1.1 bjh21
535 1.1 bjh21 if (sync) {
536 1.1 bjh21 if (respbuf)
537 1.1 bjh21 memcpy(respbuf, nc->response, responselen);
538 1.1 bjh21 TAILQ_INSERT_TAIL(&q->freequeue, nc, next);
539 1.1 bjh21 }
540 1.1 bjh21
541 1.1 bjh21 splx(s);
542 1.1 bjh21
543 1.2 bjh21 return res;
544 1.1 bjh21 }
545 1.1 bjh21
546 1.1 bjh21 void
547 1.2 bjh21 pckbport_set_inputhandler(pckbport_tag_t t, pckbport_slot_t slot,
548 1.12 cube pckbport_inputfcn func, void *arg, const char *name)
549 1.1 bjh21 {
550 1.1 bjh21
551 1.1 bjh21 if (slot >= PCKBPORT_NSLOTS)
552 1.1 bjh21 panic("pckbport_set_inputhandler: bad slot %d", slot);
553 1.1 bjh21
554 1.1 bjh21 t->t_ops->t_intr_establish(t->t_cookie, slot);
555 1.1 bjh21
556 1.1 bjh21 t->t_inputhandler[slot] = func;
557 1.1 bjh21 t->t_inputarg[slot] = arg;
558 1.1 bjh21 t->t_subname[slot] = name;
559 1.1 bjh21 }
560 1.1 bjh21
561 1.1 bjh21 void
562 1.1 bjh21 pckbportintr(pckbport_tag_t t, pckbport_slot_t slot, int data)
563 1.1 bjh21 {
564 1.1 bjh21 struct pckbport_slotdata *q;
565 1.1 bjh21
566 1.1 bjh21 q = t->t_slotdata[slot];
567 1.1 bjh21
568 1.1 bjh21 if (!q) {
569 1.1 bjh21 /* XXX do something for live insertion? */
570 1.1 bjh21 printf("pckbportintr: no dev for slot %d\n", slot);
571 1.1 bjh21 return;
572 1.1 bjh21 }
573 1.1 bjh21
574 1.1 bjh21 if (CMD_IN_QUEUE(q) && pckbport_cmdresponse(t, slot, data))
575 1.1 bjh21 return;
576 1.1 bjh21
577 1.15 christos if (t->t_inputhandler[slot]) {
578 1.1 bjh21 (*t->t_inputhandler[slot])(t->t_inputarg[slot], data);
579 1.15 christos return;
580 1.15 christos }
581 1.15 christos DPRINTF(("%s: slot %d lost %d\n", slot, data, __func__));
582 1.1 bjh21 }
583 1.1 bjh21
584 1.1 bjh21 int
585 1.1 bjh21 pckbport_cnattach(void *cookie, struct pckbport_accessops const *ops,
586 1.1 bjh21 pckbport_slot_t slot)
587 1.1 bjh21 {
588 1.1 bjh21 int res = 0;
589 1.1 bjh21 pckbport_tag_t t = &pckbport_cntag;
590 1.1 bjh21
591 1.10 ad callout_init(&t->t_cleanup, 0);
592 1.1 bjh21 t->t_cookie = cookie;
593 1.1 bjh21 t->t_ops = ops;
594 1.1 bjh21
595 1.1 bjh21 /* flush */
596 1.1 bjh21 pckbport_flush(t, slot);
597 1.1 bjh21
598 1.1 bjh21 #if (NPCKBD > 0)
599 1.1 bjh21 res = pckbd_cnattach(t, slot);
600 1.1 bjh21 #elif (NPCKBPORT_MACHDEP_CNATTACH > 0)
601 1.1 bjh21 res = pckbport_machdep_cnattach(t, slot);
602 1.1 bjh21 #else
603 1.1 bjh21 res = ENXIO;
604 1.1 bjh21 #endif /* NPCKBPORT_MACHDEP_CNATTACH > 0 */
605 1.1 bjh21
606 1.1 bjh21 if (res == 0) {
607 1.1 bjh21 t->t_slotdata[slot] = &pckbport_cons_slotdata;
608 1.1 bjh21 pckbport_init_slotdata(&pckbport_cons_slotdata);
609 1.1 bjh21 }
610 1.1 bjh21
611 1.1 bjh21 return res;
612 1.1 bjh21 }
613