1 /* $NetBSD: umodem.c,v 1.45 2002/09/23 05:51:23 simonb Exp $ */ 2 3 #define UFOMA_HANDSFREE 4 /*- 5 * SPDX-License-Identifier: BSD-2-Clause 6 * 7 * Copyright (c) 2005, Takanori Watanabe All rights reserved. 8 * Copyright (c) 2003 M. Warner Losh <imp@FreeBSD.org> 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 * Copyright (c) 1998 The NetBSD Foundation, Inc. 34 * All rights reserved. 35 * 36 * This code is derived from software contributed to The NetBSD Foundation 37 * by Lennart Augustsson (lennart@augustsson.net) at 38 * Carlstedt Research & Technology. 39 * 40 * Redistribution and use in source and binary forms, with or without 41 * modification, are permitted provided that the following conditions 42 * are met: 43 * 1. Redistributions of source code must retain the above copyright 44 * notice, this list of conditions and the following disclaimer. 45 * 2. Redistributions in binary form must reproduce the above copyright 46 * notice, this list of conditions and the following disclaimer in the 47 * documentation and/or other materials provided with the distribution. 48 * 49 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 50 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 51 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 52 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 53 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 54 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 55 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 56 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 57 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 58 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 59 * POSSIBILITY OF SUCH DAMAGE. 60 */ 61 62 /* 63 * Comm Class spec: http://www.usb.org/developers/devclass_docs/usbccs10.pdf 64 * http://www.usb.org/developers/devclass_docs/usbcdc11.pdf 65 */ 66 67 /* 68 * TODO: 69 * - Implement a Call Device for modems without multiplexed commands. 70 */ 71 72 /* 73 * NOTE: all function names beginning like "ufoma_cfg_" can only 74 * be called from within the config thread function ! 75 */ 76 77 #include <sys/stdint.h> 78 #include <sys/stddef.h> 79 #include <sys/param.h> 80 #include <sys/queue.h> 81 #include <sys/types.h> 82 #include <sys/systm.h> 83 #include <sys/kernel.h> 84 #include <sys/bus.h> 85 #include <sys/module.h> 86 #include <sys/lock.h> 87 #include <sys/mutex.h> 88 #include <sys/condvar.h> 89 #include <sys/sysctl.h> 90 #include <sys/sx.h> 91 #include <sys/unistd.h> 92 #include <sys/callout.h> 93 #include <sys/malloc.h> 94 #include <sys/priv.h> 95 #include <sys/sbuf.h> 96 97 #include <dev/usb/usb.h> 98 #include <dev/usb/usbdi.h> 99 #include <dev/usb/usbdi_util.h> 100 #include <dev/usb/usb_cdc.h> 101 #include "usbdevs.h" 102 103 #define USB_DEBUG_VAR usb_debug 104 #include <dev/usb/usb_debug.h> 105 #include <dev/usb/usb_process.h> 106 107 #include <dev/usb/serial/usb_serial.h> 108 109 typedef struct ufoma_mobile_acm_descriptor { 110 uint8_t bFunctionLength; 111 uint8_t bDescriptorType; 112 uint8_t bDescriptorSubtype; 113 uint8_t bType; 114 uint8_t bMode[1]; 115 } __packed usb_mcpc_acm_descriptor; 116 117 #define UISUBCLASS_MCPC 0x88 118 119 #define UDESC_VS_INTERFACE 0x44 120 #define UDESCSUB_MCPC_ACM 0x11 121 122 #define UMCPC_ACM_TYPE_AB1 0x1 123 #define UMCPC_ACM_TYPE_AB2 0x2 124 #define UMCPC_ACM_TYPE_AB5 0x5 125 #define UMCPC_ACM_TYPE_AB6 0x6 126 127 #define UMCPC_ACM_MODE_DEACTIVATED 0x0 128 #define UMCPC_ACM_MODE_MODEM 0x1 129 #define UMCPC_ACM_MODE_ATCOMMAND 0x2 130 #define UMCPC_ACM_MODE_OBEX 0x60 131 #define UMCPC_ACM_MODE_VENDOR1 0xc0 132 #define UMCPC_ACM_MODE_VENDOR2 0xfe 133 #define UMCPC_ACM_MODE_UNLINKED 0xff 134 135 #define UMCPC_CM_MOBILE_ACM 0x0 136 137 #define UMCPC_ACTIVATE_MODE 0x60 138 #define UMCPC_GET_MODETABLE 0x61 139 #define UMCPC_SET_LINK 0x62 140 #define UMCPC_CLEAR_LINK 0x63 141 142 #define UMCPC_REQUEST_ACKNOWLEDGE 0x31 143 144 #define UFOMA_MAX_TIMEOUT 15 /* standard says 10 seconds */ 145 #define UFOMA_CMD_BUF_SIZE 64 /* bytes */ 146 147 #define UFOMA_BULK_BUF_SIZE 1024 /* bytes */ 148 149 enum { 150 UFOMA_CTRL_ENDPT_INTR, 151 UFOMA_CTRL_ENDPT_READ, 152 UFOMA_CTRL_ENDPT_WRITE, 153 UFOMA_CTRL_ENDPT_MAX, 154 }; 155 156 enum { 157 UFOMA_BULK_ENDPT_WRITE, 158 UFOMA_BULK_ENDPT_READ, 159 UFOMA_BULK_ENDPT_MAX, 160 }; 161 162 struct ufoma_softc { 163 struct ucom_super_softc sc_super_ucom; 164 struct ucom_softc sc_ucom; 165 struct cv sc_cv; 166 struct mtx sc_mtx; 167 168 struct usb_xfer *sc_ctrl_xfer[UFOMA_CTRL_ENDPT_MAX]; 169 struct usb_xfer *sc_bulk_xfer[UFOMA_BULK_ENDPT_MAX]; 170 uint8_t *sc_modetable; 171 device_t sc_dev; 172 struct usb_device *sc_udev; 173 174 uint32_t sc_unit; 175 176 uint16_t sc_line; 177 178 uint8_t sc_num_msg; 179 uint8_t sc_nobulk; 180 uint8_t sc_ctrl_iface_no; 181 uint8_t sc_ctrl_iface_index; 182 uint8_t sc_data_iface_no; 183 uint8_t sc_data_iface_index; 184 uint8_t sc_cm_cap; 185 uint8_t sc_acm_cap; 186 uint8_t sc_lsr; 187 uint8_t sc_msr; 188 uint8_t sc_modetoactivate; 189 uint8_t sc_currentmode; 190 }; 191 192 /* prototypes */ 193 194 static device_probe_t ufoma_probe; 195 static device_attach_t ufoma_attach; 196 static device_detach_t ufoma_detach; 197 static void ufoma_free_softc(struct ufoma_softc *); 198 199 static usb_callback_t ufoma_ctrl_read_callback; 200 static usb_callback_t ufoma_ctrl_write_callback; 201 static usb_callback_t ufoma_intr_callback; 202 static usb_callback_t ufoma_bulk_write_callback; 203 static usb_callback_t ufoma_bulk_read_callback; 204 205 static void *ufoma_get_intconf(struct usb_config_descriptor *, 206 struct usb_interface_descriptor *, uint8_t, uint8_t); 207 static void ufoma_cfg_link_state(struct ufoma_softc *); 208 static void ufoma_cfg_activate_state(struct ufoma_softc *, uint16_t); 209 static void ufoma_free(struct ucom_softc *); 210 static void ufoma_cfg_open(struct ucom_softc *); 211 static void ufoma_cfg_close(struct ucom_softc *); 212 static void ufoma_cfg_set_break(struct ucom_softc *, uint8_t); 213 static void ufoma_cfg_get_status(struct ucom_softc *, uint8_t *, 214 uint8_t *); 215 static void ufoma_cfg_set_dtr(struct ucom_softc *, uint8_t); 216 static void ufoma_cfg_set_rts(struct ucom_softc *, uint8_t); 217 static int ufoma_pre_param(struct ucom_softc *, struct termios *); 218 static void ufoma_cfg_param(struct ucom_softc *, struct termios *); 219 static int ufoma_modem_setup(device_t, struct ufoma_softc *, 220 struct usb_attach_arg *); 221 static void ufoma_start_read(struct ucom_softc *); 222 static void ufoma_stop_read(struct ucom_softc *); 223 static void ufoma_start_write(struct ucom_softc *); 224 static void ufoma_stop_write(struct ucom_softc *); 225 static void ufoma_poll(struct ucom_softc *ucom); 226 227 /*sysctl stuff*/ 228 static int ufoma_sysctl_support(SYSCTL_HANDLER_ARGS); 229 static int ufoma_sysctl_current(SYSCTL_HANDLER_ARGS); 230 static int ufoma_sysctl_open(SYSCTL_HANDLER_ARGS); 231 232 static const struct usb_config 233 ufoma_ctrl_config[UFOMA_CTRL_ENDPT_MAX] = { 234 [UFOMA_CTRL_ENDPT_INTR] = { 235 .type = UE_INTERRUPT, 236 .endpoint = UE_ADDR_ANY, 237 .direction = UE_DIR_IN, 238 .flags = {.pipe_bof = 1,.short_xfer_ok = 1,}, 239 .bufsize = sizeof(struct usb_cdc_notification), 240 .callback = &ufoma_intr_callback, 241 }, 242 243 [UFOMA_CTRL_ENDPT_READ] = { 244 .type = UE_CONTROL, 245 .endpoint = 0x00, /* Control pipe */ 246 .direction = UE_DIR_ANY, 247 .bufsize = (sizeof(struct usb_device_request) + UFOMA_CMD_BUF_SIZE), 248 .flags = {.short_xfer_ok = 1,}, 249 .callback = &ufoma_ctrl_read_callback, 250 .timeout = 1000, /* 1 second */ 251 }, 252 253 [UFOMA_CTRL_ENDPT_WRITE] = { 254 .type = UE_CONTROL, 255 .endpoint = 0x00, /* Control pipe */ 256 .direction = UE_DIR_ANY, 257 .bufsize = (sizeof(struct usb_device_request) + 1), 258 .callback = &ufoma_ctrl_write_callback, 259 .timeout = 1000, /* 1 second */ 260 }, 261 }; 262 263 static const struct usb_config 264 ufoma_bulk_config[UFOMA_BULK_ENDPT_MAX] = { 265 [UFOMA_BULK_ENDPT_WRITE] = { 266 .type = UE_BULK, 267 .endpoint = UE_ADDR_ANY, 268 .direction = UE_DIR_OUT, 269 .bufsize = UFOMA_BULK_BUF_SIZE, 270 .flags = {.pipe_bof = 1,.force_short_xfer = 1,}, 271 .callback = &ufoma_bulk_write_callback, 272 }, 273 274 [UFOMA_BULK_ENDPT_READ] = { 275 .type = UE_BULK, 276 .endpoint = UE_ADDR_ANY, 277 .direction = UE_DIR_IN, 278 .bufsize = UFOMA_BULK_BUF_SIZE, 279 .flags = {.pipe_bof = 1,.short_xfer_ok = 1,}, 280 .callback = &ufoma_bulk_read_callback, 281 }, 282 }; 283 284 static const struct ucom_callback ufoma_callback = { 285 .ucom_cfg_get_status = &ufoma_cfg_get_status, 286 .ucom_cfg_set_dtr = &ufoma_cfg_set_dtr, 287 .ucom_cfg_set_rts = &ufoma_cfg_set_rts, 288 .ucom_cfg_set_break = &ufoma_cfg_set_break, 289 .ucom_cfg_param = &ufoma_cfg_param, 290 .ucom_cfg_open = &ufoma_cfg_open, 291 .ucom_cfg_close = &ufoma_cfg_close, 292 .ucom_pre_param = &ufoma_pre_param, 293 .ucom_start_read = &ufoma_start_read, 294 .ucom_stop_read = &ufoma_stop_read, 295 .ucom_start_write = &ufoma_start_write, 296 .ucom_stop_write = &ufoma_stop_write, 297 .ucom_poll = &ufoma_poll, 298 .ucom_free = &ufoma_free, 299 }; 300 301 static device_method_t ufoma_methods[] = { 302 /* Device methods */ 303 DEVMETHOD(device_probe, ufoma_probe), 304 DEVMETHOD(device_attach, ufoma_attach), 305 DEVMETHOD(device_detach, ufoma_detach), 306 DEVMETHOD_END 307 }; 308 309 static driver_t ufoma_driver = { 310 .name = "ufoma", 311 .methods = ufoma_methods, 312 .size = sizeof(struct ufoma_softc), 313 }; 314 315 static const STRUCT_USB_HOST_ID ufoma_devs[] = { 316 {USB_IFACE_CLASS(UICLASS_CDC), 317 USB_IFACE_SUBCLASS(UISUBCLASS_MCPC),}, 318 }; 319 320 DRIVER_MODULE(ufoma, uhub, ufoma_driver, NULL, NULL); 321 MODULE_DEPEND(ufoma, ucom, 1, 1, 1); 322 MODULE_DEPEND(ufoma, usb, 1, 1, 1); 323 MODULE_VERSION(ufoma, 1); 324 USB_PNP_HOST_INFO(ufoma_devs); 325 326 static int 327 ufoma_probe(device_t dev) 328 { 329 struct usb_attach_arg *uaa = device_get_ivars(dev); 330 struct usb_interface_descriptor *id; 331 struct usb_config_descriptor *cd; 332 usb_mcpc_acm_descriptor *mad; 333 int error; 334 335 if (uaa->usb_mode != USB_MODE_HOST) 336 return (ENXIO); 337 338 error = usbd_lookup_id_by_uaa(ufoma_devs, sizeof(ufoma_devs), uaa); 339 if (error) 340 return (error); 341 342 id = usbd_get_interface_descriptor(uaa->iface); 343 cd = usbd_get_config_descriptor(uaa->device); 344 345 if (id == NULL || cd == NULL) 346 return (ENXIO); 347 348 mad = ufoma_get_intconf(cd, id, UDESC_VS_INTERFACE, UDESCSUB_MCPC_ACM); 349 if (mad == NULL) 350 return (ENXIO); 351 352 #ifndef UFOMA_HANDSFREE 353 if ((mad->bType == UMCPC_ACM_TYPE_AB5) || 354 (mad->bType == UMCPC_ACM_TYPE_AB6)) 355 return (ENXIO); 356 #endif 357 return (BUS_PROBE_GENERIC); 358 } 359 360 static int 361 ufoma_attach(device_t dev) 362 { 363 struct usb_attach_arg *uaa = device_get_ivars(dev); 364 struct ufoma_softc *sc = device_get_softc(dev); 365 struct usb_config_descriptor *cd; 366 struct usb_interface_descriptor *id; 367 struct sysctl_ctx_list *sctx; 368 struct sysctl_oid *soid; 369 370 usb_mcpc_acm_descriptor *mad; 371 uint8_t elements; 372 int32_t error; 373 374 sc->sc_udev = uaa->device; 375 sc->sc_dev = dev; 376 sc->sc_unit = device_get_unit(dev); 377 378 mtx_init(&sc->sc_mtx, "ufoma", NULL, MTX_DEF); 379 ucom_ref(&sc->sc_super_ucom); 380 cv_init(&sc->sc_cv, "CWAIT"); 381 382 device_set_usb_desc(dev); 383 384 DPRINTF("\n"); 385 386 /* setup control transfers */ 387 388 cd = usbd_get_config_descriptor(uaa->device); 389 id = usbd_get_interface_descriptor(uaa->iface); 390 sc->sc_ctrl_iface_no = id->bInterfaceNumber; 391 sc->sc_ctrl_iface_index = uaa->info.bIfaceIndex; 392 393 error = usbd_transfer_setup(uaa->device, 394 &sc->sc_ctrl_iface_index, sc->sc_ctrl_xfer, 395 ufoma_ctrl_config, UFOMA_CTRL_ENDPT_MAX, sc, &sc->sc_mtx); 396 397 if (error) { 398 device_printf(dev, "allocating control USB " 399 "transfers failed\n"); 400 goto detach; 401 } 402 mad = ufoma_get_intconf(cd, id, UDESC_VS_INTERFACE, UDESCSUB_MCPC_ACM); 403 if (mad == NULL) { 404 goto detach; 405 } 406 if (mad->bFunctionLength < sizeof(*mad)) { 407 device_printf(dev, "invalid MAD descriptor\n"); 408 goto detach; 409 } 410 if ((mad->bType == UMCPC_ACM_TYPE_AB5) || 411 (mad->bType == UMCPC_ACM_TYPE_AB6)) { 412 sc->sc_nobulk = 1; 413 } else { 414 sc->sc_nobulk = 0; 415 if (ufoma_modem_setup(dev, sc, uaa)) { 416 goto detach; 417 } 418 } 419 420 elements = (mad->bFunctionLength - sizeof(*mad) + 1); 421 422 /* initialize mode variables */ 423 424 sc->sc_modetable = malloc(elements + 1, M_USBDEV, M_WAITOK); 425 426 if (sc->sc_modetable == NULL) { 427 goto detach; 428 } 429 sc->sc_modetable[0] = (elements + 1); 430 memcpy(&sc->sc_modetable[1], mad->bMode, elements); 431 432 sc->sc_currentmode = UMCPC_ACM_MODE_UNLINKED; 433 sc->sc_modetoactivate = mad->bMode[0]; 434 435 /* clear stall at first run, if any */ 436 mtx_lock(&sc->sc_mtx); 437 usbd_xfer_set_stall(sc->sc_bulk_xfer[UFOMA_BULK_ENDPT_WRITE]); 438 usbd_xfer_set_stall(sc->sc_bulk_xfer[UFOMA_BULK_ENDPT_READ]); 439 mtx_unlock(&sc->sc_mtx); 440 441 error = ucom_attach(&sc->sc_super_ucom, &sc->sc_ucom, 1, sc, 442 &ufoma_callback, &sc->sc_mtx); 443 if (error) { 444 DPRINTF("ucom_attach failed\n"); 445 goto detach; 446 } 447 ucom_set_pnpinfo_usb(&sc->sc_super_ucom, dev); 448 449 /*Sysctls*/ 450 sctx = device_get_sysctl_ctx(dev); 451 soid = device_get_sysctl_tree(dev); 452 453 SYSCTL_ADD_PROC(sctx, SYSCTL_CHILDREN(soid), OID_AUTO, "supportmode", 454 CTLFLAG_RD | CTLTYPE_STRING | CTLFLAG_MPSAFE, sc, 0, 455 ufoma_sysctl_support, "A", "Supporting port role"); 456 457 SYSCTL_ADD_PROC(sctx, SYSCTL_CHILDREN(soid), OID_AUTO, "currentmode", 458 CTLFLAG_RD | CTLTYPE_STRING | CTLFLAG_MPSAFE, sc, 0, 459 ufoma_sysctl_current, "A", "Current port role"); 460 461 SYSCTL_ADD_PROC(sctx, SYSCTL_CHILDREN(soid), OID_AUTO, "openmode", 462 CTLFLAG_RW | CTLTYPE_STRING | CTLFLAG_MPSAFE, sc, 0, 463 ufoma_sysctl_open, "A", "Mode to transit when port is opened"); 464 SYSCTL_ADD_UINT(sctx, SYSCTL_CHILDREN(soid), OID_AUTO, "comunit", 465 CTLFLAG_RD, &(sc->sc_super_ucom.sc_unit), 0, 466 "Unit number as USB serial"); 467 468 return (0); /* success */ 469 470 detach: 471 ufoma_detach(dev); 472 return (ENXIO); /* failure */ 473 } 474 475 static int 476 ufoma_detach(device_t dev) 477 { 478 struct ufoma_softc *sc = device_get_softc(dev); 479 480 ucom_detach(&sc->sc_super_ucom, &sc->sc_ucom); 481 usbd_transfer_unsetup(sc->sc_ctrl_xfer, UFOMA_CTRL_ENDPT_MAX); 482 usbd_transfer_unsetup(sc->sc_bulk_xfer, UFOMA_BULK_ENDPT_MAX); 483 484 if (sc->sc_modetable) { 485 free(sc->sc_modetable, M_USBDEV); 486 } 487 cv_destroy(&sc->sc_cv); 488 489 device_claim_softc(dev); 490 491 ufoma_free_softc(sc); 492 493 return (0); 494 } 495 496 UCOM_UNLOAD_DRAIN(ufoma); 497 498 static void 499 ufoma_free_softc(struct ufoma_softc *sc) 500 { 501 if (ucom_unref(&sc->sc_super_ucom)) { 502 mtx_destroy(&sc->sc_mtx); 503 device_free_softc(sc); 504 } 505 } 506 507 static void 508 ufoma_free(struct ucom_softc *ucom) 509 { 510 ufoma_free_softc(ucom->sc_parent); 511 } 512 513 static void * 514 ufoma_get_intconf(struct usb_config_descriptor *cd, struct usb_interface_descriptor *id, 515 uint8_t type, uint8_t subtype) 516 { 517 struct usb_descriptor *desc = (void *)id; 518 519 while ((desc = usb_desc_foreach(cd, desc))) { 520 if (desc->bDescriptorType == UDESC_INTERFACE) { 521 return (NULL); 522 } 523 if ((desc->bDescriptorType == type) && 524 (desc->bDescriptorSubtype == subtype)) { 525 break; 526 } 527 } 528 return (desc); 529 } 530 531 static void 532 ufoma_cfg_link_state(struct ufoma_softc *sc) 533 { 534 struct usb_device_request req; 535 int32_t error; 536 537 req.bmRequestType = UT_WRITE_VENDOR_INTERFACE; 538 req.bRequest = UMCPC_SET_LINK; 539 USETW(req.wValue, UMCPC_CM_MOBILE_ACM); 540 USETW(req.wIndex, sc->sc_ctrl_iface_no); 541 USETW(req.wLength, sc->sc_modetable[0]); 542 543 ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom, 544 &req, sc->sc_modetable, 0, 1000); 545 546 error = cv_timedwait(&sc->sc_cv, &sc->sc_mtx, hz); 547 548 if (error) { 549 DPRINTF("NO response\n"); 550 } 551 } 552 553 static void 554 ufoma_cfg_activate_state(struct ufoma_softc *sc, uint16_t state) 555 { 556 struct usb_device_request req; 557 int32_t error; 558 559 req.bmRequestType = UT_WRITE_VENDOR_INTERFACE; 560 req.bRequest = UMCPC_ACTIVATE_MODE; 561 USETW(req.wValue, state); 562 USETW(req.wIndex, sc->sc_ctrl_iface_no); 563 USETW(req.wLength, 0); 564 565 ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom, 566 &req, NULL, 0, 1000); 567 568 error = cv_timedwait(&sc->sc_cv, &sc->sc_mtx, 569 (UFOMA_MAX_TIMEOUT * hz)); 570 if (error) { 571 DPRINTF("No response\n"); 572 } 573 } 574 575 static void 576 ufoma_ctrl_read_callback(struct usb_xfer *xfer, usb_error_t error) 577 { 578 struct ufoma_softc *sc = usbd_xfer_softc(xfer); 579 struct usb_device_request req; 580 struct usb_page_cache *pc0, *pc1; 581 int len, aframes, nframes; 582 583 usbd_xfer_status(xfer, NULL, NULL, &aframes, &nframes); 584 585 switch (USB_GET_STATE(xfer)) { 586 case USB_ST_TRANSFERRED: 587 tr_transferred: 588 if (aframes != nframes) 589 goto tr_setup; 590 pc1 = usbd_xfer_get_frame(xfer, 1); 591 len = usbd_xfer_frame_len(xfer, 1); 592 if (len > 0) 593 ucom_put_data(&sc->sc_ucom, pc1, 0, len); 594 /* FALLTHROUGH */ 595 case USB_ST_SETUP: 596 tr_setup: 597 if (sc->sc_num_msg) { 598 sc->sc_num_msg--; 599 600 req.bmRequestType = UT_READ_CLASS_INTERFACE; 601 req.bRequest = UCDC_GET_ENCAPSULATED_RESPONSE; 602 USETW(req.wIndex, sc->sc_ctrl_iface_no); 603 USETW(req.wValue, 0); 604 USETW(req.wLength, UFOMA_CMD_BUF_SIZE); 605 606 pc0 = usbd_xfer_get_frame(xfer, 0); 607 usbd_copy_in(pc0, 0, &req, sizeof(req)); 608 609 usbd_xfer_set_frame_len(xfer, 0, sizeof(req)); 610 usbd_xfer_set_frame_len(xfer, 1, UFOMA_CMD_BUF_SIZE); 611 usbd_xfer_set_frames(xfer, 2); 612 usbd_transfer_submit(xfer); 613 } 614 return; 615 616 default: /* Error */ 617 DPRINTF("error = %s\n", 618 usbd_errstr(error)); 619 620 if (error == USB_ERR_CANCELLED) { 621 return; 622 } 623 goto tr_transferred; 624 } 625 } 626 627 static void 628 ufoma_ctrl_write_callback(struct usb_xfer *xfer, usb_error_t error) 629 { 630 struct ufoma_softc *sc = usbd_xfer_softc(xfer); 631 struct usb_device_request req; 632 struct usb_page_cache *pc; 633 uint32_t actlen; 634 635 switch (USB_GET_STATE(xfer)) { 636 case USB_ST_TRANSFERRED: 637 tr_transferred: 638 case USB_ST_SETUP: 639 pc = usbd_xfer_get_frame(xfer, 1); 640 if (ucom_get_data(&sc->sc_ucom, pc, 0, 1, &actlen)) { 641 req.bmRequestType = UT_WRITE_CLASS_INTERFACE; 642 req.bRequest = UCDC_SEND_ENCAPSULATED_COMMAND; 643 USETW(req.wIndex, sc->sc_ctrl_iface_no); 644 USETW(req.wValue, 0); 645 USETW(req.wLength, 1); 646 647 pc = usbd_xfer_get_frame(xfer, 0); 648 usbd_copy_in(pc, 0, &req, sizeof(req)); 649 650 usbd_xfer_set_frame_len(xfer, 0, sizeof(req)); 651 usbd_xfer_set_frame_len(xfer, 1, 1); 652 usbd_xfer_set_frames(xfer, 2); 653 654 usbd_transfer_submit(xfer); 655 } 656 return; 657 658 default: /* Error */ 659 DPRINTF("error = %s\n", usbd_errstr(error)); 660 661 if (error == USB_ERR_CANCELLED) { 662 return; 663 } 664 goto tr_transferred; 665 } 666 } 667 668 static void 669 ufoma_intr_callback(struct usb_xfer *xfer, usb_error_t error) 670 { 671 struct ufoma_softc *sc = usbd_xfer_softc(xfer); 672 struct usb_cdc_notification pkt; 673 struct usb_page_cache *pc; 674 uint16_t wLen; 675 uint16_t temp; 676 uint8_t mstatus; 677 int actlen; 678 679 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL); 680 681 switch (USB_GET_STATE(xfer)) { 682 case USB_ST_TRANSFERRED: 683 if (actlen < 8) { 684 DPRINTF("too short message\n"); 685 goto tr_setup; 686 } 687 if (actlen > (int)sizeof(pkt)) { 688 DPRINTF("truncating message\n"); 689 actlen = sizeof(pkt); 690 } 691 pc = usbd_xfer_get_frame(xfer, 0); 692 usbd_copy_out(pc, 0, &pkt, actlen); 693 694 actlen -= 8; 695 696 wLen = UGETW(pkt.wLength); 697 if (actlen > wLen) { 698 actlen = wLen; 699 } 700 if ((pkt.bmRequestType == UT_READ_VENDOR_INTERFACE) && 701 (pkt.bNotification == UMCPC_REQUEST_ACKNOWLEDGE)) { 702 temp = UGETW(pkt.wValue); 703 sc->sc_currentmode = (temp >> 8); 704 if (!(temp & 0xff)) { 705 DPRINTF("Mode change failed!\n"); 706 } 707 cv_signal(&sc->sc_cv); 708 } 709 if (pkt.bmRequestType != UCDC_NOTIFICATION) { 710 goto tr_setup; 711 } 712 switch (pkt.bNotification) { 713 case UCDC_N_RESPONSE_AVAILABLE: 714 if (!(sc->sc_nobulk)) { 715 DPRINTF("Wrong serial state!\n"); 716 break; 717 } 718 if (sc->sc_num_msg != 0xFF) { 719 sc->sc_num_msg++; 720 } 721 usbd_transfer_start(sc->sc_ctrl_xfer[UFOMA_CTRL_ENDPT_READ]); 722 break; 723 724 case UCDC_N_SERIAL_STATE: 725 if (sc->sc_nobulk) { 726 DPRINTF("Wrong serial state!\n"); 727 break; 728 } 729 /* 730 * Set the serial state in ucom driver based on 731 * the bits from the notify message 732 */ 733 if (actlen < 2) { 734 DPRINTF("invalid notification " 735 "length, %d bytes!\n", actlen); 736 break; 737 } 738 DPRINTF("notify bytes = 0x%02x, 0x%02x\n", 739 pkt.data[0], pkt.data[1]); 740 741 /* currently, lsr is always zero. */ 742 sc->sc_lsr = 0; 743 sc->sc_msr = 0; 744 745 mstatus = pkt.data[0]; 746 747 if (mstatus & UCDC_N_SERIAL_RI) { 748 sc->sc_msr |= SER_RI; 749 } 750 if (mstatus & UCDC_N_SERIAL_DSR) { 751 sc->sc_msr |= SER_DSR; 752 } 753 if (mstatus & UCDC_N_SERIAL_DCD) { 754 sc->sc_msr |= SER_DCD; 755 } 756 ucom_status_change(&sc->sc_ucom); 757 break; 758 759 default: 760 break; 761 } 762 763 case USB_ST_SETUP: 764 tr_setup: 765 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer)); 766 usbd_transfer_submit(xfer); 767 return; 768 769 default: /* Error */ 770 if (error != USB_ERR_CANCELLED) { 771 /* try to clear stall first */ 772 usbd_xfer_set_stall(xfer); 773 goto tr_setup; 774 } 775 return; 776 } 777 } 778 779 static void 780 ufoma_bulk_write_callback(struct usb_xfer *xfer, usb_error_t error) 781 { 782 struct ufoma_softc *sc = usbd_xfer_softc(xfer); 783 struct usb_page_cache *pc; 784 uint32_t actlen; 785 786 switch (USB_GET_STATE(xfer)) { 787 case USB_ST_SETUP: 788 case USB_ST_TRANSFERRED: 789 tr_setup: 790 pc = usbd_xfer_get_frame(xfer, 0); 791 if (ucom_get_data(&sc->sc_ucom, pc, 0, 792 UFOMA_BULK_BUF_SIZE, &actlen)) { 793 usbd_xfer_set_frame_len(xfer, 0, actlen); 794 usbd_transfer_submit(xfer); 795 } 796 return; 797 798 default: /* Error */ 799 if (error != USB_ERR_CANCELLED) { 800 /* try to clear stall first */ 801 usbd_xfer_set_stall(xfer); 802 goto tr_setup; 803 } 804 return; 805 } 806 } 807 808 static void 809 ufoma_bulk_read_callback(struct usb_xfer *xfer, usb_error_t error) 810 { 811 struct ufoma_softc *sc = usbd_xfer_softc(xfer); 812 struct usb_page_cache *pc; 813 int actlen; 814 815 usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL); 816 817 switch (USB_GET_STATE(xfer)) { 818 case USB_ST_TRANSFERRED: 819 pc = usbd_xfer_get_frame(xfer, 0); 820 ucom_put_data(&sc->sc_ucom, pc, 0, actlen); 821 822 case USB_ST_SETUP: 823 tr_setup: 824 usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer)); 825 usbd_transfer_submit(xfer); 826 return; 827 828 default: /* Error */ 829 if (error != USB_ERR_CANCELLED) { 830 /* try to clear stall first */ 831 usbd_xfer_set_stall(xfer); 832 goto tr_setup; 833 } 834 return; 835 } 836 } 837 838 static void 839 ufoma_cfg_open(struct ucom_softc *ucom) 840 { 841 struct ufoma_softc *sc = ucom->sc_parent; 842 843 /* empty input queue */ 844 845 if (sc->sc_num_msg != 0xFF) { 846 sc->sc_num_msg++; 847 } 848 if (sc->sc_currentmode == UMCPC_ACM_MODE_UNLINKED) { 849 ufoma_cfg_link_state(sc); 850 } 851 if (sc->sc_currentmode == UMCPC_ACM_MODE_DEACTIVATED) { 852 ufoma_cfg_activate_state(sc, sc->sc_modetoactivate); 853 } 854 } 855 856 static void 857 ufoma_cfg_close(struct ucom_softc *ucom) 858 { 859 struct ufoma_softc *sc = ucom->sc_parent; 860 861 ufoma_cfg_activate_state(sc, UMCPC_ACM_MODE_DEACTIVATED); 862 } 863 864 static void 865 ufoma_cfg_set_break(struct ucom_softc *ucom, uint8_t onoff) 866 { 867 struct ufoma_softc *sc = ucom->sc_parent; 868 struct usb_device_request req; 869 uint16_t wValue; 870 871 if (sc->sc_nobulk || 872 (sc->sc_currentmode == UMCPC_ACM_MODE_OBEX)) { 873 return; 874 } 875 if (!(sc->sc_acm_cap & USB_CDC_ACM_HAS_BREAK)) { 876 return; 877 } 878 wValue = onoff ? UCDC_BREAK_ON : UCDC_BREAK_OFF; 879 880 req.bmRequestType = UT_WRITE_CLASS_INTERFACE; 881 req.bRequest = UCDC_SEND_BREAK; 882 USETW(req.wValue, wValue); 883 req.wIndex[0] = sc->sc_ctrl_iface_no; 884 req.wIndex[1] = 0; 885 USETW(req.wLength, 0); 886 887 ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom, 888 &req, NULL, 0, 1000); 889 } 890 891 static void 892 ufoma_cfg_get_status(struct ucom_softc *ucom, uint8_t *lsr, uint8_t *msr) 893 { 894 struct ufoma_softc *sc = ucom->sc_parent; 895 896 /* XXX Note: sc_lsr is always zero */ 897 *lsr = sc->sc_lsr; 898 *msr = sc->sc_msr; 899 } 900 901 static void 902 ufoma_cfg_set_line_state(struct ufoma_softc *sc) 903 { 904 struct usb_device_request req; 905 906 /* Don't send line state emulation request for OBEX port */ 907 if (sc->sc_currentmode == UMCPC_ACM_MODE_OBEX) { 908 return; 909 } 910 req.bmRequestType = UT_WRITE_CLASS_INTERFACE; 911 req.bRequest = UCDC_SET_CONTROL_LINE_STATE; 912 USETW(req.wValue, sc->sc_line); 913 req.wIndex[0] = sc->sc_ctrl_iface_no; 914 req.wIndex[1] = 0; 915 USETW(req.wLength, 0); 916 917 ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom, 918 &req, NULL, 0, 1000); 919 } 920 921 static void 922 ufoma_cfg_set_dtr(struct ucom_softc *ucom, uint8_t onoff) 923 { 924 struct ufoma_softc *sc = ucom->sc_parent; 925 926 if (sc->sc_nobulk) { 927 return; 928 } 929 if (onoff) 930 sc->sc_line |= UCDC_LINE_DTR; 931 else 932 sc->sc_line &= ~UCDC_LINE_DTR; 933 934 ufoma_cfg_set_line_state(sc); 935 } 936 937 static void 938 ufoma_cfg_set_rts(struct ucom_softc *ucom, uint8_t onoff) 939 { 940 struct ufoma_softc *sc = ucom->sc_parent; 941 942 if (sc->sc_nobulk) { 943 return; 944 } 945 if (onoff) 946 sc->sc_line |= UCDC_LINE_RTS; 947 else 948 sc->sc_line &= ~UCDC_LINE_RTS; 949 950 ufoma_cfg_set_line_state(sc); 951 } 952 953 static int 954 ufoma_pre_param(struct ucom_softc *ucom, struct termios *t) 955 { 956 return (0); /* we accept anything */ 957 } 958 959 static void 960 ufoma_cfg_param(struct ucom_softc *ucom, struct termios *t) 961 { 962 struct ufoma_softc *sc = ucom->sc_parent; 963 struct usb_device_request req; 964 struct usb_cdc_line_state ls; 965 966 if (sc->sc_nobulk || 967 (sc->sc_currentmode == UMCPC_ACM_MODE_OBEX)) { 968 return; 969 } 970 DPRINTF("\n"); 971 972 memset(&ls, 0, sizeof(ls)); 973 974 USETDW(ls.dwDTERate, t->c_ospeed); 975 976 if (t->c_cflag & CSTOPB) { 977 ls.bCharFormat = UCDC_STOP_BIT_2; 978 } else { 979 ls.bCharFormat = UCDC_STOP_BIT_1; 980 } 981 982 if (t->c_cflag & PARENB) { 983 if (t->c_cflag & PARODD) { 984 ls.bParityType = UCDC_PARITY_ODD; 985 } else { 986 ls.bParityType = UCDC_PARITY_EVEN; 987 } 988 } else { 989 ls.bParityType = UCDC_PARITY_NONE; 990 } 991 992 switch (t->c_cflag & CSIZE) { 993 case CS5: 994 ls.bDataBits = 5; 995 break; 996 case CS6: 997 ls.bDataBits = 6; 998 break; 999 case CS7: 1000 ls.bDataBits = 7; 1001 break; 1002 case CS8: 1003 ls.bDataBits = 8; 1004 break; 1005 } 1006 1007 req.bmRequestType = UT_WRITE_CLASS_INTERFACE; 1008 req.bRequest = UCDC_SET_LINE_CODING; 1009 USETW(req.wValue, 0); 1010 req.wIndex[0] = sc->sc_ctrl_iface_no; 1011 req.wIndex[1] = 0; 1012 USETW(req.wLength, UCDC_LINE_STATE_LENGTH); 1013 1014 ucom_cfg_do_request(sc->sc_udev, &sc->sc_ucom, 1015 &req, &ls, 0, 1000); 1016 } 1017 1018 static int 1019 ufoma_modem_setup(device_t dev, struct ufoma_softc *sc, 1020 struct usb_attach_arg *uaa) 1021 { 1022 struct usb_config_descriptor *cd; 1023 struct usb_cdc_acm_descriptor *acm; 1024 struct usb_cdc_cm_descriptor *cmd; 1025 struct usb_interface_descriptor *id; 1026 struct usb_interface *iface; 1027 uint8_t i; 1028 int32_t error; 1029 1030 cd = usbd_get_config_descriptor(uaa->device); 1031 id = usbd_get_interface_descriptor(uaa->iface); 1032 1033 cmd = ufoma_get_intconf(cd, id, UDESC_CS_INTERFACE, UDESCSUB_CDC_CM); 1034 1035 if ((cmd == NULL) || 1036 (cmd->bLength < sizeof(*cmd))) { 1037 return (EINVAL); 1038 } 1039 sc->sc_cm_cap = cmd->bmCapabilities; 1040 sc->sc_data_iface_no = cmd->bDataInterface; 1041 1042 acm = ufoma_get_intconf(cd, id, UDESC_CS_INTERFACE, UDESCSUB_CDC_ACM); 1043 1044 if ((acm == NULL) || 1045 (acm->bLength < sizeof(*acm))) { 1046 return (EINVAL); 1047 } 1048 sc->sc_acm_cap = acm->bmCapabilities; 1049 1050 device_printf(dev, "data interface %d, has %sCM over data, " 1051 "has %sbreak\n", 1052 sc->sc_data_iface_no, 1053 sc->sc_cm_cap & USB_CDC_CM_OVER_DATA ? "" : "no ", 1054 sc->sc_acm_cap & USB_CDC_ACM_HAS_BREAK ? "" : "no "); 1055 1056 /* get the data interface too */ 1057 1058 for (i = 0;; i++) { 1059 iface = usbd_get_iface(uaa->device, i); 1060 1061 if (iface) { 1062 id = usbd_get_interface_descriptor(iface); 1063 1064 if (id && (id->bInterfaceNumber == sc->sc_data_iface_no)) { 1065 sc->sc_data_iface_index = i; 1066 usbd_set_parent_iface(uaa->device, i, uaa->info.bIfaceIndex); 1067 break; 1068 } 1069 } else { 1070 device_printf(dev, "no data interface\n"); 1071 return (EINVAL); 1072 } 1073 } 1074 1075 error = usbd_transfer_setup(uaa->device, 1076 &sc->sc_data_iface_index, sc->sc_bulk_xfer, 1077 ufoma_bulk_config, UFOMA_BULK_ENDPT_MAX, sc, &sc->sc_mtx); 1078 1079 if (error) { 1080 device_printf(dev, "allocating BULK USB " 1081 "transfers failed\n"); 1082 return (EINVAL); 1083 } 1084 return (0); 1085 } 1086 1087 static void 1088 ufoma_start_read(struct ucom_softc *ucom) 1089 { 1090 struct ufoma_softc *sc = ucom->sc_parent; 1091 1092 /* start interrupt transfer */ 1093 usbd_transfer_start(sc->sc_ctrl_xfer[UFOMA_CTRL_ENDPT_INTR]); 1094 1095 /* start data transfer */ 1096 if (sc->sc_nobulk) { 1097 usbd_transfer_start(sc->sc_ctrl_xfer[UFOMA_CTRL_ENDPT_READ]); 1098 } else { 1099 usbd_transfer_start(sc->sc_bulk_xfer[UFOMA_BULK_ENDPT_READ]); 1100 } 1101 } 1102 1103 static void 1104 ufoma_stop_read(struct ucom_softc *ucom) 1105 { 1106 struct ufoma_softc *sc = ucom->sc_parent; 1107 1108 /* stop interrupt transfer */ 1109 usbd_transfer_stop(sc->sc_ctrl_xfer[UFOMA_CTRL_ENDPT_INTR]); 1110 1111 /* stop data transfer */ 1112 if (sc->sc_nobulk) { 1113 usbd_transfer_stop(sc->sc_ctrl_xfer[UFOMA_CTRL_ENDPT_READ]); 1114 } else { 1115 usbd_transfer_stop(sc->sc_bulk_xfer[UFOMA_BULK_ENDPT_READ]); 1116 } 1117 } 1118 1119 static void 1120 ufoma_start_write(struct ucom_softc *ucom) 1121 { 1122 struct ufoma_softc *sc = ucom->sc_parent; 1123 1124 if (sc->sc_nobulk) { 1125 usbd_transfer_start(sc->sc_ctrl_xfer[UFOMA_CTRL_ENDPT_WRITE]); 1126 } else { 1127 usbd_transfer_start(sc->sc_bulk_xfer[UFOMA_BULK_ENDPT_WRITE]); 1128 } 1129 } 1130 1131 static void 1132 ufoma_stop_write(struct ucom_softc *ucom) 1133 { 1134 struct ufoma_softc *sc = ucom->sc_parent; 1135 1136 if (sc->sc_nobulk) { 1137 usbd_transfer_stop(sc->sc_ctrl_xfer[UFOMA_CTRL_ENDPT_WRITE]); 1138 } else { 1139 usbd_transfer_stop(sc->sc_bulk_xfer[UFOMA_BULK_ENDPT_WRITE]); 1140 } 1141 } 1142 1143 static struct umcpc_modetostr_tab{ 1144 int mode; 1145 char *str; 1146 }umcpc_modetostr_tab[]={ 1147 {UMCPC_ACM_MODE_DEACTIVATED, "deactivated"}, 1148 {UMCPC_ACM_MODE_MODEM, "modem"}, 1149 {UMCPC_ACM_MODE_ATCOMMAND, "handsfree"}, 1150 {UMCPC_ACM_MODE_OBEX, "obex"}, 1151 {UMCPC_ACM_MODE_VENDOR1, "vendor1"}, 1152 {UMCPC_ACM_MODE_VENDOR2, "vendor2"}, 1153 {UMCPC_ACM_MODE_UNLINKED, "unlinked"}, 1154 {0, NULL} 1155 }; 1156 1157 static char *ufoma_mode_to_str(int mode) 1158 { 1159 int i; 1160 for(i = 0 ;umcpc_modetostr_tab[i].str != NULL; i++){ 1161 if(umcpc_modetostr_tab[i].mode == mode){ 1162 return umcpc_modetostr_tab[i].str; 1163 } 1164 } 1165 return NULL; 1166 } 1167 1168 static int ufoma_str_to_mode(char *str) 1169 { 1170 int i; 1171 for(i = 0 ;umcpc_modetostr_tab[i].str != NULL; i++){ 1172 if(strcmp(str, umcpc_modetostr_tab[i].str)==0){ 1173 return umcpc_modetostr_tab[i].mode; 1174 } 1175 } 1176 return -1; 1177 } 1178 1179 static int ufoma_sysctl_support(SYSCTL_HANDLER_ARGS) 1180 { 1181 struct ufoma_softc *sc = (struct ufoma_softc *)oidp->oid_arg1; 1182 struct sbuf sb; 1183 int i; 1184 char *mode; 1185 1186 sbuf_new(&sb, NULL, 1, SBUF_AUTOEXTEND); 1187 for(i = 1; i < sc->sc_modetable[0]; i++){ 1188 mode = ufoma_mode_to_str(sc->sc_modetable[i]); 1189 if(mode !=NULL){ 1190 sbuf_cat(&sb, mode); 1191 }else{ 1192 sbuf_printf(&sb, "(%02x)", sc->sc_modetable[i]); 1193 } 1194 if(i < (sc->sc_modetable[0]-1)) 1195 sbuf_cat(&sb, ","); 1196 } 1197 sbuf_trim(&sb); 1198 sbuf_finish(&sb); 1199 sysctl_handle_string(oidp, sbuf_data(&sb), sbuf_len(&sb), req); 1200 sbuf_delete(&sb); 1201 1202 return 0; 1203 } 1204 static int ufoma_sysctl_current(SYSCTL_HANDLER_ARGS) 1205 { 1206 struct ufoma_softc *sc = (struct ufoma_softc *)oidp->oid_arg1; 1207 char *mode; 1208 char subbuf[]="(XXX)"; 1209 mode = ufoma_mode_to_str(sc->sc_currentmode); 1210 if(!mode){ 1211 mode = subbuf; 1212 snprintf(subbuf, sizeof(subbuf), "(%02x)", sc->sc_currentmode); 1213 } 1214 sysctl_handle_string(oidp, mode, strlen(mode), req); 1215 1216 return 0; 1217 1218 } 1219 static int ufoma_sysctl_open(SYSCTL_HANDLER_ARGS) 1220 { 1221 struct ufoma_softc *sc = (struct ufoma_softc *)oidp->oid_arg1; 1222 char *mode; 1223 char subbuf[40]; 1224 int newmode; 1225 int error; 1226 int i; 1227 1228 mode = ufoma_mode_to_str(sc->sc_modetoactivate); 1229 if(mode){ 1230 strncpy(subbuf, mode, sizeof(subbuf)); 1231 }else{ 1232 snprintf(subbuf, sizeof(subbuf), "(%02x)", sc->sc_modetoactivate); 1233 } 1234 error = sysctl_handle_string(oidp, subbuf, sizeof(subbuf), req); 1235 if(error != 0 || req->newptr == NULL){ 1236 return error; 1237 } 1238 1239 if((newmode = ufoma_str_to_mode(subbuf)) == -1){ 1240 return EINVAL; 1241 } 1242 1243 for(i = 1 ; i < sc->sc_modetable[0] ; i++){ 1244 if(sc->sc_modetable[i] == newmode){ 1245 sc->sc_modetoactivate = newmode; 1246 return 0; 1247 } 1248 } 1249 1250 return EINVAL; 1251 } 1252 1253 static void 1254 ufoma_poll(struct ucom_softc *ucom) 1255 { 1256 struct ufoma_softc *sc = ucom->sc_parent; 1257 usbd_transfer_poll(sc->sc_ctrl_xfer, UFOMA_CTRL_ENDPT_MAX); 1258 usbd_transfer_poll(sc->sc_bulk_xfer, UFOMA_BULK_ENDPT_MAX); 1259 } 1260