uslsa.c revision 1.19 1 1.19 reinoud /* $NetBSD: uslsa.c,v 1.19 2014/03/10 19:55:18 reinoud Exp $ */
2 1.9 jakllsch
3 1.9 jakllsch /* from ugensa.c */
4 1.2 xtraeme
5 1.1 dogcow /*
6 1.9 jakllsch * Copyright (c) 2004, 2005 The NetBSD Foundation, Inc.
7 1.1 dogcow * All rights reserved.
8 1.1 dogcow *
9 1.1 dogcow * This code is derived from software contributed to The NetBSD Foundation
10 1.9 jakllsch * by Roland C. Dowdeswell <elric (at) netbsd.org>.
11 1.1 dogcow *
12 1.1 dogcow * Redistribution and use in source and binary forms, with or without
13 1.1 dogcow * modification, are permitted provided that the following conditions
14 1.1 dogcow * are met:
15 1.1 dogcow * 1. Redistributions of source code must retain the above copyright
16 1.1 dogcow * notice, this list of conditions and the following disclaimer.
17 1.1 dogcow * 2. Redistributions in binary form must reproduce the above copyright
18 1.1 dogcow * notice, this list of conditions and the following disclaimer in the
19 1.1 dogcow * documentation and/or other materials provided with the distribution.
20 1.1 dogcow *
21 1.1 dogcow * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
22 1.1 dogcow * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
23 1.1 dogcow * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
24 1.1 dogcow * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
25 1.1 dogcow * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
26 1.1 dogcow * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
27 1.1 dogcow * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
28 1.1 dogcow * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
29 1.1 dogcow * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
30 1.1 dogcow * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
31 1.1 dogcow * POSSIBILITY OF SUCH DAMAGE.
32 1.1 dogcow */
33 1.1 dogcow
34 1.9 jakllsch /*
35 1.9 jakllsch * Copyright (c) 2007, 2009 Jonathan A. Kollasch.
36 1.9 jakllsch * All rights reserved.
37 1.9 jakllsch *
38 1.9 jakllsch * Redistribution and use in source and binary forms, with or without
39 1.9 jakllsch * modification, are permitted provided that the following conditions
40 1.9 jakllsch * are met:
41 1.9 jakllsch * 1. Redistributions of source code must retain the above copyright
42 1.9 jakllsch * notice, this list of conditions and the following disclaimer.
43 1.9 jakllsch * 2. Redistributions in binary form must reproduce the above copyright
44 1.9 jakllsch * notice, this list of conditions and the following disclaimer in the
45 1.9 jakllsch * documentation and/or other materials provided with the distribution.
46 1.9 jakllsch *
47 1.9 jakllsch * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
48 1.9 jakllsch * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
49 1.9 jakllsch * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
50 1.9 jakllsch * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
51 1.9 jakllsch * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
52 1.9 jakllsch * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
53 1.9 jakllsch * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
54 1.9 jakllsch * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
55 1.9 jakllsch * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
56 1.9 jakllsch * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
57 1.9 jakllsch *
58 1.9 jakllsch */
59 1.9 jakllsch
60 1.2 xtraeme #include <sys/cdefs.h>
61 1.19 reinoud __KERNEL_RCSID(0, "$NetBSD: uslsa.c,v 1.19 2014/03/10 19:55:18 reinoud Exp $");
62 1.2 xtraeme
63 1.1 dogcow #include <sys/param.h>
64 1.1 dogcow #include <sys/systm.h>
65 1.1 dogcow #include <sys/kernel.h>
66 1.1 dogcow #include <sys/device.h>
67 1.1 dogcow #include <sys/conf.h>
68 1.1 dogcow #include <sys/tty.h>
69 1.1 dogcow
70 1.1 dogcow #include <dev/usb/usb.h>
71 1.1 dogcow
72 1.1 dogcow #include <dev/usb/usbdi.h>
73 1.1 dogcow #include <dev/usb/usbdi_util.h>
74 1.1 dogcow #include <dev/usb/usbdevs.h>
75 1.1 dogcow
76 1.1 dogcow #include <dev/usb/ucomvar.h>
77 1.1 dogcow
78 1.17 jakllsch #include <dev/usb/uslsareg.h>
79 1.17 jakllsch
80 1.17 jakllsch #include <fs/unicode.h>
81 1.1 dogcow
82 1.1 dogcow #ifdef USLSA_DEBUG
83 1.17 jakllsch #define DPRINTF(x) if (uslsadebug) device_printf x
84 1.1 dogcow int uslsadebug = 0;
85 1.1 dogcow #else
86 1.1 dogcow #define DPRINTF(x)
87 1.1 dogcow #endif
88 1.1 dogcow
89 1.1 dogcow struct uslsa_softc {
90 1.12 dyoung device_t sc_dev; /* base device */
91 1.17 jakllsch device_t sc_subdev; /* ucom device */
92 1.17 jakllsch usbd_device_handle sc_udev; /* usb device */
93 1.1 dogcow usbd_interface_handle sc_iface; /* interface */
94 1.17 jakllsch uint8_t sc_ifnum; /* interface number */
95 1.17 jakllsch bool sc_dying; /* disconnecting */
96 1.1 dogcow };
97 1.1 dogcow
98 1.1 dogcow static void uslsa_get_status(void *sc, int, u_char *, u_char *);
99 1.1 dogcow static void uslsa_set(void *, int, int, int);
100 1.1 dogcow static int uslsa_param(void *, int, struct termios *);
101 1.17 jakllsch static int uslsa_ioctl(void *, int, u_long, void *, int, proc_t *);
102 1.17 jakllsch
103 1.1 dogcow static int uslsa_open(void *, int);
104 1.1 dogcow static void uslsa_close(void *, int);
105 1.1 dogcow
106 1.17 jakllsch static int uslsa_usbd_errno(usbd_status);
107 1.1 dogcow static int uslsa_request_set(struct uslsa_softc *, uint8_t, uint16_t);
108 1.17 jakllsch static int uslsa_set_flow(struct uslsa_softc *, tcflag_t, tcflag_t);
109 1.17 jakllsch
110 1.14 jakllsch static const struct ucom_methods uslsa_methods = {
111 1.1 dogcow uslsa_get_status,
112 1.1 dogcow uslsa_set,
113 1.1 dogcow uslsa_param,
114 1.17 jakllsch uslsa_ioctl,
115 1.1 dogcow uslsa_open,
116 1.1 dogcow uslsa_close,
117 1.1 dogcow NULL,
118 1.1 dogcow NULL,
119 1.1 dogcow };
120 1.1 dogcow
121 1.1 dogcow #define USLSA_CONFIG_INDEX 0
122 1.1 dogcow #define USLSA_IFACE_INDEX 0
123 1.1 dogcow #define USLSA_BUFSIZE 256
124 1.1 dogcow
125 1.1 dogcow static const struct usb_devno uslsa_devs[] = {
126 1.1 dogcow { USB_VENDOR_BALTECH, USB_PRODUCT_BALTECH_CARDREADER },
127 1.1 dogcow { USB_VENDOR_DYNASTREAM, USB_PRODUCT_DYNASTREAM_ANTDEVBOARD },
128 1.1 dogcow { USB_VENDOR_JABLOTRON, USB_PRODUCT_JABLOTRON_PC60B },
129 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_ARGUSISP },
130 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_CRUMB128 },
131 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_DEGREECONT },
132 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_DESKTOPMOBILE },
133 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_IPLINK1220 },
134 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_LIPOWSKY_HARP },
135 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_LIPOWSKY_JTAG },
136 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_LIPOWSKY_LIN },
137 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_POLOLU },
138 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_CP210X_1 },
139 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_CP210X_2 },
140 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_SUNNTO },
141 1.1 dogcow { USB_VENDOR_SILABS2, USB_PRODUCT_SILABS2_DCU11CLONE },
142 1.1 dogcow { USB_VENDOR_USI, USB_PRODUCT_USI_MC60 }
143 1.1 dogcow };
144 1.1 dogcow
145 1.14 jakllsch static int uslsa_match(device_t, cfdata_t, void *);
146 1.14 jakllsch static void uslsa_attach(device_t, device_t, void *);
147 1.14 jakllsch static void uslsa_childdet(device_t, device_t);
148 1.14 jakllsch static int uslsa_detach(device_t, int);
149 1.14 jakllsch static int uslsa_activate(device_t, enum devact);
150 1.14 jakllsch
151 1.8 cube CFATTACH_DECL2_NEW(uslsa, sizeof(struct uslsa_softc), uslsa_match,
152 1.5 dyoung uslsa_attach, uslsa_detach, uslsa_activate, NULL, uslsa_childdet);
153 1.1 dogcow
154 1.17 jakllsch static int
155 1.12 dyoung uslsa_match(device_t parent, cfdata_t match, void *aux)
156 1.1 dogcow {
157 1.17 jakllsch const struct usbif_attach_arg *uaa;
158 1.17 jakllsch
159 1.17 jakllsch uaa = aux;
160 1.1 dogcow
161 1.17 jakllsch if (usb_lookup(uslsa_devs, uaa->vendor, uaa->product) != NULL) {
162 1.17 jakllsch return UMATCH_VENDOR_PRODUCT;
163 1.17 jakllsch } else {
164 1.17 jakllsch return UMATCH_NONE;
165 1.17 jakllsch }
166 1.1 dogcow }
167 1.1 dogcow
168 1.17 jakllsch static void
169 1.12 dyoung uslsa_attach(device_t parent, device_t self, void *aux)
170 1.1 dogcow {
171 1.17 jakllsch struct uslsa_softc *sc;
172 1.17 jakllsch const struct usbif_attach_arg *uaa;
173 1.17 jakllsch const usb_interface_descriptor_t *id;
174 1.17 jakllsch const usb_endpoint_descriptor_t *ed;
175 1.1 dogcow char *devinfop;
176 1.1 dogcow struct ucom_attach_args uca;
177 1.1 dogcow int i;
178 1.1 dogcow
179 1.17 jakllsch sc = device_private(self);
180 1.17 jakllsch uaa = aux;
181 1.17 jakllsch
182 1.8 cube sc->sc_dev = self;
183 1.17 jakllsch sc->sc_udev = uaa->device;
184 1.17 jakllsch sc->sc_iface = uaa->iface;
185 1.1 dogcow
186 1.10 plunky aprint_naive("\n");
187 1.10 plunky aprint_normal("\n");
188 1.10 plunky
189 1.17 jakllsch devinfop = usbd_devinfo_alloc(sc->sc_udev, 0);
190 1.10 plunky aprint_normal_dev(self, "%s\n", devinfop);
191 1.10 plunky usbd_devinfo_free(devinfop);
192 1.10 plunky
193 1.17 jakllsch id = usbd_get_interface_descriptor(sc->sc_iface);
194 1.1 dogcow
195 1.17 jakllsch sc->sc_ifnum = id->bInterfaceNumber;
196 1.1 dogcow
197 1.1 dogcow uca.info = "Silicon Labs CP210x";
198 1.3 nathanw uca.portno = UCOM_UNK_PORTNO;
199 1.1 dogcow uca.ibufsize = USLSA_BUFSIZE;
200 1.1 dogcow uca.obufsize = USLSA_BUFSIZE;
201 1.1 dogcow uca.ibufsizepad = USLSA_BUFSIZE;
202 1.1 dogcow uca.opkthdrlen = 0;
203 1.17 jakllsch uca.device = sc->sc_udev;
204 1.17 jakllsch uca.iface = sc->sc_iface;
205 1.1 dogcow uca.methods = &uslsa_methods;
206 1.1 dogcow uca.arg = sc;
207 1.1 dogcow
208 1.1 dogcow usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev,
209 1.12 dyoung sc->sc_dev);
210 1.1 dogcow
211 1.1 dogcow uca.bulkin = uca.bulkout = -1;
212 1.1 dogcow for (i = 0; i < id->bNumEndpoints; i++) {
213 1.1 dogcow int addr, dir, attr;
214 1.1 dogcow
215 1.17 jakllsch ed = usbd_interface2endpoint_descriptor(sc->sc_iface, i);
216 1.1 dogcow if (ed == NULL) {
217 1.8 cube aprint_error_dev(self,
218 1.17 jakllsch "could not read endpoint descriptor\n");
219 1.17 jakllsch sc->sc_dying = true;
220 1.17 jakllsch return;
221 1.1 dogcow }
222 1.1 dogcow addr = ed->bEndpointAddress;
223 1.1 dogcow dir = UE_GET_DIR(ed->bEndpointAddress);
224 1.1 dogcow attr = ed->bmAttributes & UE_XFERTYPE;
225 1.17 jakllsch if (dir == UE_DIR_IN && attr == UE_BULK) {
226 1.1 dogcow uca.bulkin = addr;
227 1.17 jakllsch } else if (dir == UE_DIR_OUT && attr == UE_BULK) {
228 1.1 dogcow uca.bulkout = addr;
229 1.17 jakllsch } else {
230 1.8 cube aprint_error_dev(self, "unexpected endpoint\n");
231 1.17 jakllsch }
232 1.1 dogcow }
233 1.17 jakllsch aprint_debug_dev(sc->sc_dev, "EPs: in=%#x out=%#x\n",
234 1.17 jakllsch uca.bulkin, uca.bulkout);
235 1.17 jakllsch if ((uca.bulkin == -1) || (uca.bulkout == -1)) {
236 1.17 jakllsch aprint_error_dev(self, "could not find endpoints\n");
237 1.17 jakllsch sc->sc_dying = true;
238 1.17 jakllsch return;
239 1.1 dogcow }
240 1.1 dogcow
241 1.1 dogcow sc->sc_subdev = config_found_sm_loc(self, "ucombus", NULL, &uca,
242 1.1 dogcow ucomprint, ucomsubmatch);
243 1.1 dogcow
244 1.12 dyoung return;
245 1.1 dogcow }
246 1.1 dogcow
247 1.14 jakllsch static int
248 1.5 dyoung uslsa_activate(device_t self, enum devact act)
249 1.1 dogcow {
250 1.5 dyoung struct uslsa_softc *sc = device_private(self);
251 1.1 dogcow
252 1.1 dogcow switch (act) {
253 1.1 dogcow case DVACT_DEACTIVATE:
254 1.17 jakllsch sc->sc_dying = true;
255 1.11 dyoung return 0;
256 1.11 dyoung default:
257 1.11 dyoung return EOPNOTSUPP;
258 1.1 dogcow }
259 1.1 dogcow }
260 1.1 dogcow
261 1.14 jakllsch static void
262 1.5 dyoung uslsa_childdet(device_t self, device_t child)
263 1.5 dyoung {
264 1.5 dyoung struct uslsa_softc *sc = device_private(self);
265 1.5 dyoung
266 1.5 dyoung KASSERT(sc->sc_subdev == child);
267 1.5 dyoung sc->sc_subdev = NULL;
268 1.5 dyoung }
269 1.5 dyoung
270 1.17 jakllsch static int
271 1.12 dyoung uslsa_detach(device_t self, int flags)
272 1.1 dogcow {
273 1.12 dyoung struct uslsa_softc *sc = device_private(self);
274 1.1 dogcow int rv = 0;
275 1.1 dogcow
276 1.17 jakllsch DPRINTF((self, "%s(%p, %#x)\n", __func__, self, flags));
277 1.1 dogcow
278 1.17 jakllsch sc->sc_dying = true;
279 1.1 dogcow
280 1.17 jakllsch if (sc->sc_subdev != NULL) {
281 1.1 dogcow rv = config_detach(sc->sc_subdev, flags);
282 1.17 jakllsch }
283 1.1 dogcow
284 1.1 dogcow usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
285 1.12 dyoung sc->sc_dev);
286 1.1 dogcow
287 1.1 dogcow return (rv);
288 1.1 dogcow }
289 1.1 dogcow
290 1.17 jakllsch static int
291 1.17 jakllsch uslsa_usbd_errno(usbd_status status)
292 1.17 jakllsch {
293 1.17 jakllsch switch (status) {
294 1.17 jakllsch case USBD_NORMAL_COMPLETION:
295 1.17 jakllsch return 0;
296 1.17 jakllsch case USBD_STALLED:
297 1.17 jakllsch return EINVAL;
298 1.17 jakllsch default:
299 1.17 jakllsch return EIO;
300 1.17 jakllsch }
301 1.17 jakllsch }
302 1.17 jakllsch
303 1.1 dogcow static void
304 1.1 dogcow uslsa_get_status(void *vsc, int portno, u_char *lsr, u_char *msr)
305 1.1 dogcow {
306 1.1 dogcow struct uslsa_softc *sc;
307 1.1 dogcow usb_device_request_t req;
308 1.17 jakllsch usbd_status status;
309 1.17 jakllsch uint8_t mdmsts;
310 1.1 dogcow
311 1.1 dogcow sc = vsc;
312 1.1 dogcow
313 1.17 jakllsch DPRINTF((sc->sc_dev, "%s(%p, %d, ....)\n", __func__, vsc, portno));
314 1.17 jakllsch
315 1.17 jakllsch if (sc->sc_dying) {
316 1.17 jakllsch return;
317 1.17 jakllsch }
318 1.1 dogcow
319 1.9 jakllsch req.bmRequestType = UT_READ_VENDOR_INTERFACE;
320 1.17 jakllsch req.bRequest = SLSA_R_GET_MDMSTS;
321 1.1 dogcow USETW(req.wValue, 0);
322 1.17 jakllsch USETW(req.wIndex, sc->sc_ifnum);
323 1.17 jakllsch USETW(req.wLength, SLSA_RL_GET_MDMSTS);
324 1.17 jakllsch
325 1.17 jakllsch status = usbd_do_request(sc->sc_udev, &req, &mdmsts);
326 1.17 jakllsch if (status != USBD_NORMAL_COMPLETION) {
327 1.17 jakllsch device_printf(sc->sc_dev, "%s: GET_MDMSTS %s\n",
328 1.17 jakllsch __func__, usbd_errstr(status));
329 1.17 jakllsch return;
330 1.17 jakllsch }
331 1.17 jakllsch
332 1.17 jakllsch DPRINTF((sc->sc_dev, "%s: GET_MDMSTS %#x\n", __func__, mdmsts));
333 1.17 jakllsch
334 1.17 jakllsch if (lsr != NULL) {
335 1.17 jakllsch *lsr = 0;
336 1.17 jakllsch }
337 1.1 dogcow
338 1.17 jakllsch if (msr != NULL) {
339 1.17 jakllsch *msr = 0;
340 1.17 jakllsch *msr |= ISSET(mdmsts, SLSA_MDMSTS_CTS) ? UMSR_CTS : 0;
341 1.17 jakllsch *msr |= ISSET(mdmsts, SLSA_MDMSTS_DSR) ? UMSR_DSR : 0;
342 1.17 jakllsch *msr |= ISSET(mdmsts, SLSA_MDMSTS_RI) ? UMSR_RI : 0;
343 1.17 jakllsch *msr |= ISSET(mdmsts, SLSA_MDMSTS_DCD) ? UMSR_DCD : 0;
344 1.17 jakllsch }
345 1.1 dogcow }
346 1.1 dogcow
347 1.1 dogcow static void
348 1.1 dogcow uslsa_set(void *vsc, int portno, int reg, int onoff)
349 1.1 dogcow {
350 1.1 dogcow struct uslsa_softc *sc;
351 1.1 dogcow
352 1.1 dogcow sc = vsc;
353 1.1 dogcow
354 1.17 jakllsch DPRINTF((sc->sc_dev, "%s(%p, %d, %d, %d)\n", __func__, vsc, portno, reg, onoff));
355 1.17 jakllsch
356 1.17 jakllsch if (sc->sc_dying) {
357 1.17 jakllsch return;
358 1.17 jakllsch }
359 1.1 dogcow
360 1.1 dogcow switch (reg) {
361 1.1 dogcow case UCOM_SET_DTR:
362 1.17 jakllsch if (uslsa_request_set(sc, SLSA_R_SET_MHS,
363 1.17 jakllsch SLSA_RV_SET_MHS_DTR_MASK |
364 1.17 jakllsch (onoff ? SLSA_RV_SET_MHS_DTR : 0))) {
365 1.17 jakllsch device_printf(sc->sc_dev, "SET_MHS/DTR failed\n");
366 1.17 jakllsch }
367 1.1 dogcow break;
368 1.1 dogcow case UCOM_SET_RTS:
369 1.17 jakllsch if (uslsa_request_set(sc, SLSA_R_SET_MHS,
370 1.17 jakllsch SLSA_RV_SET_MHS_RTS_MASK |
371 1.17 jakllsch (onoff ? SLSA_RV_SET_MHS_RTS : 0))) {
372 1.17 jakllsch device_printf(sc->sc_dev, "SET_MHS/RTS failed\n");
373 1.17 jakllsch }
374 1.1 dogcow break;
375 1.1 dogcow case UCOM_SET_BREAK:
376 1.17 jakllsch if (uslsa_request_set(sc, SLSA_R_SET_BREAK,
377 1.17 jakllsch (onoff ? SLSA_RV_SET_BREAK_ENABLE :
378 1.17 jakllsch SLSA_RV_SET_BREAK_DISABLE))) {
379 1.17 jakllsch device_printf(sc->sc_dev, "SET_BREAK failed\n");
380 1.17 jakllsch }
381 1.1 dogcow break;
382 1.1 dogcow default:
383 1.1 dogcow break;
384 1.1 dogcow }
385 1.1 dogcow }
386 1.1 dogcow
387 1.1 dogcow static int
388 1.17 jakllsch uslsa_param(void *vsc, int portno, struct termios *t)
389 1.1 dogcow {
390 1.1 dogcow struct uslsa_softc *sc;
391 1.19 reinoud usb_device_request_t req;
392 1.19 reinoud usbd_status status;
393 1.19 reinoud uint16_t value;
394 1.19 reinoud uint32_t baud;
395 1.17 jakllsch int ret;
396 1.1 dogcow
397 1.1 dogcow sc = vsc;
398 1.1 dogcow
399 1.17 jakllsch DPRINTF((sc->sc_dev, "%s(%p, %d, %p)\n", __func__, vsc, portno, t));
400 1.17 jakllsch
401 1.17 jakllsch if (sc->sc_dying) {
402 1.17 jakllsch return EIO;
403 1.17 jakllsch }
404 1.17 jakllsch
405 1.19 reinoud req.bmRequestType = UT_WRITE_VENDOR_INTERFACE;
406 1.19 reinoud req.bRequest = SLSA_R_SET_BAUDRATE;
407 1.19 reinoud USETW(req.wValue, 0);
408 1.19 reinoud USETW(req.wIndex, sc->sc_ifnum);
409 1.19 reinoud USETW(req.wLength, 4);
410 1.17 jakllsch
411 1.19 reinoud baud = t->c_ospeed;
412 1.19 reinoud status = usbd_do_request(sc->sc_udev, &req, &baud);
413 1.19 reinoud if (status != USBD_NORMAL_COMPLETION) {
414 1.19 reinoud /* fallback method for devices that don't know SET_BAUDRATE */
415 1.19 reinoud /* hope we calculate it right */
416 1.19 reinoud device_printf(sc->sc_dev, "%s: set baudrate %d, failed %s,"
417 1.19 reinoud " using set bauddiv\n",
418 1.19 reinoud __func__, baud, usbd_errstr(status));
419 1.19 reinoud
420 1.19 reinoud value = SLSA_RV_BAUDDIV(t->c_ospeed);
421 1.19 reinoud if ((ret = uslsa_request_set(sc, SLSA_R_SET_BAUDDIV, value)) != 0) {
422 1.19 reinoud device_printf(sc->sc_dev, "%s: SET_BAUDDIV failed\n",
423 1.19 reinoud __func__);
424 1.19 reinoud return ret;
425 1.19 reinoud }
426 1.17 jakllsch }
427 1.17 jakllsch
428 1.17 jakllsch value = 0;
429 1.1 dogcow
430 1.17 jakllsch if (ISSET(t->c_cflag, CSTOPB)) {
431 1.17 jakllsch value |= SLSA_RV_LINE_CTL_STOP_2;
432 1.17 jakllsch } else {
433 1.17 jakllsch value |= SLSA_RV_LINE_CTL_STOP_1;
434 1.17 jakllsch }
435 1.1 dogcow
436 1.1 dogcow if (ISSET(t->c_cflag, PARENB)) {
437 1.17 jakllsch if (ISSET(t->c_cflag, PARODD)) {
438 1.17 jakllsch value |= SLSA_RV_LINE_CTL_PARITY_ODD;
439 1.17 jakllsch } else {
440 1.17 jakllsch value |= SLSA_RV_LINE_CTL_PARITY_EVEN;
441 1.17 jakllsch }
442 1.17 jakllsch } else {
443 1.17 jakllsch value |= SLSA_RV_LINE_CTL_PARITY_NONE;
444 1.17 jakllsch }
445 1.1 dogcow
446 1.1 dogcow switch (ISSET(t->c_cflag, CSIZE)) {
447 1.1 dogcow case CS5:
448 1.17 jakllsch value |= SLSA_RV_LINE_CTL_LEN_5;
449 1.1 dogcow break;
450 1.1 dogcow case CS6:
451 1.17 jakllsch value |= SLSA_RV_LINE_CTL_LEN_6;
452 1.1 dogcow break;
453 1.1 dogcow case CS7:
454 1.17 jakllsch value |= SLSA_RV_LINE_CTL_LEN_7;
455 1.1 dogcow break;
456 1.1 dogcow case CS8:
457 1.17 jakllsch value |= SLSA_RV_LINE_CTL_LEN_8;
458 1.1 dogcow break;
459 1.1 dogcow }
460 1.1 dogcow
461 1.17 jakllsch DPRINTF((sc->sc_dev, "%s: setting LINE_CTL to 0x%x\n",
462 1.17 jakllsch __func__, value));
463 1.17 jakllsch if ((ret = uslsa_request_set(sc, SLSA_R_SET_LINE_CTL, value)) != 0) {
464 1.17 jakllsch device_printf(sc->sc_dev, "SET_LINE_CTL failed\n");
465 1.17 jakllsch return ret;
466 1.17 jakllsch }
467 1.17 jakllsch
468 1.17 jakllsch if ((ret = uslsa_set_flow(sc, t->c_cflag, t->c_iflag)) != 0) {
469 1.17 jakllsch device_printf(sc->sc_dev, "SET_LINE_CTL failed\n");
470 1.17 jakllsch }
471 1.17 jakllsch
472 1.17 jakllsch return ret;
473 1.17 jakllsch }
474 1.17 jakllsch
475 1.17 jakllsch static int
476 1.17 jakllsch uslsa_ioctl(void *vsc, int portno, u_long cmd, void *data, int flag, proc_t *p)
477 1.17 jakllsch {
478 1.17 jakllsch struct uslsa_softc *sc;
479 1.1 dogcow
480 1.17 jakllsch sc = vsc;
481 1.17 jakllsch
482 1.17 jakllsch switch (cmd) {
483 1.17 jakllsch case TIOCMGET:
484 1.17 jakllsch ucom_status_change(device_private(sc->sc_subdev));
485 1.17 jakllsch return EPASSTHROUGH;
486 1.17 jakllsch default:
487 1.17 jakllsch return EPASSTHROUGH;
488 1.17 jakllsch }
489 1.1 dogcow
490 1.1 dogcow return 0;
491 1.1 dogcow }
492 1.1 dogcow
493 1.1 dogcow static int
494 1.1 dogcow uslsa_open(void *vsc, int portno)
495 1.1 dogcow {
496 1.1 dogcow struct uslsa_softc *sc;
497 1.1 dogcow
498 1.1 dogcow sc = vsc;
499 1.1 dogcow
500 1.17 jakllsch DPRINTF((sc->sc_dev, "%s(%p, %d)\n", __func__, vsc, portno));
501 1.1 dogcow
502 1.17 jakllsch if (sc->sc_dying) {
503 1.17 jakllsch return EIO;
504 1.17 jakllsch }
505 1.1 dogcow
506 1.17 jakllsch return uslsa_request_set(sc, SLSA_R_IFC_ENABLE,
507 1.17 jakllsch SLSA_RV_IFC_ENABLE_ENABLE);
508 1.1 dogcow }
509 1.1 dogcow
510 1.14 jakllsch static void
511 1.1 dogcow uslsa_close(void *vsc, int portno)
512 1.1 dogcow {
513 1.1 dogcow struct uslsa_softc *sc;
514 1.1 dogcow
515 1.1 dogcow sc = vsc;
516 1.1 dogcow
517 1.17 jakllsch DPRINTF((sc->sc_dev, "%s(%p, %d)\n", __func__, vsc, portno));
518 1.17 jakllsch
519 1.17 jakllsch if (sc->sc_dying) {
520 1.1 dogcow return;
521 1.17 jakllsch }
522 1.1 dogcow
523 1.17 jakllsch (void)uslsa_request_set(sc, SLSA_R_IFC_ENABLE,
524 1.17 jakllsch SLSA_RV_IFC_ENABLE_DISABLE);
525 1.1 dogcow }
526 1.1 dogcow
527 1.1 dogcow static int
528 1.1 dogcow uslsa_request_set(struct uslsa_softc * sc, uint8_t request, uint16_t value)
529 1.1 dogcow {
530 1.1 dogcow usb_device_request_t req;
531 1.17 jakllsch usbd_status status;
532 1.1 dogcow
533 1.9 jakllsch req.bmRequestType = UT_WRITE_VENDOR_INTERFACE;
534 1.1 dogcow req.bRequest = request;
535 1.1 dogcow USETW(req.wValue, value);
536 1.17 jakllsch USETW(req.wIndex, sc->sc_ifnum);
537 1.1 dogcow USETW(req.wLength, 0);
538 1.1 dogcow
539 1.17 jakllsch status = usbd_do_request(sc->sc_udev, &req, NULL);
540 1.17 jakllsch
541 1.17 jakllsch return uslsa_usbd_errno(status);
542 1.1 dogcow }
543 1.1 dogcow
544 1.17 jakllsch static int
545 1.1 dogcow uslsa_set_flow(struct uslsa_softc *sc, tcflag_t cflag, tcflag_t iflag)
546 1.1 dogcow {
547 1.17 jakllsch struct slsa_fcs fcs;
548 1.1 dogcow usb_device_request_t req;
549 1.17 jakllsch uint32_t ulControlHandshake;
550 1.17 jakllsch uint32_t ulFlowReplace;
551 1.17 jakllsch usbd_status status;
552 1.1 dogcow
553 1.17 jakllsch DPRINTF((sc->sc_dev, "%s(%p, %#x, %#x)\n", __func__, sc, cflag, iflag));
554 1.1 dogcow
555 1.9 jakllsch req.bmRequestType = UT_READ_VENDOR_INTERFACE;
556 1.17 jakllsch req.bRequest = SLSA_R_GET_FLOW;
557 1.1 dogcow USETW(req.wValue, 0);
558 1.17 jakllsch USETW(req.wIndex, sc->sc_ifnum);
559 1.17 jakllsch USETW(req.wLength, SLSA_RL_GET_FLOW);
560 1.17 jakllsch
561 1.17 jakllsch status = usbd_do_request(sc->sc_udev, &req, &fcs);
562 1.17 jakllsch if (status != USBD_NORMAL_COMPLETION) {
563 1.17 jakllsch device_printf(sc->sc_dev, "%s: GET_FLOW %s\n",
564 1.17 jakllsch __func__, usbd_errstr(status));
565 1.17 jakllsch return uslsa_usbd_errno(status);
566 1.17 jakllsch }
567 1.1 dogcow
568 1.17 jakllsch ulControlHandshake = le32toh(fcs.ulControlHandshake);
569 1.17 jakllsch ulFlowReplace = le32toh(fcs.ulFlowReplace);
570 1.1 dogcow
571 1.1 dogcow if (ISSET(cflag, CRTSCTS)) {
572 1.17 jakllsch ulControlHandshake =
573 1.17 jakllsch SERIAL_CTS_HANDSHAKE | __SHIFTIN(1, SERIAL_DTR_MASK);
574 1.17 jakllsch ulFlowReplace = __SHIFTIN(2, SERIAL_RTS_MASK);
575 1.1 dogcow } else {
576 1.17 jakllsch ulControlHandshake = __SHIFTIN(1, SERIAL_DTR_MASK);
577 1.17 jakllsch ulFlowReplace = __SHIFTIN(1, SERIAL_RTS_MASK);
578 1.1 dogcow }
579 1.1 dogcow
580 1.17 jakllsch fcs.ulControlHandshake = htole32(ulControlHandshake);
581 1.17 jakllsch fcs.ulFlowReplace = htole32(ulFlowReplace);
582 1.17 jakllsch
583 1.9 jakllsch req.bmRequestType = UT_WRITE_VENDOR_INTERFACE;
584 1.17 jakllsch req.bRequest = SLSA_R_SET_FLOW;
585 1.1 dogcow USETW(req.wValue, 0);
586 1.17 jakllsch USETW(req.wIndex, sc->sc_ifnum);
587 1.17 jakllsch USETW(req.wLength, SLSA_RL_SET_FLOW);
588 1.17 jakllsch
589 1.17 jakllsch status = usbd_do_request(sc->sc_udev, &req, &fcs);
590 1.1 dogcow
591 1.17 jakllsch return uslsa_usbd_errno(status);
592 1.1 dogcow }
593