1 /* $FreeBSD$ */
2 /* $OpenBSD: umoscom.c,v 1.2 2006/10/26 06:02:43 jsg Exp $ */
3
4 /*
5 * Copyright (c) 2006 Jonathan Gray <jsg@openbsd.org>
6 *
7 * Permission to use, copy, modify, and distribute this software for any
8 * purpose with or without fee is hereby granted, provided that the above
9 * copyright notice and this permission notice appear in all copies.
10 *
11 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
12 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
13 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
14 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
15 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
16 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
17 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
18 */
19
20 #include <sys/stdint.h>
21 #include <sys/stddef.h>
22 #include <sys/param.h>
23 #include <sys/queue.h>
24 #include <sys/types.h>
25 #include <sys/systm.h>
26 #include <sys/kernel.h>
27 #include <sys/bus.h>
28 #include <sys/module.h>
29 #include <sys/lock.h>
30 #include <sys/mutex.h>
31 #include <sys/condvar.h>
32 #include <sys/sysctl.h>
33 #include <sys/sx.h>
34 #include <sys/unistd.h>
35 #include <sys/callout.h>
36 #include <sys/malloc.h>
37 #include <sys/priv.h>
38
39 #include <dev/usb/usb.h>
40 #include <dev/usb/usbdi.h>
41 #include <dev/usb/usbdi_util.h>
42 #include "usbdevs.h"
43
44 #define USB_DEBUG_VAR umoscom_debug
45 #include <dev/usb/usb_debug.h>
46 #include <dev/usb/usb_process.h>
47
48 #include <dev/usb/serial/usb_serial.h>
49
50 #ifdef USB_DEBUG
51 static int umoscom_debug = 0;
52
53 static SYSCTL_NODE(_hw_usb, OID_AUTO, umoscom, CTLFLAG_RW | CTLFLAG_MPSAFE, 0,
54 "USB umoscom");
55 SYSCTL_INT(_hw_usb_umoscom, OID_AUTO, debug, CTLFLAG_RWTUN,
56 &umoscom_debug, 0, "Debug level");
57 #endif
58
59 #define UMOSCOM_BUFSIZE 1024 /* bytes */
60
61 #define UMOSCOM_CONFIG_INDEX 0
62 #define UMOSCOM_IFACE_INDEX 0
63
64 /* interrupt packet */
65 #define UMOSCOM_IIR_RLS 0x06
66 #define UMOSCOM_IIR_RDA 0x04
67 #define UMOSCOM_IIR_CTI 0x0c
68 #define UMOSCOM_IIR_THR 0x02
69 #define UMOSCOM_IIR_MS 0x00
70
71 /* registers */
72 #define UMOSCOM_READ 0x0d
73 #define UMOSCOM_WRITE 0x0e
74 #define UMOSCOM_UART_REG 0x0300
75 #define UMOSCOM_VEND_REG 0x0000
76
77 #define UMOSCOM_TXBUF 0x00 /* Write */
78 #define UMOSCOM_RXBUF 0x00 /* Read */
79 #define UMOSCOM_INT 0x01
80 #define UMOSCOM_FIFO 0x02 /* Write */
81 #define UMOSCOM_ISR 0x02 /* Read */
82 #define UMOSCOM_LCR 0x03
83 #define UMOSCOM_MCR 0x04
84 #define UMOSCOM_LSR 0x05
85 #define UMOSCOM_MSR 0x06
86 #define UMOSCOM_SCRATCH 0x07
87 #define UMOSCOM_DIV_LO 0x08
88 #define UMOSCOM_DIV_HI 0x09
89 #define UMOSCOM_EFR 0x0a
90 #define UMOSCOM_XON1 0x0b
91 #define UMOSCOM_XON2 0x0c
92 #define UMOSCOM_XOFF1 0x0d
93 #define UMOSCOM_XOFF2 0x0e
94
95 #define UMOSCOM_BAUDLO 0x00
96 #define UMOSCOM_BAUDHI 0x01
97
98 #define UMOSCOM_INT_RXEN 0x01
99 #define UMOSCOM_INT_TXEN 0x02
100 #define UMOSCOM_INT_RSEN 0x04
101 #define UMOSCOM_INT_MDMEM 0x08
102 #define UMOSCOM_INT_SLEEP 0x10
103 #define UMOSCOM_INT_XOFF 0x20
104 #define UMOSCOM_INT_RTS 0x40
105
106 #define UMOSCOM_FIFO_EN 0x01
107 #define UMOSCOM_FIFO_RXCLR 0x02
108 #define UMOSCOM_FIFO_TXCLR 0x04
109 #define UMOSCOM_FIFO_DMA_BLK 0x08
110 #define UMOSCOM_FIFO_TXLVL_MASK 0x30
111 #define UMOSCOM_FIFO_TXLVL_8 0x00
112 #define UMOSCOM_FIFO_TXLVL_16 0x10
113 #define UMOSCOM_FIFO_TXLVL_32 0x20
114 #define UMOSCOM_FIFO_TXLVL_56 0x30
115 #define UMOSCOM_FIFO_RXLVL_MASK 0xc0
116 #define UMOSCOM_FIFO_RXLVL_8 0x00
117 #define UMOSCOM_FIFO_RXLVL_16 0x40
118 #define UMOSCOM_FIFO_RXLVL_56 0x80
119 #define UMOSCOM_FIFO_RXLVL_80 0xc0
120
121 #define UMOSCOM_ISR_MDM 0x00
122 #define UMOSCOM_ISR_NONE 0x01
123 #define UMOSCOM_ISR_TX 0x02
124 #define UMOSCOM_ISR_RX 0x04
125 #define UMOSCOM_ISR_LINE 0x06
126 #define UMOSCOM_ISR_RXTIMEOUT 0x0c
127 #define UMOSCOM_ISR_RX_XOFF 0x10
128 #define UMOSCOM_ISR_RTSCTS 0x20
129 #define UMOSCOM_ISR_FIFOEN 0xc0
130
131 #define UMOSCOM_LCR_DBITS(x) ((x) - 5)
132 #define UMOSCOM_LCR_STOP_BITS_1 0x00
133 #define UMOSCOM_LCR_STOP_BITS_2 0x04 /* 2 if 6-8 bits/char or 1.5 if 5 */
134 #define UMOSCOM_LCR_PARITY_NONE 0x00
135 #define UMOSCOM_LCR_PARITY_ODD 0x08
136 #define UMOSCOM_LCR_PARITY_EVEN 0x18
137 #define UMOSCOM_LCR_BREAK 0x40
138 #define UMOSCOM_LCR_DIVLATCH_EN 0x80
139
140 #define UMOSCOM_MCR_DTR 0x01
141 #define UMOSCOM_MCR_RTS 0x02
142 #define UMOSCOM_MCR_LOOP 0x04
143 #define UMOSCOM_MCR_INTEN 0x08
144 #define UMOSCOM_MCR_LOOPBACK 0x10
145 #define UMOSCOM_MCR_XONANY 0x20
146 #define UMOSCOM_MCR_IRDA_EN 0x40
147 #define UMOSCOM_MCR_BAUD_DIV4 0x80
148
149 #define UMOSCOM_LSR_RXDATA 0x01
150 #define UMOSCOM_LSR_RXOVER 0x02
151 #define UMOSCOM_LSR_RXPAR_ERR 0x04
152 #define UMOSCOM_LSR_RXFRM_ERR 0x08
153 #define UMOSCOM_LSR_RXBREAK 0x10
154 #define UMOSCOM_LSR_TXEMPTY 0x20
155 #define UMOSCOM_LSR_TXALLEMPTY 0x40
156 #define UMOSCOM_LSR_TXFIFO_ERR 0x80
157
158 #define UMOSCOM_MSR_CTS_CHG 0x01
159 #define UMOSCOM_MSR_DSR_CHG 0x02
160 #define UMOSCOM_MSR_RI_CHG 0x04
161 #define UMOSCOM_MSR_CD_CHG 0x08
162 #define UMOSCOM_MSR_CTS 0x10
163 #define UMOSCOM_MSR_RTS 0x20
164 #define UMOSCOM_MSR_RI 0x40
165 #define UMOSCOM_MSR_CD 0x80
166
167 #define UMOSCOM_BAUD_REF 115200
168
169 enum {
170 UMOSCOM_BULK_DT_WR,
171 UMOSCOM_BULK_DT_RD,
172 UMOSCOM_INTR_DT_RD,
173 UMOSCOM_N_TRANSFER,
174 };
175
176 struct umoscom_softc {
177 struct ucom_super_softc sc_super_ucom;
178 struct ucom_softc sc_ucom;
179
180 struct usb_xfer *sc_xfer[UMOSCOM_N_TRANSFER];
181 struct usb_device *sc_udev;
182 struct mtx sc_mtx;
183
184 uint8_t sc_mcr;
185 uint8_t sc_lcr;
186 };
187
188 /* prototypes */
189
190 static device_probe_t umoscom_probe;
191 static device_attach_t umoscom_attach;
192 static device_detach_t umoscom_detach;
193 static void umoscom_free_softc(struct umoscom_softc *);
194
195 static usb_callback_t umoscom_write_callback;
196 static usb_callback_t umoscom_read_callback;
197 static usb_callback_t umoscom_intr_callback;
198
199 static void umoscom_free(struct ucom_softc *);
200 static void umoscom_cfg_open(struct ucom_softc *);
201 static void umoscom_cfg_close(struct ucom_softc *);
202 static void umoscom_cfg_set_break(struct ucom_softc *, uint8_t);
203 static void umoscom_cfg_set_dtr(struct ucom_softc *, uint8_t);
204 static void umoscom_cfg_set_rts(struct ucom_softc *, uint8_t);
205 static int umoscom_pre_param(struct ucom_softc *, struct termios *);
206 static void umoscom_cfg_param(struct ucom_softc *, struct termios *);
207 static void umoscom_cfg_get_status(struct ucom_softc *, uint8_t *,
208 uint8_t *);
209 static void umoscom_cfg_write(struct umoscom_softc *, uint16_t, uint16_t);
210 static uint8_t umoscom_cfg_read(struct umoscom_softc *, uint16_t);
211 static void umoscom_start_read(struct ucom_softc *);
212 static void umoscom_stop_read(struct ucom_softc *);
213 static void umoscom_start_write(struct ucom_softc *);
214 static void umoscom_stop_write(struct ucom_softc *);
215 static void umoscom_poll(struct ucom_softc *ucom);
216
217 static const struct usb_config umoscom_config_data[UMOSCOM_N_TRANSFER] = {
218 [UMOSCOM_BULK_DT_WR] = {
219 .type = UE_BULK,
220 .endpoint = UE_ADDR_ANY,
221 .direction = UE_DIR_OUT,
222 .bufsize = UMOSCOM_BUFSIZE,
223 .flags = {.pipe_bof = 1,.force_short_xfer = 1,},
224 .callback = &umoscom_write_callback,
225 },
226
227 [UMOSCOM_BULK_DT_RD] = {
228 .type = UE_BULK,
229 .endpoint = UE_ADDR_ANY,
230 .direction = UE_DIR_IN,
231 .bufsize = UMOSCOM_BUFSIZE,
232 .flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
233 .callback = &umoscom_read_callback,
234 },
235
236 [UMOSCOM_INTR_DT_RD] = {
237 .type = UE_INTERRUPT,
238 .endpoint = UE_ADDR_ANY,
239 .direction = UE_DIR_IN,
240 .flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
241 .bufsize = 0, /* use wMaxPacketSize */
242 .callback = &umoscom_intr_callback,
243 },
244 };
245
246 static const struct ucom_callback umoscom_callback = {
247 /* configuration callbacks */
248 .ucom_cfg_get_status = &umoscom_cfg_get_status,
249 .ucom_cfg_set_dtr = &umoscom_cfg_set_dtr,
250 .ucom_cfg_set_rts = &umoscom_cfg_set_rts,
251 .ucom_cfg_set_break = &umoscom_cfg_set_break,
252 .ucom_cfg_param = &umoscom_cfg_param,
253 .ucom_cfg_open = &umoscom_cfg_open,
254 .ucom_cfg_close = &umoscom_cfg_close,
255
256 /* other callbacks */
257 .ucom_pre_param = &umoscom_pre_param,
258 .ucom_start_read = &umoscom_start_read,
259 .ucom_stop_read = &umoscom_stop_read,
260 .ucom_start_write = &umoscom_start_write,
261 .ucom_stop_write = &umoscom_stop_write,
262 .ucom_poll = &umoscom_poll,
263 .ucom_free = &umoscom_free,
264 };
265
266 static device_method_t umoscom_methods[] = {
267 DEVMETHOD(device_probe, umoscom_probe),
268 DEVMETHOD(device_attach, umoscom_attach),
269 DEVMETHOD(device_detach, umoscom_detach),
270 DEVMETHOD_END
271 };
272
273 static driver_t umoscom_driver = {
274 .name = "umoscom",
275 .methods = umoscom_methods,
276 .size = sizeof(struct umoscom_softc),
277 };
278
279 static const STRUCT_USB_HOST_ID umoscom_devs[] = {
280 {USB_VPI(USB_VENDOR_MOSCHIP, USB_PRODUCT_MOSCHIP_MCS7703, 0)}
281 };
282
283 DRIVER_MODULE(umoscom, uhub, umoscom_driver, NULL, NULL);
284 MODULE_DEPEND(umoscom, ucom, 1, 1, 1);
285 MODULE_DEPEND(umoscom, usb, 1, 1, 1);
286 MODULE_VERSION(umoscom, 1);
287 USB_PNP_HOST_INFO(umoscom_devs);
288
289 static int
290 umoscom_probe(device_t dev)
291 {
292 struct usb_attach_arg *uaa = device_get_ivars(dev);
293
294 if (uaa->usb_mode != USB_MODE_HOST) {
295 return (ENXIO);
296 }
297 if (uaa->info.bConfigIndex != UMOSCOM_CONFIG_INDEX) {
298 return (ENXIO);
299 }
300 if (uaa->info.bIfaceIndex != UMOSCOM_IFACE_INDEX) {
301 return (ENXIO);
302 }
303 return (usbd_lookup_id_by_uaa(umoscom_devs, sizeof(umoscom_devs), uaa));
304 }
305
306 static int
307 umoscom_attach(device_t dev)
308 {
309 struct usb_attach_arg *uaa = device_get_ivars(dev);
310 struct umoscom_softc *sc = device_get_softc(dev);
311 int error;
312 uint8_t iface_index;
313
314 sc->sc_udev = uaa->device;
315 sc->sc_mcr = 0x08; /* enable interrupts */
316
317 /* XXX the device doesn't provide any ID string, so set a static one */
318 device_set_desc(dev, "MOSCHIP USB Serial Port Adapter");
319 device_printf(dev, "<MOSCHIP USB Serial Port Adapter>\n");
320
321 mtx_init(&sc->sc_mtx, "umoscom", NULL, MTX_DEF);
322 ucom_ref(&sc->sc_super_ucom);
323
324 iface_index = UMOSCOM_IFACE_INDEX;
325 error = usbd_transfer_setup(uaa->device, &iface_index,
326 sc->sc_xfer, umoscom_config_data,
327 UMOSCOM_N_TRANSFER, sc, &sc->sc_mtx);
328
329 if (error) {
330 goto detach;
331 }
332 /* clear stall at first run */
333 mtx_lock(&sc->sc_mtx);
334 usbd_xfer_set_stall(sc->sc_xfer[UMOSCOM_BULK_DT_WR]);
335 usbd_xfer_set_stall(sc->sc_xfer[UMOSCOM_BULK_DT_RD]);
336 mtx_unlock(&sc->sc_mtx);
337
338 error = ucom_attach(&sc->sc_super_ucom, &sc->sc_ucom, 1, sc,
339 &umoscom_callback, &sc->sc_mtx);
340 if (error) {
341 goto detach;
342 }
343 ucom_set_pnpinfo_usb(&sc->sc_super_ucom, dev);
344
345 return (0);
346
347 detach:
348 device_printf(dev, "attach error: %s\n", usbd_errstr(error));
349 umoscom_detach(dev);
350 return (ENXIO);
351 }
352
353 static int
354 umoscom_detach(device_t dev)
355 {
356 struct umoscom_softc *sc = device_get_softc(dev);
357
358 ucom_detach(&sc->sc_super_ucom, &sc->sc_ucom);
359 usbd_transfer_unsetup(sc->sc_xfer, UMOSCOM_N_TRANSFER);
360
361 device_claim_softc(dev);
362
363 umoscom_free_softc(sc);
364
365 return (0);
366 }
367
368 UCOM_UNLOAD_DRAIN(umoscom);
369
370 static void
371 umoscom_free_softc(struct umoscom_softc *sc)
372 {
373 if (ucom_unref(&sc->sc_super_ucom)) {
374 mtx_destroy(&sc->sc_mtx);
375 device_free_softc(sc);
376 }
377 }
378
379 static void
380 umoscom_free(struct ucom_softc *ucom)
381 {
382 umoscom_free_softc(ucom->sc_parent);
383 }
384
385 static void
386 umoscom_cfg_open(struct ucom_softc *ucom)
387 {
388 struct umoscom_softc *sc = ucom->sc_parent;
389
390 DPRINTF("\n");
391
392 /* Purge FIFOs or odd things happen */
393 umoscom_cfg_write(sc, UMOSCOM_FIFO, 0x00 | UMOSCOM_UART_REG);
394
395 /* Enable FIFO */
396 umoscom_cfg_write(sc, UMOSCOM_FIFO, UMOSCOM_FIFO_EN |
397 UMOSCOM_FIFO_RXCLR | UMOSCOM_FIFO_TXCLR |
398 UMOSCOM_FIFO_DMA_BLK | UMOSCOM_FIFO_RXLVL_MASK |
399 UMOSCOM_UART_REG);
400
401 /* Enable Interrupt Registers */
402 umoscom_cfg_write(sc, UMOSCOM_INT, 0x0C | UMOSCOM_UART_REG);
403
404 /* Magic */
405 umoscom_cfg_write(sc, 0x01, 0x08);
406
407 /* Magic */
408 umoscom_cfg_write(sc, 0x00, 0x02);
409 }
410
411 static void
412 umoscom_cfg_close(struct ucom_softc *ucom)
413 {
414 return;
415 }
416
417 static void
418 umoscom_cfg_set_break(struct ucom_softc *ucom, uint8_t onoff)
419 {
420 struct umoscom_softc *sc = ucom->sc_parent;
421 uint16_t val;
422
423 val = sc->sc_lcr;
424 if (onoff)
425 val |= UMOSCOM_LCR_BREAK;
426
427 umoscom_cfg_write(sc, UMOSCOM_LCR, val | UMOSCOM_UART_REG);
428 }
429
430 static void
431 umoscom_cfg_set_dtr(struct ucom_softc *ucom, uint8_t onoff)
432 {
433 struct umoscom_softc *sc = ucom->sc_parent;
434
435 if (onoff)
436 sc->sc_mcr |= UMOSCOM_MCR_DTR;
437 else
438 sc->sc_mcr &= ~UMOSCOM_MCR_DTR;
439
440 umoscom_cfg_write(sc, UMOSCOM_MCR, sc->sc_mcr | UMOSCOM_UART_REG);
441 }
442
443 static void
444 umoscom_cfg_set_rts(struct ucom_softc *ucom, uint8_t onoff)
445 {
446 struct umoscom_softc *sc = ucom->sc_parent;
447
448 if (onoff)
449 sc->sc_mcr |= UMOSCOM_MCR_RTS;
450 else
451 sc->sc_mcr &= ~UMOSCOM_MCR_RTS;
452
453 umoscom_cfg_write(sc, UMOSCOM_MCR, sc->sc_mcr | UMOSCOM_UART_REG);
454 }
455
456 static int
457 umoscom_pre_param(struct ucom_softc *ucom, struct termios *t)
458 {
459 if ((t->c_ospeed <= 1) || (t->c_ospeed > 115200))
460 return (EINVAL);
461
462 return (0);
463 }
464
465 static void
466 umoscom_cfg_param(struct ucom_softc *ucom, struct termios *t)
467 {
468 struct umoscom_softc *sc = ucom->sc_parent;
469 uint16_t data;
470
471 DPRINTF("speed=%d\n", t->c_ospeed);
472
473 data = ((uint32_t)UMOSCOM_BAUD_REF) / ((uint32_t)t->c_ospeed);
474
475 if (data == 0) {
476 DPRINTF("invalid baud rate!\n");
477 return;
478 }
479 umoscom_cfg_write(sc, UMOSCOM_LCR,
480 UMOSCOM_LCR_DIVLATCH_EN | UMOSCOM_UART_REG);
481
482 umoscom_cfg_write(sc, UMOSCOM_BAUDLO,
483 (data & 0xFF) | UMOSCOM_UART_REG);
484
485 umoscom_cfg_write(sc, UMOSCOM_BAUDHI,
486 ((data >> 8) & 0xFF) | UMOSCOM_UART_REG);
487
488 if (t->c_cflag & CSTOPB)
489 data = UMOSCOM_LCR_STOP_BITS_2;
490 else
491 data = UMOSCOM_LCR_STOP_BITS_1;
492
493 if (t->c_cflag & PARENB) {
494 if (t->c_cflag & PARODD)
495 data |= UMOSCOM_LCR_PARITY_ODD;
496 else
497 data |= UMOSCOM_LCR_PARITY_EVEN;
498 } else
499 data |= UMOSCOM_LCR_PARITY_NONE;
500
501 switch (t->c_cflag & CSIZE) {
502 case CS5:
503 data |= UMOSCOM_LCR_DBITS(5);
504 break;
505 case CS6:
506 data |= UMOSCOM_LCR_DBITS(6);
507 break;
508 case CS7:
509 data |= UMOSCOM_LCR_DBITS(7);
510 break;
511 case CS8:
512 data |= UMOSCOM_LCR_DBITS(8);
513 break;
514 }
515
516 sc->sc_lcr = data;
517 umoscom_cfg_write(sc, UMOSCOM_LCR, data | UMOSCOM_UART_REG);
518 }
519
520 static void
521 umoscom_cfg_get_status(struct ucom_softc *ucom, uint8_t *p_lsr, uint8_t *p_msr)
522 {
523 struct umoscom_softc *sc = ucom->sc_parent;
524 uint8_t msr;
525
526 DPRINTFN(5, "\n");
527
528 /*
529 * Read status registers. MSR bits need translation from ns16550 to
530 * SER_* values. LSR bits are ns16550 in hardware and ucom.
531 */
532
533 *p_lsr = umoscom_cfg_read(sc, UMOSCOM_LSR);
534 msr = umoscom_cfg_read(sc, UMOSCOM_MSR);
535
536 /* translate bits */
537
538 if (msr & UMOSCOM_MSR_CTS)
539 *p_msr |= SER_CTS;
540
541 if (msr & UMOSCOM_MSR_CD)
542 *p_msr |= SER_DCD;
543
544 if (msr & UMOSCOM_MSR_RI)
545 *p_msr |= SER_RI;
546
547 if (msr & UMOSCOM_MSR_RTS)
548 *p_msr |= SER_DSR;
549 }
550
551 static void
552 umoscom_cfg_write(struct umoscom_softc *sc, uint16_t reg, uint16_t val)
553 {
554 struct usb_device_request req;
555
556 req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
557 req.bRequest = UMOSCOM_WRITE;
558 USETW(req.wValue, val);
559 USETW(req.wIndex, reg);
560 USETW(req.wLength, 0);
561
562 ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom,
563 &req, NULL, 0, 1000);
564 }
565
566 static uint8_t
567 umoscom_cfg_read(struct umoscom_softc *sc, uint16_t reg)
568 {
569 struct usb_device_request req;
570 uint8_t val;
571
572 req.bmRequestType = UT_READ_VENDOR_DEVICE;
573 req.bRequest = UMOSCOM_READ;
574 USETW(req.wValue, 0);
575 USETW(req.wIndex, reg);
576 USETW(req.wLength, 1);
577
578 ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom,
579 &req, &val, 0, 1000);
580
581 DPRINTF("reg=0x%04x, val=0x%02x\n", reg, val);
582
583 return (val);
584 }
585
586 static void
587 umoscom_start_read(struct ucom_softc *ucom)
588 {
589 struct umoscom_softc *sc = ucom->sc_parent;
590
591 #if 0
592 /* start interrupt endpoint */
593 usbd_transfer_start(sc->sc_xfer[UMOSCOM_INTR_DT_RD]);
594 #endif
595 /* start read endpoint */
596 usbd_transfer_start(sc->sc_xfer[UMOSCOM_BULK_DT_RD]);
597 }
598
599 static void
600 umoscom_stop_read(struct ucom_softc *ucom)
601 {
602 struct umoscom_softc *sc = ucom->sc_parent;
603
604 /* stop interrupt transfer */
605 usbd_transfer_stop(sc->sc_xfer[UMOSCOM_INTR_DT_RD]);
606
607 /* stop read endpoint */
608 usbd_transfer_stop(sc->sc_xfer[UMOSCOM_BULK_DT_RD]);
609 }
610
611 static void
612 umoscom_start_write(struct ucom_softc *ucom)
613 {
614 struct umoscom_softc *sc = ucom->sc_parent;
615
616 usbd_transfer_start(sc->sc_xfer[UMOSCOM_BULK_DT_WR]);
617 }
618
619 static void
620 umoscom_stop_write(struct ucom_softc *ucom)
621 {
622 struct umoscom_softc *sc = ucom->sc_parent;
623
624 usbd_transfer_stop(sc->sc_xfer[UMOSCOM_BULK_DT_WR]);
625 }
626
627 static void
628 umoscom_write_callback(struct usb_xfer *xfer, usb_error_t error)
629 {
630 struct umoscom_softc *sc = usbd_xfer_softc(xfer);
631 struct usb_page_cache *pc;
632 uint32_t actlen;
633
634 switch (USB_GET_STATE(xfer)) {
635 case USB_ST_SETUP:
636 case USB_ST_TRANSFERRED:
637 tr_setup:
638 DPRINTF("\n");
639
640 pc = usbd_xfer_get_frame(xfer, 0);
641 if (ucom_get_data(&sc->sc_ucom, pc, 0,
642 UMOSCOM_BUFSIZE, &actlen)) {
643 usbd_xfer_set_frame_len(xfer, 0, actlen);
644 usbd_transfer_submit(xfer);
645 }
646 return;
647
648 default: /* Error */
649 if (error != USB_ERR_CANCELLED) {
650 DPRINTFN(0, "transfer failed\n");
651 /* try to clear stall first */
652 usbd_xfer_set_stall(xfer);
653 goto tr_setup;
654 }
655 return;
656 }
657 }
658
659 static void
660 umoscom_read_callback(struct usb_xfer *xfer, usb_error_t error)
661 {
662 struct umoscom_softc *sc = usbd_xfer_softc(xfer);
663 struct usb_page_cache *pc;
664 int actlen;
665
666 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
667
668 switch (USB_GET_STATE(xfer)) {
669 case USB_ST_TRANSFERRED:
670 DPRINTF("got %d bytes\n", actlen);
671 pc = usbd_xfer_get_frame(xfer, 0);
672 ucom_put_data(&sc->sc_ucom, pc, 0, actlen);
673
674 case USB_ST_SETUP:
675 tr_setup:
676 DPRINTF("\n");
677
678 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
679 usbd_transfer_submit(xfer);
680 return;
681
682 default: /* Error */
683 if (error != USB_ERR_CANCELLED) {
684 DPRINTFN(0, "transfer failed\n");
685 /* try to clear stall first */
686 usbd_xfer_set_stall(xfer);
687 goto tr_setup;
688 }
689 return;
690 }
691 }
692
693 static void
694 umoscom_intr_callback(struct usb_xfer *xfer, usb_error_t error)
695 {
696 struct umoscom_softc *sc = usbd_xfer_softc(xfer);
697 int actlen;
698
699 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
700
701 switch (USB_GET_STATE(xfer)) {
702 case USB_ST_TRANSFERRED:
703 if (actlen < 2) {
704 DPRINTF("too short message\n");
705 goto tr_setup;
706 }
707 ucom_status_change(&sc->sc_ucom);
708
709 case USB_ST_SETUP:
710 tr_setup:
711 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
712 usbd_transfer_submit(xfer);
713 return;
714
715 default: /* Error */
716 if (error != USB_ERR_CANCELLED) {
717 DPRINTFN(0, "transfer failed\n");
718 /* try to clear stall first */
719 usbd_xfer_set_stall(xfer);
720 goto tr_setup;
721 }
722 return;
723 }
724 }
725
726 static void
727 umoscom_poll(struct ucom_softc *ucom)
728 {
729 struct umoscom_softc *sc = ucom->sc_parent;
730 usbd_transfer_poll(sc->sc_xfer, UMOSCOM_N_TRANSFER);
731 }
Cache object: 5fe9ea7fc91775e17f7e19e90592c556
|