1 #include <sys/cdefs.h>
2 __FBSDID("$FreeBSD$");
3
4 /*-
5 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
6 *
7 * Copyright (c) 2003 Scott Long
8 * All rights reserved.
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 * notice, this list of conditions and the following disclaimer in the
17 * documentation and/or other materials provided with the distribution.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
20 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
23 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 * SUCH DAMAGE.
30 *
31 */
32
33 /*
34 * Driver for the MCT (Magic Control Technology) USB-RS232 Converter.
35 * Based on the superb documentation from the linux mct_u232 driver by
36 * Wolfgang Grandeggar <[email protected]>.
37 * This device smells a lot like the Belkin F5U103, except that it has
38 * suffered some mild brain-damage. This driver is based off of the ubsa.c
39 * driver from Alexander Kabaev <[email protected]>. Merging the two together
40 * might be useful, though the subtle differences might lead to lots of
41 * #ifdef's.
42 */
43
44 /*
45 * NOTE: all function names beginning like "umct_cfg_" can only
46 * be called from within the config thread function !
47 */
48
49 #include <sys/stdint.h>
50 #include <sys/stddef.h>
51 #include <sys/param.h>
52 #include <sys/queue.h>
53 #include <sys/types.h>
54 #include <sys/systm.h>
55 #include <sys/kernel.h>
56 #include <sys/bus.h>
57 #include <sys/module.h>
58 #include <sys/lock.h>
59 #include <sys/mutex.h>
60 #include <sys/condvar.h>
61 #include <sys/sysctl.h>
62 #include <sys/sx.h>
63 #include <sys/unistd.h>
64 #include <sys/callout.h>
65 #include <sys/malloc.h>
66 #include <sys/priv.h>
67
68 #include <dev/usb/usb.h>
69 #include <dev/usb/usbdi.h>
70 #include <dev/usb/usbdi_util.h>
71 #include "usbdevs.h"
72
73 #define USB_DEBUG_VAR usb_debug
74 #include <dev/usb/usb_debug.h>
75 #include <dev/usb/usb_process.h>
76
77 #include <dev/usb/serial/usb_serial.h>
78
79 /* The UMCT advertises the standard 8250 UART registers */
80 #define UMCT_GET_MSR 2 /* Get Modem Status Register */
81 #define UMCT_GET_MSR_SIZE 1
82 #define UMCT_GET_LCR 6 /* Get Line Control Register */
83 #define UMCT_GET_LCR_SIZE 1
84 #define UMCT_SET_BAUD 5 /* Set the Baud Rate Divisor */
85 #define UMCT_SET_BAUD_SIZE 4
86 #define UMCT_SET_LCR 7 /* Set Line Control Register */
87 #define UMCT_SET_LCR_SIZE 1
88 #define UMCT_SET_MCR 10 /* Set Modem Control Register */
89 #define UMCT_SET_MCR_SIZE 1
90
91 #define UMCT_MSR_CTS_CHG 0x01
92 #define UMCT_MSR_DSR_CHG 0x02
93 #define UMCT_MSR_RI_CHG 0x04
94 #define UMCT_MSR_CD_CHG 0x08
95 #define UMCT_MSR_CTS 0x10
96 #define UMCT_MSR_RTS 0x20
97 #define UMCT_MSR_RI 0x40
98 #define UMCT_MSR_CD 0x80
99
100 #define UMCT_INTR_INTERVAL 100
101 #define UMCT_IFACE_INDEX 0
102 #define UMCT_CONFIG_INDEX 0
103
104 enum {
105 UMCT_BULK_DT_WR,
106 UMCT_BULK_DT_RD,
107 UMCT_INTR_DT_RD,
108 UMCT_N_TRANSFER,
109 };
110
111 struct umct_softc {
112 struct ucom_super_softc sc_super_ucom;
113 struct ucom_softc sc_ucom;
114
115 struct usb_device *sc_udev;
116 struct usb_xfer *sc_xfer[UMCT_N_TRANSFER];
117 struct mtx sc_mtx;
118
119 uint32_t sc_unit;
120
121 uint16_t sc_obufsize;
122
123 uint8_t sc_lsr;
124 uint8_t sc_msr;
125 uint8_t sc_lcr;
126 uint8_t sc_mcr;
127 uint8_t sc_iface_no;
128 uint8_t sc_swap_cb;
129 };
130
131 /* prototypes */
132
133 static device_probe_t umct_probe;
134 static device_attach_t umct_attach;
135 static device_detach_t umct_detach;
136 static void umct_free_softc(struct umct_softc *);
137
138 static usb_callback_t umct_intr_callback;
139 static usb_callback_t umct_intr_callback_sub;
140 static usb_callback_t umct_read_callback;
141 static usb_callback_t umct_read_callback_sub;
142 static usb_callback_t umct_write_callback;
143
144 static void umct_cfg_do_request(struct umct_softc *sc, uint8_t request,
145 uint16_t len, uint32_t value);
146 static void umct_free(struct ucom_softc *);
147 static void umct_cfg_get_status(struct ucom_softc *, uint8_t *,
148 uint8_t *);
149 static void umct_cfg_set_break(struct ucom_softc *, uint8_t);
150 static void umct_cfg_set_dtr(struct ucom_softc *, uint8_t);
151 static void umct_cfg_set_rts(struct ucom_softc *, uint8_t);
152 static uint8_t umct_calc_baud(uint32_t);
153 static int umct_pre_param(struct ucom_softc *, struct termios *);
154 static void umct_cfg_param(struct ucom_softc *, struct termios *);
155 static void umct_start_read(struct ucom_softc *);
156 static void umct_stop_read(struct ucom_softc *);
157 static void umct_start_write(struct ucom_softc *);
158 static void umct_stop_write(struct ucom_softc *);
159 static void umct_poll(struct ucom_softc *ucom);
160
161 static const struct usb_config umct_config[UMCT_N_TRANSFER] = {
162 [UMCT_BULK_DT_WR] = {
163 .type = UE_BULK,
164 .endpoint = UE_ADDR_ANY,
165 .direction = UE_DIR_OUT,
166 .bufsize = 0, /* use wMaxPacketSize */
167 .flags = {.pipe_bof = 1,.force_short_xfer = 1,},
168 .callback = &umct_write_callback,
169 },
170
171 [UMCT_BULK_DT_RD] = {
172 .type = UE_INTERRUPT,
173 .endpoint = UE_ADDR_ANY,
174 .direction = UE_DIR_IN,
175 .flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
176 .bufsize = 0, /* use wMaxPacketSize */
177 .callback = &umct_read_callback,
178 .ep_index = 0, /* first interrupt endpoint */
179 },
180
181 [UMCT_INTR_DT_RD] = {
182 .type = UE_INTERRUPT,
183 .endpoint = UE_ADDR_ANY,
184 .direction = UE_DIR_IN,
185 .flags = {.pipe_bof = 1,.short_xfer_ok = 1,},
186 .bufsize = 0, /* use wMaxPacketSize */
187 .callback = &umct_intr_callback,
188 .ep_index = 1, /* second interrupt endpoint */
189 },
190 };
191
192 static const struct ucom_callback umct_callback = {
193 .ucom_cfg_get_status = &umct_cfg_get_status,
194 .ucom_cfg_set_dtr = &umct_cfg_set_dtr,
195 .ucom_cfg_set_rts = &umct_cfg_set_rts,
196 .ucom_cfg_set_break = &umct_cfg_set_break,
197 .ucom_cfg_param = &umct_cfg_param,
198 .ucom_pre_param = &umct_pre_param,
199 .ucom_start_read = &umct_start_read,
200 .ucom_stop_read = &umct_stop_read,
201 .ucom_start_write = &umct_start_write,
202 .ucom_stop_write = &umct_stop_write,
203 .ucom_poll = &umct_poll,
204 .ucom_free = &umct_free,
205 };
206
207 static const STRUCT_USB_HOST_ID umct_devs[] = {
208 {USB_VPI(USB_VENDOR_MCT, USB_PRODUCT_MCT_USB232, 0)},
209 {USB_VPI(USB_VENDOR_MCT, USB_PRODUCT_MCT_SITECOM_USB232, 0)},
210 {USB_VPI(USB_VENDOR_MCT, USB_PRODUCT_MCT_DU_H3SP_USB232, 0)},
211 {USB_VPI(USB_VENDOR_BELKIN, USB_PRODUCT_BELKIN_F5U109, 0)},
212 {USB_VPI(USB_VENDOR_BELKIN, USB_PRODUCT_BELKIN_F5U409, 0)},
213 };
214
215 static device_method_t umct_methods[] = {
216 DEVMETHOD(device_probe, umct_probe),
217 DEVMETHOD(device_attach, umct_attach),
218 DEVMETHOD(device_detach, umct_detach),
219 DEVMETHOD_END
220 };
221
222 static devclass_t umct_devclass;
223
224 static driver_t umct_driver = {
225 .name = "umct",
226 .methods = umct_methods,
227 .size = sizeof(struct umct_softc),
228 };
229
230 DRIVER_MODULE(umct, uhub, umct_driver, umct_devclass, NULL, 0);
231 MODULE_DEPEND(umct, ucom, 1, 1, 1);
232 MODULE_DEPEND(umct, usb, 1, 1, 1);
233 MODULE_VERSION(umct, 1);
234 USB_PNP_HOST_INFO(umct_devs);
235
236 static int
umct_probe(device_t dev)237 umct_probe(device_t dev)
238 {
239 struct usb_attach_arg *uaa = device_get_ivars(dev);
240
241 if (uaa->usb_mode != USB_MODE_HOST) {
242 return (ENXIO);
243 }
244 if (uaa->info.bConfigIndex != UMCT_CONFIG_INDEX) {
245 return (ENXIO);
246 }
247 if (uaa->info.bIfaceIndex != UMCT_IFACE_INDEX) {
248 return (ENXIO);
249 }
250 return (usbd_lookup_id_by_uaa(umct_devs, sizeof(umct_devs), uaa));
251 }
252
253 static int
umct_attach(device_t dev)254 umct_attach(device_t dev)
255 {
256 struct usb_attach_arg *uaa = device_get_ivars(dev);
257 struct umct_softc *sc = device_get_softc(dev);
258 int32_t error;
259 uint16_t maxp;
260 uint8_t iface_index;
261
262 sc->sc_udev = uaa->device;
263 sc->sc_unit = device_get_unit(dev);
264
265 device_set_usb_desc(dev);
266 mtx_init(&sc->sc_mtx, "umct", NULL, MTX_DEF);
267 ucom_ref(&sc->sc_super_ucom);
268
269 sc->sc_iface_no = uaa->info.bIfaceNum;
270
271 iface_index = UMCT_IFACE_INDEX;
272 error = usbd_transfer_setup(uaa->device, &iface_index,
273 sc->sc_xfer, umct_config, UMCT_N_TRANSFER, sc, &sc->sc_mtx);
274
275 if (error) {
276 device_printf(dev, "allocating USB "
277 "transfers failed\n");
278 goto detach;
279 }
280
281 /*
282 * The real bulk-in endpoint is also marked as an interrupt.
283 * The only way to differentiate it from the real interrupt
284 * endpoint is to look at the wMaxPacketSize field.
285 */
286 maxp = usbd_xfer_max_framelen(sc->sc_xfer[UMCT_BULK_DT_RD]);
287 if (maxp == 0x2) {
288 /* guessed wrong - switch around endpoints */
289
290 struct usb_xfer *temp = sc->sc_xfer[UMCT_INTR_DT_RD];
291
292 sc->sc_xfer[UMCT_INTR_DT_RD] = sc->sc_xfer[UMCT_BULK_DT_RD];
293 sc->sc_xfer[UMCT_BULK_DT_RD] = temp;
294 sc->sc_swap_cb = 1;
295 }
296
297 sc->sc_obufsize = usbd_xfer_max_len(sc->sc_xfer[UMCT_BULK_DT_WR]);
298
299 if (uaa->info.idProduct == USB_PRODUCT_MCT_SITECOM_USB232) {
300 if (sc->sc_obufsize > 16) {
301 sc->sc_obufsize = 16;
302 }
303 }
304 error = ucom_attach(&sc->sc_super_ucom, &sc->sc_ucom, 1, sc,
305 &umct_callback, &sc->sc_mtx);
306 if (error) {
307 goto detach;
308 }
309 ucom_set_pnpinfo_usb(&sc->sc_super_ucom, dev);
310
311 return (0); /* success */
312
313 detach:
314 umct_detach(dev);
315 return (ENXIO); /* failure */
316 }
317
318 static int
umct_detach(device_t dev)319 umct_detach(device_t dev)
320 {
321 struct umct_softc *sc = device_get_softc(dev);
322
323 ucom_detach(&sc->sc_super_ucom, &sc->sc_ucom);
324 usbd_transfer_unsetup(sc->sc_xfer, UMCT_N_TRANSFER);
325
326 device_claim_softc(dev);
327
328 umct_free_softc(sc);
329
330 return (0);
331 }
332
333 UCOM_UNLOAD_DRAIN(umct);
334
335 static void
umct_free_softc(struct umct_softc * sc)336 umct_free_softc(struct umct_softc *sc)
337 {
338 if (ucom_unref(&sc->sc_super_ucom)) {
339 mtx_destroy(&sc->sc_mtx);
340 device_free_softc(sc);
341 }
342 }
343
344 static void
umct_free(struct ucom_softc * ucom)345 umct_free(struct ucom_softc *ucom)
346 {
347 umct_free_softc(ucom->sc_parent);
348 }
349
350 static void
umct_cfg_do_request(struct umct_softc * sc,uint8_t request,uint16_t len,uint32_t value)351 umct_cfg_do_request(struct umct_softc *sc, uint8_t request,
352 uint16_t len, uint32_t value)
353 {
354 struct usb_device_request req;
355 usb_error_t err;
356 uint8_t temp[4];
357
358 if (len > 4)
359 len = 4;
360 req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
361 req.bRequest = request;
362 USETW(req.wValue, 0);
363 req.wIndex[0] = sc->sc_iface_no;
364 req.wIndex[1] = 0;
365 USETW(req.wLength, len);
366 USETDW(temp, value);
367
368 err = ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom,
369 &req, temp, 0, 1000);
370 if (err) {
371 DPRINTFN(0, "device request failed, err=%s "
372 "(ignored)\n", usbd_errstr(err));
373 }
374 return;
375 }
376
377 static void
umct_intr_callback_sub(struct usb_xfer * xfer,usb_error_t error)378 umct_intr_callback_sub(struct usb_xfer *xfer, usb_error_t error)
379 {
380 struct umct_softc *sc = usbd_xfer_softc(xfer);
381 struct usb_page_cache *pc;
382 uint8_t buf[2];
383 int actlen;
384
385 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
386
387 switch (USB_GET_STATE(xfer)) {
388 case USB_ST_TRANSFERRED:
389 if (actlen < 2) {
390 DPRINTF("too short message\n");
391 goto tr_setup;
392 }
393 pc = usbd_xfer_get_frame(xfer, 0);
394 usbd_copy_out(pc, 0, buf, sizeof(buf));
395
396 /*
397 * MSR bits need translation from ns16550 to SER_* values.
398 * LSR bits are ns16550 in hardware and ucom.
399 */
400 sc->sc_msr = 0;
401 if (buf[0] & UMCT_MSR_CTS)
402 sc->sc_msr |= SER_CTS;
403 if (buf[0] & UMCT_MSR_CD)
404 sc->sc_msr |= SER_DCD;
405 if (buf[0] & UMCT_MSR_RI)
406 sc->sc_msr |= SER_RI;
407 if (buf[0] & UMCT_MSR_RTS)
408 sc->sc_msr |= SER_DSR;
409 sc->sc_lsr = buf[1];
410
411 ucom_status_change(&sc->sc_ucom);
412 /* FALLTHROUGH */
413 case USB_ST_SETUP:
414 tr_setup:
415 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
416 usbd_transfer_submit(xfer);
417 return;
418
419 default: /* Error */
420 if (error != USB_ERR_CANCELLED) {
421 /* try to clear stall first */
422 usbd_xfer_set_stall(xfer);
423 goto tr_setup;
424 }
425 return;
426 }
427 }
428
429 static void
umct_cfg_get_status(struct ucom_softc * ucom,uint8_t * lsr,uint8_t * msr)430 umct_cfg_get_status(struct ucom_softc *ucom, uint8_t *lsr, uint8_t *msr)
431 {
432 struct umct_softc *sc = ucom->sc_parent;
433
434 *lsr = sc->sc_lsr;
435 *msr = sc->sc_msr;
436 }
437
438 static void
umct_cfg_set_break(struct ucom_softc * ucom,uint8_t onoff)439 umct_cfg_set_break(struct ucom_softc *ucom, uint8_t onoff)
440 {
441 struct umct_softc *sc = ucom->sc_parent;
442
443 if (onoff)
444 sc->sc_lcr |= 0x40;
445 else
446 sc->sc_lcr &= ~0x40;
447
448 umct_cfg_do_request(sc, UMCT_SET_LCR, UMCT_SET_LCR_SIZE, sc->sc_lcr);
449 }
450
451 static void
umct_cfg_set_dtr(struct ucom_softc * ucom,uint8_t onoff)452 umct_cfg_set_dtr(struct ucom_softc *ucom, uint8_t onoff)
453 {
454 struct umct_softc *sc = ucom->sc_parent;
455
456 if (onoff)
457 sc->sc_mcr |= 0x01;
458 else
459 sc->sc_mcr &= ~0x01;
460
461 umct_cfg_do_request(sc, UMCT_SET_MCR, UMCT_SET_MCR_SIZE, sc->sc_mcr);
462 }
463
464 static void
umct_cfg_set_rts(struct ucom_softc * ucom,uint8_t onoff)465 umct_cfg_set_rts(struct ucom_softc *ucom, uint8_t onoff)
466 {
467 struct umct_softc *sc = ucom->sc_parent;
468
469 if (onoff)
470 sc->sc_mcr |= 0x02;
471 else
472 sc->sc_mcr &= ~0x02;
473
474 umct_cfg_do_request(sc, UMCT_SET_MCR, UMCT_SET_MCR_SIZE, sc->sc_mcr);
475 }
476
477 static uint8_t
umct_calc_baud(uint32_t baud)478 umct_calc_baud(uint32_t baud)
479 {
480 switch (baud) {
481 case B300:return (0x1);
482 case B600:
483 return (0x2);
484 case B1200:
485 return (0x3);
486 case B2400:
487 return (0x4);
488 case B4800:
489 return (0x6);
490 case B9600:
491 return (0x8);
492 case B19200:
493 return (0x9);
494 case B38400:
495 return (0xa);
496 case B57600:
497 return (0xb);
498 case 115200:
499 return (0xc);
500 case B0:
501 default:
502 break;
503 }
504 return (0x0);
505 }
506
507 static int
umct_pre_param(struct ucom_softc * ucom,struct termios * t)508 umct_pre_param(struct ucom_softc *ucom, struct termios *t)
509 {
510 return (0); /* we accept anything */
511 }
512
513 static void
umct_cfg_param(struct ucom_softc * ucom,struct termios * t)514 umct_cfg_param(struct ucom_softc *ucom, struct termios *t)
515 {
516 struct umct_softc *sc = ucom->sc_parent;
517 uint32_t value;
518
519 value = umct_calc_baud(t->c_ospeed);
520 umct_cfg_do_request(sc, UMCT_SET_BAUD, UMCT_SET_BAUD_SIZE, value);
521
522 value = (sc->sc_lcr & 0x40);
523
524 switch (t->c_cflag & CSIZE) {
525 case CS5:
526 value |= 0x0;
527 break;
528 case CS6:
529 value |= 0x1;
530 break;
531 case CS7:
532 value |= 0x2;
533 break;
534 default:
535 case CS8:
536 value |= 0x3;
537 break;
538 }
539
540 value |= (t->c_cflag & CSTOPB) ? 0x4 : 0;
541 if (t->c_cflag & PARENB) {
542 value |= 0x8;
543 value |= (t->c_cflag & PARODD) ? 0x0 : 0x10;
544 }
545 /*
546 * XXX There doesn't seem to be a way to tell the device
547 * to use flow control.
548 */
549
550 sc->sc_lcr = value;
551 umct_cfg_do_request(sc, UMCT_SET_LCR, UMCT_SET_LCR_SIZE, value);
552 }
553
554 static void
umct_start_read(struct ucom_softc * ucom)555 umct_start_read(struct ucom_softc *ucom)
556 {
557 struct umct_softc *sc = ucom->sc_parent;
558
559 /* start interrupt endpoint */
560 usbd_transfer_start(sc->sc_xfer[UMCT_INTR_DT_RD]);
561
562 /* start read endpoint */
563 usbd_transfer_start(sc->sc_xfer[UMCT_BULK_DT_RD]);
564 }
565
566 static void
umct_stop_read(struct ucom_softc * ucom)567 umct_stop_read(struct ucom_softc *ucom)
568 {
569 struct umct_softc *sc = ucom->sc_parent;
570
571 /* stop interrupt endpoint */
572 usbd_transfer_stop(sc->sc_xfer[UMCT_INTR_DT_RD]);
573
574 /* stop read endpoint */
575 usbd_transfer_stop(sc->sc_xfer[UMCT_BULK_DT_RD]);
576 }
577
578 static void
umct_start_write(struct ucom_softc * ucom)579 umct_start_write(struct ucom_softc *ucom)
580 {
581 struct umct_softc *sc = ucom->sc_parent;
582
583 usbd_transfer_start(sc->sc_xfer[UMCT_BULK_DT_WR]);
584 }
585
586 static void
umct_stop_write(struct ucom_softc * ucom)587 umct_stop_write(struct ucom_softc *ucom)
588 {
589 struct umct_softc *sc = ucom->sc_parent;
590
591 usbd_transfer_stop(sc->sc_xfer[UMCT_BULK_DT_WR]);
592 }
593
594 static void
umct_read_callback(struct usb_xfer * xfer,usb_error_t error)595 umct_read_callback(struct usb_xfer *xfer, usb_error_t error)
596 {
597 struct umct_softc *sc = usbd_xfer_softc(xfer);
598
599 if (sc->sc_swap_cb)
600 umct_intr_callback_sub(xfer, error);
601 else
602 umct_read_callback_sub(xfer, error);
603 }
604
605 static void
umct_intr_callback(struct usb_xfer * xfer,usb_error_t error)606 umct_intr_callback(struct usb_xfer *xfer, usb_error_t error)
607 {
608 struct umct_softc *sc = usbd_xfer_softc(xfer);
609
610 if (sc->sc_swap_cb)
611 umct_read_callback_sub(xfer, error);
612 else
613 umct_intr_callback_sub(xfer, error);
614 }
615
616 static void
umct_write_callback(struct usb_xfer * xfer,usb_error_t error)617 umct_write_callback(struct usb_xfer *xfer, usb_error_t error)
618 {
619 struct umct_softc *sc = usbd_xfer_softc(xfer);
620 struct usb_page_cache *pc;
621 uint32_t actlen;
622
623 switch (USB_GET_STATE(xfer)) {
624 case USB_ST_SETUP:
625 case USB_ST_TRANSFERRED:
626 tr_setup:
627 pc = usbd_xfer_get_frame(xfer, 0);
628 if (ucom_get_data(&sc->sc_ucom, pc, 0,
629 sc->sc_obufsize, &actlen)) {
630 usbd_xfer_set_frame_len(xfer, 0, actlen);
631 usbd_transfer_submit(xfer);
632 }
633 return;
634
635 default: /* Error */
636 if (error != USB_ERR_CANCELLED) {
637 /* try to clear stall first */
638 usbd_xfer_set_stall(xfer);
639 goto tr_setup;
640 }
641 return;
642 }
643 }
644
645 static void
umct_read_callback_sub(struct usb_xfer * xfer,usb_error_t error)646 umct_read_callback_sub(struct usb_xfer *xfer, usb_error_t error)
647 {
648 struct umct_softc *sc = usbd_xfer_softc(xfer);
649 struct usb_page_cache *pc;
650 int actlen;
651
652 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
653
654 switch (USB_GET_STATE(xfer)) {
655 case USB_ST_TRANSFERRED:
656 pc = usbd_xfer_get_frame(xfer, 0);
657 ucom_put_data(&sc->sc_ucom, pc, 0, actlen);
658
659 case USB_ST_SETUP:
660 tr_setup:
661 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
662 usbd_transfer_submit(xfer);
663 return;
664
665 default: /* Error */
666 if (error != USB_ERR_CANCELLED) {
667 /* try to clear stall first */
668 usbd_xfer_set_stall(xfer);
669 goto tr_setup;
670 }
671 return;
672 }
673 }
674
675 static void
umct_poll(struct ucom_softc * ucom)676 umct_poll(struct ucom_softc *ucom)
677 {
678 struct umct_softc *sc = ucom->sc_parent;
679 usbd_transfer_poll(sc->sc_xfer, UMCT_N_TRANSFER);
680 }
681