uslsa.c revision 1.10 1 1.10 plunky /* $NetBSD: uslsa.c,v 1.10 2009/09/23 19:07:19 plunky 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.9 jakllsch /*
61 1.9 jakllsch * Craig Shelley's Linux driver was used for documentation.
62 1.9 jakllsch */
63 1.9 jakllsch
64 1.2 xtraeme #include <sys/cdefs.h>
65 1.10 plunky __KERNEL_RCSID(0, "$NetBSD: uslsa.c,v 1.10 2009/09/23 19:07:19 plunky Exp $");
66 1.2 xtraeme
67 1.1 dogcow #include <sys/param.h>
68 1.1 dogcow #include <sys/systm.h>
69 1.1 dogcow #include <sys/kernel.h>
70 1.1 dogcow #include <sys/device.h>
71 1.1 dogcow #include <sys/conf.h>
72 1.1 dogcow #include <sys/tty.h>
73 1.1 dogcow
74 1.1 dogcow #include <dev/usb/usb.h>
75 1.1 dogcow
76 1.1 dogcow #include <dev/usb/usbdi.h>
77 1.1 dogcow #include <dev/usb/usbdi_util.h>
78 1.1 dogcow #include <dev/usb/usbdevs.h>
79 1.1 dogcow
80 1.1 dogcow #include <dev/usb/ucomvar.h>
81 1.1 dogcow
82 1.1 dogcow #ifdef DEBUG
83 1.1 dogcow #define USLSA_DEBUG
84 1.1 dogcow #endif
85 1.1 dogcow
86 1.1 dogcow #ifdef USLSA_DEBUG
87 1.1 dogcow #define DPRINTF(x) if (uslsadebug) printf x
88 1.1 dogcow #define DPRINTFN(n,x) if (uslsadebug>(n)) printf x
89 1.1 dogcow int uslsadebug = 0;
90 1.1 dogcow #else
91 1.1 dogcow #define DPRINTF(x)
92 1.1 dogcow #define DPRINTFN(n,x)
93 1.1 dogcow #endif
94 1.1 dogcow
95 1.1 dogcow #define USLSA_REQ_SET_STATE 0x00
96 1.1 dogcow
97 1.1 dogcow #define USLSA_REQ_SET_BPS 0x01
98 1.1 dogcow #define USLSA_REQ_GET_BPS 0x02
99 1.1 dogcow
100 1.1 dogcow #define USLSA_REQ_SET_DPS 0x03
101 1.1 dogcow #define USLSA_REQ_GET_DPS 0x04
102 1.1 dogcow
103 1.1 dogcow #define USLSA_REQ_SET_BREAK 0x05
104 1.1 dogcow #define USLSA_REQ_GET_BREAK 0x06
105 1.1 dogcow
106 1.1 dogcow #define USLSA_REQ_SET_FLOW 0x07
107 1.1 dogcow #define USLSA_REQ_GET_FLOW 0x08
108 1.1 dogcow
109 1.1 dogcow #define USLSA_REQ_SET_MODEM 0x13
110 1.1 dogcow #define USLSA_REQ_GET_MODEM 0x14
111 1.1 dogcow
112 1.1 dogcow #define USLSA_REQ_SET_MISC 0x19
113 1.1 dogcow #define USLSA_REQ_GET_MISC 0x20
114 1.1 dogcow
115 1.1 dogcow #define USLSA_STATE_DISABLE 0x0000
116 1.1 dogcow #define USLSA_STATE_ENABLE 0x0001
117 1.1 dogcow
118 1.1 dogcow #define USLSA_BPS(b) (3686400/b)
119 1.1 dogcow
120 1.1 dogcow #define USLSA_DPS_DATA_MASK 0x0f00
121 1.1 dogcow #define USLSA_DPS_DATA_FIVE 0x0500
122 1.1 dogcow #define USLSA_DPS_DATA_SIX 0x0600
123 1.1 dogcow #define USLSA_DPS_DATA_SEVEN 0x0700
124 1.1 dogcow #define USLSA_DPS_DATA_EIGHT 0x0800
125 1.1 dogcow #define USLSA_DPS_DATA_NINE 0x0900
126 1.1 dogcow
127 1.1 dogcow #define USLSA_DPS_PARITY_MASK 0x00f0
128 1.1 dogcow #define USLSA_DPS_PARITY_SPACE 0x0040
129 1.1 dogcow #define USLSA_DPS_PARITY_MARK 0x0030
130 1.1 dogcow #define USLSA_DPS_PARITY_EVEN 0x0020
131 1.1 dogcow #define USLSA_DPS_PARITY_ODD 0x0010
132 1.1 dogcow #define USLSA_DPS_PARITY_NONE 0x0000
133 1.1 dogcow
134 1.1 dogcow #define USLSA_DPS_STOP_MASK 0x000f
135 1.1 dogcow #define USLSA_DPS_STOP_TWO 0x0002
136 1.1 dogcow #define USLSA_DPS_STOP_ONE_FIVE 0x0001
137 1.1 dogcow #define USLSA_DPS_STOP_ONE 0x0000
138 1.1 dogcow
139 1.1 dogcow #define USLSA_BREAK_DISABLE 0x0001
140 1.1 dogcow #define USLSA_BREAK_ENABLE 0x0000
141 1.1 dogcow
142 1.1 dogcow #define USLSA_FLOW_SET_RTS 0x0200
143 1.1 dogcow #define USLSA_FLOW_SET_DTR 0x0100
144 1.1 dogcow #define USLSA_FLOW_MSR_MASK 0x00f0
145 1.1 dogcow #define USLSA_FLOW_MSR_DCD 0x0080
146 1.1 dogcow #define USLSA_FLOW_MSR_RI 0x0040
147 1.1 dogcow #define USLSA_FLOW_MSR_DSR 0x0020
148 1.1 dogcow #define USLSA_FLOW_MSR_CTS 0x0010
149 1.1 dogcow #define USLSA_FLOW_RTS 0x0002
150 1.1 dogcow #define USLSA_FLOW_DTR 0x0001
151 1.1 dogcow
152 1.1 dogcow struct uslsa_softc {
153 1.1 dogcow USBBASEDEVICE sc_dev; /* base device */
154 1.1 dogcow usbd_device_handle sc_udev; /* device */
155 1.1 dogcow usbd_interface_handle sc_iface; /* interface */
156 1.1 dogcow
157 1.5 dyoung device_t sc_subdev; /* ucom device */
158 1.1 dogcow
159 1.1 dogcow u_char sc_dying; /* disconnecting */
160 1.1 dogcow
161 1.1 dogcow u_char sc_lsr; /* local status register */
162 1.1 dogcow u_char sc_msr; /* uslsa status register */
163 1.1 dogcow };
164 1.1 dogcow
165 1.1 dogcow static void uslsa_get_status(void *sc, int, u_char *, u_char *);
166 1.1 dogcow static void uslsa_set(void *, int, int, int);
167 1.1 dogcow static int uslsa_param(void *, int, struct termios *);
168 1.1 dogcow static int uslsa_open(void *, int);
169 1.1 dogcow static void uslsa_close(void *, int);
170 1.1 dogcow
171 1.1 dogcow static int uslsa_request_set(struct uslsa_softc *, uint8_t, uint16_t);
172 1.1 dogcow static void uslsa_set_flow(struct uslsa_softc *, tcflag_t, tcflag_t);
173 1.1 dogcow
174 1.1 dogcow struct ucom_methods uslsa_methods = {
175 1.1 dogcow uslsa_get_status,
176 1.1 dogcow uslsa_set,
177 1.1 dogcow uslsa_param,
178 1.1 dogcow NULL,
179 1.1 dogcow uslsa_open,
180 1.1 dogcow uslsa_close,
181 1.1 dogcow NULL,
182 1.1 dogcow NULL,
183 1.1 dogcow };
184 1.1 dogcow
185 1.1 dogcow #define USLSA_CONFIG_INDEX 0
186 1.1 dogcow #define USLSA_IFACE_INDEX 0
187 1.1 dogcow #define USLSA_BUFSIZE 256
188 1.1 dogcow
189 1.1 dogcow static const struct usb_devno uslsa_devs[] = {
190 1.1 dogcow { USB_VENDOR_BALTECH, USB_PRODUCT_BALTECH_CARDREADER },
191 1.1 dogcow { USB_VENDOR_DYNASTREAM, USB_PRODUCT_DYNASTREAM_ANTDEVBOARD },
192 1.1 dogcow { USB_VENDOR_JABLOTRON, USB_PRODUCT_JABLOTRON_PC60B },
193 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_ARGUSISP },
194 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_CRUMB128 },
195 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_DEGREECONT },
196 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_DESKTOPMOBILE },
197 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_IPLINK1220 },
198 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_LIPOWSKY_HARP },
199 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_LIPOWSKY_JTAG },
200 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_LIPOWSKY_LIN },
201 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_POLOLU },
202 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_CP210X_1 },
203 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_CP210X_2 },
204 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_SUNNTO },
205 1.1 dogcow { USB_VENDOR_SILABS2, USB_PRODUCT_SILABS2_DCU11CLONE },
206 1.1 dogcow { USB_VENDOR_USI, USB_PRODUCT_USI_MC60 }
207 1.1 dogcow };
208 1.1 dogcow #define uslsa_lookup(v, p) usb_lookup(uslsa_devs, v, p)
209 1.1 dogcow
210 1.8 cube int uslsa_match(device_t, cfdata_t, void *);
211 1.5 dyoung void uslsa_attach(device_t, device_t, void *);
212 1.5 dyoung void uslsa_childdet(device_t, device_t);
213 1.5 dyoung int uslsa_detach(device_t, int);
214 1.5 dyoung int uslsa_activate(device_t, enum devact);
215 1.5 dyoung extern struct cfdriver uslsa_cd;
216 1.8 cube CFATTACH_DECL2_NEW(uslsa, sizeof(struct uslsa_softc), uslsa_match,
217 1.5 dyoung uslsa_attach, uslsa_detach, uslsa_activate, NULL, uslsa_childdet);
218 1.1 dogcow
219 1.1 dogcow USB_MATCH(uslsa)
220 1.1 dogcow {
221 1.1 dogcow USB_MATCH_START(uslsa, uaa);
222 1.1 dogcow
223 1.1 dogcow return (uslsa_lookup(uaa->vendor, uaa->product) != NULL ?
224 1.1 dogcow UMATCH_VENDOR_PRODUCT : UMATCH_NONE);
225 1.1 dogcow }
226 1.1 dogcow
227 1.1 dogcow USB_ATTACH(uslsa)
228 1.1 dogcow {
229 1.1 dogcow USB_ATTACH_START(uslsa, sc, uaa);
230 1.1 dogcow usbd_device_handle dev = uaa->device;
231 1.1 dogcow usbd_interface_handle iface;
232 1.1 dogcow usb_interface_descriptor_t *id;
233 1.1 dogcow usb_endpoint_descriptor_t *ed;
234 1.1 dogcow char *devinfop;
235 1.1 dogcow usbd_status err;
236 1.1 dogcow struct ucom_attach_args uca;
237 1.1 dogcow int i;
238 1.1 dogcow
239 1.8 cube sc->sc_dev = self;
240 1.1 dogcow
241 1.1 dogcow DPRINTFN(10, ("\nuslsa_attach: sc=%p\n", sc));
242 1.1 dogcow
243 1.10 plunky aprint_naive("\n");
244 1.10 plunky aprint_normal("\n");
245 1.10 plunky
246 1.10 plunky devinfop = usbd_devinfo_alloc(dev, 0);
247 1.10 plunky aprint_normal_dev(self, "%s\n", devinfop);
248 1.10 plunky usbd_devinfo_free(devinfop);
249 1.10 plunky
250 1.1 dogcow /* Move the device into the configured state. */
251 1.1 dogcow err = usbd_set_config_index(dev, USLSA_CONFIG_INDEX, 1);
252 1.1 dogcow if (err) {
253 1.10 plunky aprint_error_dev(self, "failed to set configuration, err=%s\n",
254 1.10 plunky usbd_errstr(err));
255 1.1 dogcow goto bad;
256 1.1 dogcow }
257 1.1 dogcow
258 1.1 dogcow err = usbd_device2interface_handle(dev, USLSA_IFACE_INDEX, &iface);
259 1.1 dogcow if (err) {
260 1.10 plunky aprint_error_dev(self, "failed to get interface, err=%s\n",
261 1.10 plunky usbd_errstr(err));
262 1.1 dogcow goto bad;
263 1.1 dogcow }
264 1.1 dogcow
265 1.1 dogcow id = usbd_get_interface_descriptor(iface);
266 1.1 dogcow
267 1.1 dogcow sc->sc_udev = dev;
268 1.1 dogcow sc->sc_iface = iface;
269 1.1 dogcow
270 1.1 dogcow uca.info = "Silicon Labs CP210x";
271 1.3 nathanw uca.portno = UCOM_UNK_PORTNO;
272 1.1 dogcow uca.ibufsize = USLSA_BUFSIZE;
273 1.1 dogcow uca.obufsize = USLSA_BUFSIZE;
274 1.1 dogcow uca.ibufsizepad = USLSA_BUFSIZE;
275 1.1 dogcow uca.opkthdrlen = 0;
276 1.1 dogcow uca.device = dev;
277 1.1 dogcow uca.iface = iface;
278 1.1 dogcow uca.methods = &uslsa_methods;
279 1.1 dogcow uca.arg = sc;
280 1.1 dogcow
281 1.1 dogcow usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev,
282 1.1 dogcow USBDEV(sc->sc_dev));
283 1.1 dogcow
284 1.1 dogcow uca.bulkin = uca.bulkout = -1;
285 1.1 dogcow for (i = 0; i < id->bNumEndpoints; i++) {
286 1.1 dogcow int addr, dir, attr;
287 1.1 dogcow
288 1.1 dogcow ed = usbd_interface2endpoint_descriptor(iface, i);
289 1.1 dogcow if (ed == NULL) {
290 1.8 cube aprint_error_dev(self,
291 1.8 cube "could not read endpoint descriptor: %s\n",
292 1.8 cube usbd_errstr(err));
293 1.1 dogcow goto bad;
294 1.1 dogcow }
295 1.1 dogcow addr = ed->bEndpointAddress;
296 1.1 dogcow dir = UE_GET_DIR(ed->bEndpointAddress);
297 1.1 dogcow attr = ed->bmAttributes & UE_XFERTYPE;
298 1.1 dogcow if (dir == UE_DIR_IN && attr == UE_BULK)
299 1.1 dogcow uca.bulkin = addr;
300 1.1 dogcow else if (dir == UE_DIR_OUT && attr == UE_BULK)
301 1.1 dogcow uca.bulkout = addr;
302 1.1 dogcow else
303 1.8 cube aprint_error_dev(self, "unexpected endpoint\n");
304 1.1 dogcow }
305 1.1 dogcow if (uca.bulkin == -1) {
306 1.8 cube aprint_error_dev(self, "Could not find data bulk in\n");
307 1.1 dogcow goto bad;
308 1.1 dogcow }
309 1.1 dogcow if (uca.bulkout == -1) {
310 1.8 cube aprint_error_dev(self, "Could not find data bulk out\n");
311 1.1 dogcow goto bad;
312 1.1 dogcow }
313 1.1 dogcow
314 1.1 dogcow DPRINTF(("uslsa: in=0x%x out=0x%x\n", uca.bulkin, uca.bulkout));
315 1.1 dogcow sc->sc_subdev = config_found_sm_loc(self, "ucombus", NULL, &uca,
316 1.1 dogcow ucomprint, ucomsubmatch);
317 1.1 dogcow
318 1.1 dogcow USB_ATTACH_SUCCESS_RETURN;
319 1.1 dogcow
320 1.1 dogcow bad:
321 1.1 dogcow DPRINTF(("uslsa_attach: ATTACH ERROR\n"));
322 1.1 dogcow sc->sc_dying = 1;
323 1.1 dogcow USB_ATTACH_ERROR_RETURN;
324 1.1 dogcow }
325 1.1 dogcow
326 1.1 dogcow int
327 1.5 dyoung uslsa_activate(device_t self, enum devact act)
328 1.1 dogcow {
329 1.5 dyoung struct uslsa_softc *sc = device_private(self);
330 1.1 dogcow int rv = 0;
331 1.1 dogcow
332 1.1 dogcow switch (act) {
333 1.1 dogcow case DVACT_ACTIVATE:
334 1.1 dogcow return (EOPNOTSUPP);
335 1.1 dogcow break;
336 1.1 dogcow
337 1.1 dogcow case DVACT_DEACTIVATE:
338 1.1 dogcow sc->sc_dying = 1;
339 1.1 dogcow if (sc->sc_subdev)
340 1.1 dogcow rv = config_deactivate(sc->sc_subdev);
341 1.1 dogcow break;
342 1.1 dogcow }
343 1.1 dogcow return (rv);
344 1.1 dogcow }
345 1.1 dogcow
346 1.5 dyoung void
347 1.5 dyoung uslsa_childdet(device_t self, device_t child)
348 1.5 dyoung {
349 1.5 dyoung struct uslsa_softc *sc = device_private(self);
350 1.5 dyoung
351 1.5 dyoung KASSERT(sc->sc_subdev == child);
352 1.5 dyoung sc->sc_subdev = NULL;
353 1.5 dyoung }
354 1.5 dyoung
355 1.1 dogcow USB_DETACH(uslsa)
356 1.1 dogcow {
357 1.1 dogcow USB_DETACH_START(uslsa, sc);
358 1.1 dogcow int rv = 0;
359 1.1 dogcow
360 1.1 dogcow DPRINTF(("uslsa_detach: sc=%p flags=%d\n", sc, flags));
361 1.1 dogcow
362 1.1 dogcow sc->sc_dying = 1;
363 1.1 dogcow
364 1.1 dogcow if (sc->sc_subdev != NULL)
365 1.1 dogcow rv = config_detach(sc->sc_subdev, flags);
366 1.1 dogcow
367 1.1 dogcow usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
368 1.1 dogcow USBDEV(sc->sc_dev));
369 1.1 dogcow
370 1.1 dogcow return (rv);
371 1.1 dogcow }
372 1.1 dogcow
373 1.1 dogcow static void
374 1.1 dogcow uslsa_get_status(void *vsc, int portno, u_char *lsr, u_char *msr)
375 1.1 dogcow {
376 1.1 dogcow struct uslsa_softc *sc;
377 1.1 dogcow usb_device_request_t req;
378 1.1 dogcow usbd_status err;
379 1.1 dogcow int actlen;
380 1.1 dogcow uint16_t flowreg;
381 1.1 dogcow
382 1.1 dogcow sc = vsc;
383 1.1 dogcow
384 1.1 dogcow DPRINTF(("uslsa_get_status:\n"));
385 1.1 dogcow
386 1.9 jakllsch req.bmRequestType = UT_READ_VENDOR_INTERFACE;
387 1.1 dogcow req.bRequest = USLSA_REQ_GET_FLOW;
388 1.1 dogcow USETW(req.wValue, 0);
389 1.1 dogcow USETW(req.wIndex, 0);
390 1.1 dogcow USETW(req.wLength, sizeof(flowreg));
391 1.1 dogcow
392 1.1 dogcow err = usbd_do_request_flags(sc->sc_udev, &req, &flowreg,
393 1.1 dogcow USBD_SHORT_XFER_OK, &actlen, USBD_DEFAULT_TIMEOUT);
394 1.1 dogcow if (err)
395 1.1 dogcow printf("%s: uslsa_get_status: %s\n",
396 1.1 dogcow USBDEVNAME(sc->sc_dev), usbd_errstr(err));
397 1.1 dogcow
398 1.1 dogcow DPRINTF(("uslsa_get_status: flowreg=0x%x\n", flowreg));
399 1.1 dogcow
400 1.1 dogcow sc->sc_msr = (u_char)(USLSA_FLOW_MSR_MASK & flowreg);
401 1.1 dogcow
402 1.1 dogcow if (lsr != NULL)
403 1.1 dogcow *lsr = sc->sc_lsr;
404 1.1 dogcow if (msr != NULL)
405 1.1 dogcow *msr = sc->sc_msr;
406 1.1 dogcow }
407 1.1 dogcow
408 1.1 dogcow static void
409 1.1 dogcow uslsa_set(void *vsc, int portno, int reg, int onoff)
410 1.1 dogcow {
411 1.1 dogcow struct uslsa_softc *sc;
412 1.1 dogcow
413 1.1 dogcow sc = vsc;
414 1.1 dogcow
415 1.1 dogcow DPRINTF(("uslsa_set: sc=%p, port=%d reg=%d onoff=%d\n", sc, portno,
416 1.1 dogcow reg, onoff));
417 1.1 dogcow
418 1.1 dogcow switch (reg) {
419 1.1 dogcow case UCOM_SET_DTR:
420 1.1 dogcow if (uslsa_request_set(sc, USLSA_REQ_SET_FLOW,
421 1.1 dogcow (onoff ? (USLSA_FLOW_DTR | USLSA_FLOW_SET_DTR) :
422 1.1 dogcow USLSA_FLOW_SET_DTR)))
423 1.1 dogcow printf("%s: uslsa_set_dtr failed\n",
424 1.1 dogcow USBDEVNAME(sc->sc_dev));
425 1.1 dogcow break;
426 1.1 dogcow case UCOM_SET_RTS:
427 1.1 dogcow if (uslsa_request_set(sc, USLSA_REQ_SET_FLOW,
428 1.1 dogcow (onoff ? (USLSA_FLOW_RTS | USLSA_FLOW_SET_RTS) :
429 1.1 dogcow USLSA_FLOW_SET_RTS)))
430 1.1 dogcow printf("%s: uslsa_set_rts failed\n",
431 1.1 dogcow USBDEVNAME(sc->sc_dev));
432 1.1 dogcow break;
433 1.1 dogcow case UCOM_SET_BREAK:
434 1.1 dogcow if (uslsa_request_set(sc, USLSA_REQ_SET_BREAK,
435 1.1 dogcow (onoff ? USLSA_BREAK_ENABLE :
436 1.1 dogcow USLSA_BREAK_DISABLE)))
437 1.1 dogcow printf("%s: uslsa_set_break failed\n",
438 1.1 dogcow USBDEVNAME(sc->sc_dev));
439 1.1 dogcow break;
440 1.1 dogcow default:
441 1.1 dogcow break;
442 1.1 dogcow }
443 1.1 dogcow }
444 1.1 dogcow
445 1.1 dogcow static int
446 1.1 dogcow uslsa_param(void *vsc, int portno, struct termios * t)
447 1.1 dogcow {
448 1.1 dogcow struct uslsa_softc *sc;
449 1.1 dogcow uint16_t data;
450 1.1 dogcow
451 1.1 dogcow sc = vsc;
452 1.1 dogcow
453 1.1 dogcow DPRINTF(("uslsa_param: sc=%p\n", sc));
454 1.1 dogcow
455 1.1 dogcow switch (t->c_ospeed) {
456 1.1 dogcow case B600:
457 1.1 dogcow case B1200:
458 1.1 dogcow case B2400:
459 1.1 dogcow case B4800:
460 1.1 dogcow case B9600:
461 1.1 dogcow case B19200:
462 1.1 dogcow case B38400:
463 1.1 dogcow case B57600:
464 1.1 dogcow case B115200:
465 1.1 dogcow case B230400:
466 1.1 dogcow case B460800:
467 1.1 dogcow case B921600:
468 1.1 dogcow data = USLSA_BPS(t->c_ospeed);
469 1.1 dogcow break;
470 1.1 dogcow default:
471 1.1 dogcow printf("%s: uslsa_param: unsupported data rate, "
472 1.1 dogcow "forcing default of 115200bps\n",
473 1.1 dogcow USBDEVNAME(sc->sc_dev));
474 1.1 dogcow data = USLSA_BPS(B115200);
475 1.1 dogcow };
476 1.1 dogcow
477 1.1 dogcow if (uslsa_request_set(sc, USLSA_REQ_SET_BPS, data))
478 1.1 dogcow printf("%s: uslsa_param: setting data rate failed\n",
479 1.1 dogcow USBDEVNAME(sc->sc_dev));
480 1.1 dogcow
481 1.1 dogcow data = 0;
482 1.1 dogcow
483 1.1 dogcow if (ISSET(t->c_cflag, CSTOPB))
484 1.1 dogcow data |= USLSA_DPS_STOP_TWO;
485 1.1 dogcow else
486 1.1 dogcow data |= USLSA_DPS_STOP_ONE;
487 1.1 dogcow
488 1.1 dogcow if (ISSET(t->c_cflag, PARENB)) {
489 1.1 dogcow if (ISSET(t->c_cflag, PARODD))
490 1.1 dogcow data |= USLSA_DPS_PARITY_ODD;
491 1.1 dogcow else
492 1.1 dogcow data |= USLSA_DPS_PARITY_EVEN;
493 1.1 dogcow } else
494 1.1 dogcow data |= USLSA_DPS_PARITY_NONE;
495 1.1 dogcow
496 1.1 dogcow switch (ISSET(t->c_cflag, CSIZE)) {
497 1.1 dogcow case CS5:
498 1.1 dogcow data |= USLSA_DPS_DATA_FIVE;
499 1.1 dogcow break;
500 1.1 dogcow case CS6:
501 1.1 dogcow data |= USLSA_DPS_DATA_SIX;
502 1.1 dogcow break;
503 1.1 dogcow case CS7:
504 1.1 dogcow data |= USLSA_DPS_DATA_SEVEN;
505 1.1 dogcow break;
506 1.1 dogcow case CS8:
507 1.1 dogcow data |= USLSA_DPS_DATA_EIGHT;
508 1.1 dogcow break;
509 1.1 dogcow }
510 1.1 dogcow
511 1.1 dogcow DPRINTF(("uslsa_param: setting DPS register to 0x%x\n", data));
512 1.1 dogcow if (uslsa_request_set(sc, USLSA_REQ_SET_DPS, data))
513 1.1 dogcow printf("%s: setting DPS register failed: invalid argument\n",
514 1.1 dogcow USBDEVNAME(sc->sc_dev));
515 1.1 dogcow
516 1.1 dogcow uslsa_set_flow(sc, t->c_cflag, t->c_iflag);
517 1.1 dogcow
518 1.1 dogcow return 0;
519 1.1 dogcow }
520 1.1 dogcow
521 1.1 dogcow
522 1.1 dogcow static int
523 1.1 dogcow uslsa_open(void *vsc, int portno)
524 1.1 dogcow {
525 1.1 dogcow struct uslsa_softc *sc;
526 1.1 dogcow
527 1.1 dogcow sc = vsc;
528 1.1 dogcow
529 1.1 dogcow DPRINTF(("uslsa_open: sc=%p\n", sc));
530 1.1 dogcow
531 1.1 dogcow if (sc->sc_dying)
532 1.1 dogcow return (EIO);
533 1.1 dogcow
534 1.1 dogcow if (uslsa_request_set(sc, USLSA_REQ_SET_STATE, USLSA_STATE_ENABLE))
535 1.1 dogcow return (EIO);
536 1.1 dogcow
537 1.1 dogcow return 0;
538 1.1 dogcow }
539 1.1 dogcow
540 1.1 dogcow void
541 1.1 dogcow uslsa_close(void *vsc, int portno)
542 1.1 dogcow {
543 1.1 dogcow struct uslsa_softc *sc;
544 1.1 dogcow
545 1.1 dogcow sc = vsc;
546 1.1 dogcow
547 1.1 dogcow if (sc->sc_dying)
548 1.1 dogcow return;
549 1.1 dogcow
550 1.1 dogcow DPRINTF(("uslsa_close: sc=%p\n", sc));
551 1.1 dogcow
552 1.1 dogcow if (uslsa_request_set(sc, USLSA_REQ_SET_STATE,
553 1.1 dogcow USLSA_STATE_DISABLE))
554 1.1 dogcow printf("%s: disable-on-close failed\n",
555 1.1 dogcow USBDEVNAME(sc->sc_dev));
556 1.1 dogcow }
557 1.1 dogcow
558 1.1 dogcow /*
559 1.1 dogcow * uslsa_request_set(), wrapper for doing sets with usbd_do_request()
560 1.1 dogcow */
561 1.1 dogcow static int
562 1.1 dogcow uslsa_request_set(struct uslsa_softc * sc, uint8_t request, uint16_t value)
563 1.1 dogcow {
564 1.1 dogcow usb_device_request_t req;
565 1.1 dogcow usbd_status err;
566 1.1 dogcow
567 1.9 jakllsch req.bmRequestType = UT_WRITE_VENDOR_INTERFACE;
568 1.1 dogcow req.bRequest = request;
569 1.1 dogcow USETW(req.wValue, value);
570 1.1 dogcow USETW(req.wIndex, 0);
571 1.1 dogcow USETW(req.wLength, 0);
572 1.1 dogcow
573 1.1 dogcow err = usbd_do_request(sc->sc_udev, &req, 0);
574 1.1 dogcow if (err)
575 1.1 dogcow printf("%s: uslsa_request: %s\n",
576 1.1 dogcow USBDEVNAME(sc->sc_dev), usbd_errstr(err));
577 1.1 dogcow return err;
578 1.1 dogcow }
579 1.1 dogcow
580 1.1 dogcow /*
581 1.1 dogcow * uslsa_set_flow() does some magic to set up hardware flow control
582 1.1 dogcow */
583 1.1 dogcow static void
584 1.1 dogcow uslsa_set_flow(struct uslsa_softc *sc, tcflag_t cflag, tcflag_t iflag)
585 1.1 dogcow {
586 1.1 dogcow uint8_t mysterydata[16];
587 1.1 dogcow usb_device_request_t req;
588 1.1 dogcow usbd_status err;
589 1.1 dogcow
590 1.1 dogcow DPRINTF(("uslsa_set_flow: cflag = 0x%x, iflag = 0x%x\n",
591 1.1 dogcow cflag, iflag));
592 1.1 dogcow
593 1.9 jakllsch req.bmRequestType = UT_READ_VENDOR_INTERFACE;
594 1.1 dogcow req.bRequest = USLSA_REQ_GET_MODEM;
595 1.1 dogcow USETW(req.wValue, 0);
596 1.1 dogcow USETW(req.wIndex, 0);
597 1.1 dogcow USETW(req.wLength, 16);
598 1.1 dogcow
599 1.1 dogcow err = usbd_do_request(sc->sc_udev, &req, mysterydata);
600 1.1 dogcow if (err)
601 1.1 dogcow printf("%s: uslsa_set_flow: %s\n",
602 1.1 dogcow USBDEVNAME(sc->sc_dev), usbd_errstr(err));
603 1.1 dogcow
604 1.1 dogcow if (ISSET(cflag, CRTSCTS)) {
605 1.1 dogcow mysterydata[0] &= ~0x7b;
606 1.1 dogcow mysterydata[0] |= 0x09;
607 1.1 dogcow mysterydata[4] = 0x80;
608 1.1 dogcow } else {
609 1.1 dogcow mysterydata[0] &= ~0x7b;
610 1.1 dogcow mysterydata[0] |= 0x01;
611 1.1 dogcow mysterydata[4] = 0x40;
612 1.1 dogcow }
613 1.1 dogcow
614 1.9 jakllsch req.bmRequestType = UT_WRITE_VENDOR_INTERFACE;
615 1.1 dogcow req.bRequest = USLSA_REQ_SET_MODEM;
616 1.1 dogcow USETW(req.wValue, 0);
617 1.1 dogcow USETW(req.wIndex, 0);
618 1.1 dogcow USETW(req.wLength, 16);
619 1.1 dogcow
620 1.1 dogcow err = usbd_do_request(sc->sc_udev, &req, mysterydata);
621 1.1 dogcow if (err)
622 1.1 dogcow printf("%s: uslsa_set_flow: %s\n",
623 1.1 dogcow USBDEVNAME(sc->sc_dev), usbd_errstr(err));
624 1.1 dogcow }
625