uslsa.c revision 1.4 1 1.4 plunky /* $NetBSD: uslsa.c,v 1.4 2007/10/25 19:32:15 plunky Exp $ */
2 1.2 xtraeme
3 1.1 dogcow /*
4 1.1 dogcow * Copyright (c) 2007 The NetBSD Foundation, Inc.
5 1.1 dogcow * All rights reserved.
6 1.1 dogcow *
7 1.1 dogcow * This code is derived from software contributed to The NetBSD Foundation
8 1.1 dogcow * by Jonathan A. Kollasch <jakllsch (at) kollasch.net>. Craig Shelley's Linux
9 1.1 dogcow * driver provided invaluable documentation.
10 1.1 dogcow *
11 1.1 dogcow * This code is derived from ugensa.c, software contributed to
12 1.1 dogcow * The NetBSD Foundation by Roland C. Dowdeswell <elric (at) netbsd.org>.
13 1.1 dogcow *
14 1.1 dogcow * Redistribution and use in source and binary forms, with or without
15 1.1 dogcow * modification, are permitted provided that the following conditions
16 1.1 dogcow * are met:
17 1.1 dogcow * 1. Redistributions of source code must retain the above copyright
18 1.1 dogcow * notice, this list of conditions and the following disclaimer.
19 1.1 dogcow * 2. Redistributions in binary form must reproduce the above copyright
20 1.1 dogcow * notice, this list of conditions and the following disclaimer in the
21 1.1 dogcow * documentation and/or other materials provided with the distribution.
22 1.1 dogcow * 3. All advertising materials mentioning features or use of this software
23 1.1 dogcow * must display the following acknowledgement:
24 1.1 dogcow * This product includes software developed by the NetBSD
25 1.1 dogcow * Foundation, Inc. and its contributors.
26 1.1 dogcow * 4. Neither the name of The NetBSD Foundation nor the names of its
27 1.1 dogcow * contributors may be used to endorse or promote products derived
28 1.1 dogcow * from this software without specific prior written permission.
29 1.1 dogcow *
30 1.1 dogcow * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
31 1.1 dogcow * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
32 1.1 dogcow * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
33 1.1 dogcow * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
34 1.1 dogcow * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
35 1.1 dogcow * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
36 1.1 dogcow * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
37 1.1 dogcow * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
38 1.1 dogcow * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
39 1.1 dogcow * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
40 1.1 dogcow * POSSIBILITY OF SUCH DAMAGE.
41 1.1 dogcow */
42 1.1 dogcow
43 1.2 xtraeme #include <sys/cdefs.h>
44 1.4 plunky __KERNEL_RCSID(0, "$NetBSD: uslsa.c,v 1.4 2007/10/25 19:32:15 plunky Exp $");
45 1.2 xtraeme
46 1.1 dogcow #include <sys/param.h>
47 1.1 dogcow #include <sys/systm.h>
48 1.1 dogcow #include <sys/kernel.h>
49 1.1 dogcow #include <sys/device.h>
50 1.1 dogcow #include <sys/conf.h>
51 1.1 dogcow #include <sys/tty.h>
52 1.1 dogcow
53 1.1 dogcow #include <dev/usb/usb.h>
54 1.1 dogcow
55 1.1 dogcow #include <dev/usb/usbdi.h>
56 1.1 dogcow #include <dev/usb/usbdi_util.h>
57 1.1 dogcow #include <dev/usb/usbdevs.h>
58 1.1 dogcow
59 1.1 dogcow #include <dev/usb/ucomvar.h>
60 1.1 dogcow
61 1.1 dogcow #ifdef DEBUG
62 1.1 dogcow #define USLSA_DEBUG
63 1.1 dogcow #endif
64 1.1 dogcow
65 1.1 dogcow #ifdef USLSA_DEBUG
66 1.1 dogcow #define DPRINTF(x) if (uslsadebug) printf x
67 1.1 dogcow #define DPRINTFN(n,x) if (uslsadebug>(n)) printf x
68 1.1 dogcow int uslsadebug = 0;
69 1.1 dogcow #else
70 1.1 dogcow #define DPRINTF(x)
71 1.1 dogcow #define DPRINTFN(n,x)
72 1.1 dogcow #endif
73 1.1 dogcow
74 1.1 dogcow #define USLSA_REQUEST_SET 0x41
75 1.1 dogcow #define USLSA_REQUEST_GET 0xc1
76 1.1 dogcow
77 1.1 dogcow #define USLSA_REQ_SET_STATE 0x00
78 1.1 dogcow
79 1.1 dogcow #define USLSA_REQ_SET_BPS 0x01
80 1.1 dogcow #define USLSA_REQ_GET_BPS 0x02
81 1.1 dogcow
82 1.1 dogcow #define USLSA_REQ_SET_DPS 0x03
83 1.1 dogcow #define USLSA_REQ_GET_DPS 0x04
84 1.1 dogcow
85 1.1 dogcow #define USLSA_REQ_SET_BREAK 0x05
86 1.1 dogcow #define USLSA_REQ_GET_BREAK 0x06
87 1.1 dogcow
88 1.1 dogcow #define USLSA_REQ_SET_FLOW 0x07
89 1.1 dogcow #define USLSA_REQ_GET_FLOW 0x08
90 1.1 dogcow
91 1.1 dogcow #define USLSA_REQ_SET_MODEM 0x13
92 1.1 dogcow #define USLSA_REQ_GET_MODEM 0x14
93 1.1 dogcow
94 1.1 dogcow #define USLSA_REQ_SET_MISC 0x19
95 1.1 dogcow #define USLSA_REQ_GET_MISC 0x20
96 1.1 dogcow
97 1.1 dogcow #define USLSA_STATE_DISABLE 0x0000
98 1.1 dogcow #define USLSA_STATE_ENABLE 0x0001
99 1.1 dogcow
100 1.1 dogcow #define USLSA_BPS(b) (3686400/b)
101 1.1 dogcow
102 1.1 dogcow #define USLSA_DPS_DATA_MASK 0x0f00
103 1.1 dogcow #define USLSA_DPS_DATA_FIVE 0x0500
104 1.1 dogcow #define USLSA_DPS_DATA_SIX 0x0600
105 1.1 dogcow #define USLSA_DPS_DATA_SEVEN 0x0700
106 1.1 dogcow #define USLSA_DPS_DATA_EIGHT 0x0800
107 1.1 dogcow #define USLSA_DPS_DATA_NINE 0x0900
108 1.1 dogcow
109 1.1 dogcow #define USLSA_DPS_PARITY_MASK 0x00f0
110 1.1 dogcow #define USLSA_DPS_PARITY_SPACE 0x0040
111 1.1 dogcow #define USLSA_DPS_PARITY_MARK 0x0030
112 1.1 dogcow #define USLSA_DPS_PARITY_EVEN 0x0020
113 1.1 dogcow #define USLSA_DPS_PARITY_ODD 0x0010
114 1.1 dogcow #define USLSA_DPS_PARITY_NONE 0x0000
115 1.1 dogcow
116 1.1 dogcow #define USLSA_DPS_STOP_MASK 0x000f
117 1.1 dogcow #define USLSA_DPS_STOP_TWO 0x0002
118 1.1 dogcow #define USLSA_DPS_STOP_ONE_FIVE 0x0001
119 1.1 dogcow #define USLSA_DPS_STOP_ONE 0x0000
120 1.1 dogcow
121 1.1 dogcow #define USLSA_BREAK_DISABLE 0x0001
122 1.1 dogcow #define USLSA_BREAK_ENABLE 0x0000
123 1.1 dogcow
124 1.1 dogcow #define USLSA_FLOW_SET_RTS 0x0200
125 1.1 dogcow #define USLSA_FLOW_SET_DTR 0x0100
126 1.1 dogcow #define USLSA_FLOW_MSR_MASK 0x00f0
127 1.1 dogcow #define USLSA_FLOW_MSR_DCD 0x0080
128 1.1 dogcow #define USLSA_FLOW_MSR_RI 0x0040
129 1.1 dogcow #define USLSA_FLOW_MSR_DSR 0x0020
130 1.1 dogcow #define USLSA_FLOW_MSR_CTS 0x0010
131 1.1 dogcow #define USLSA_FLOW_RTS 0x0002
132 1.1 dogcow #define USLSA_FLOW_DTR 0x0001
133 1.1 dogcow
134 1.1 dogcow struct uslsa_softc {
135 1.1 dogcow USBBASEDEVICE sc_dev; /* base device */
136 1.1 dogcow usbd_device_handle sc_udev; /* device */
137 1.1 dogcow usbd_interface_handle sc_iface; /* interface */
138 1.1 dogcow
139 1.1 dogcow device_ptr_t sc_subdev; /* ucom device */
140 1.1 dogcow
141 1.1 dogcow u_char sc_dying; /* disconnecting */
142 1.1 dogcow
143 1.1 dogcow u_char sc_lsr; /* local status register */
144 1.1 dogcow u_char sc_msr; /* uslsa status register */
145 1.1 dogcow };
146 1.1 dogcow
147 1.1 dogcow static void uslsa_get_status(void *sc, int, u_char *, u_char *);
148 1.1 dogcow static void uslsa_set(void *, int, int, int);
149 1.1 dogcow static int uslsa_param(void *, int, struct termios *);
150 1.1 dogcow static int uslsa_open(void *, int);
151 1.1 dogcow static void uslsa_close(void *, int);
152 1.1 dogcow
153 1.1 dogcow static int uslsa_request_set(struct uslsa_softc *, uint8_t, uint16_t);
154 1.1 dogcow static void uslsa_set_flow(struct uslsa_softc *, tcflag_t, tcflag_t);
155 1.1 dogcow
156 1.1 dogcow struct ucom_methods uslsa_methods = {
157 1.1 dogcow uslsa_get_status,
158 1.1 dogcow uslsa_set,
159 1.1 dogcow uslsa_param,
160 1.1 dogcow NULL,
161 1.1 dogcow uslsa_open,
162 1.1 dogcow uslsa_close,
163 1.1 dogcow NULL,
164 1.1 dogcow NULL,
165 1.1 dogcow };
166 1.1 dogcow
167 1.1 dogcow #define USLSA_CONFIG_INDEX 0
168 1.1 dogcow #define USLSA_IFACE_INDEX 0
169 1.1 dogcow #define USLSA_BUFSIZE 256
170 1.1 dogcow
171 1.1 dogcow static const struct usb_devno uslsa_devs[] = {
172 1.1 dogcow { USB_VENDOR_BALTECH, USB_PRODUCT_BALTECH_CARDREADER },
173 1.1 dogcow { USB_VENDOR_DYNASTREAM, USB_PRODUCT_DYNASTREAM_ANTDEVBOARD },
174 1.1 dogcow { USB_VENDOR_JABLOTRON, USB_PRODUCT_JABLOTRON_PC60B },
175 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_ARGUSISP },
176 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_CRUMB128 },
177 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_DEGREECONT },
178 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_DESKTOPMOBILE },
179 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_IPLINK1220 },
180 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_LIPOWSKY_HARP },
181 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_LIPOWSKY_JTAG },
182 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_LIPOWSKY_LIN },
183 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_POLOLU },
184 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_CP210X_1 },
185 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_CP210X_2 },
186 1.1 dogcow { USB_VENDOR_SILABS, USB_PRODUCT_SILABS_SUNNTO },
187 1.1 dogcow { USB_VENDOR_SILABS2, USB_PRODUCT_SILABS2_DCU11CLONE },
188 1.1 dogcow { USB_VENDOR_USI, USB_PRODUCT_USI_MC60 }
189 1.1 dogcow };
190 1.1 dogcow #define uslsa_lookup(v, p) usb_lookup(uslsa_devs, v, p)
191 1.1 dogcow
192 1.1 dogcow USB_DECLARE_DRIVER(uslsa);
193 1.1 dogcow
194 1.1 dogcow USB_MATCH(uslsa)
195 1.1 dogcow {
196 1.1 dogcow USB_MATCH_START(uslsa, uaa);
197 1.1 dogcow
198 1.1 dogcow return (uslsa_lookup(uaa->vendor, uaa->product) != NULL ?
199 1.1 dogcow UMATCH_VENDOR_PRODUCT : UMATCH_NONE);
200 1.1 dogcow }
201 1.1 dogcow
202 1.1 dogcow USB_ATTACH(uslsa)
203 1.1 dogcow {
204 1.1 dogcow USB_ATTACH_START(uslsa, sc, uaa);
205 1.1 dogcow usbd_device_handle dev = uaa->device;
206 1.1 dogcow usbd_interface_handle iface;
207 1.1 dogcow usb_interface_descriptor_t *id;
208 1.1 dogcow usb_endpoint_descriptor_t *ed;
209 1.1 dogcow char *devinfop;
210 1.1 dogcow char *devname;
211 1.1 dogcow usbd_status err;
212 1.1 dogcow struct ucom_attach_args uca;
213 1.1 dogcow int i;
214 1.1 dogcow
215 1.1 dogcow devname = USBDEVNAME(sc->sc_dev);
216 1.1 dogcow
217 1.1 dogcow DPRINTFN(10, ("\nuslsa_attach: sc=%p\n", sc));
218 1.1 dogcow
219 1.1 dogcow /* Move the device into the configured state. */
220 1.1 dogcow err = usbd_set_config_index(dev, USLSA_CONFIG_INDEX, 1);
221 1.1 dogcow if (err) {
222 1.1 dogcow printf("\n%s: failed to set configuration, err=%s\n",
223 1.1 dogcow devname, usbd_errstr(err));
224 1.1 dogcow goto bad;
225 1.1 dogcow }
226 1.1 dogcow
227 1.1 dogcow err = usbd_device2interface_handle(dev, USLSA_IFACE_INDEX, &iface);
228 1.1 dogcow if (err) {
229 1.1 dogcow printf("\n%s: failed to get interface, err=%s\n",
230 1.1 dogcow devname, usbd_errstr(err));
231 1.1 dogcow goto bad;
232 1.1 dogcow }
233 1.1 dogcow
234 1.1 dogcow devinfop = usbd_devinfo_alloc(dev, 0);
235 1.1 dogcow USB_ATTACH_SETUP;
236 1.1 dogcow printf("%s: %s\n", devname, devinfop);
237 1.1 dogcow usbd_devinfo_free(devinfop);
238 1.1 dogcow
239 1.1 dogcow id = usbd_get_interface_descriptor(iface);
240 1.1 dogcow
241 1.1 dogcow sc->sc_udev = dev;
242 1.1 dogcow sc->sc_iface = iface;
243 1.1 dogcow
244 1.1 dogcow uca.info = "Silicon Labs CP210x";
245 1.3 nathanw uca.portno = UCOM_UNK_PORTNO;
246 1.1 dogcow uca.ibufsize = USLSA_BUFSIZE;
247 1.1 dogcow uca.obufsize = USLSA_BUFSIZE;
248 1.1 dogcow uca.ibufsizepad = USLSA_BUFSIZE;
249 1.1 dogcow uca.opkthdrlen = 0;
250 1.1 dogcow uca.device = dev;
251 1.1 dogcow uca.iface = iface;
252 1.1 dogcow uca.methods = &uslsa_methods;
253 1.1 dogcow uca.arg = sc;
254 1.1 dogcow
255 1.1 dogcow usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev,
256 1.1 dogcow USBDEV(sc->sc_dev));
257 1.1 dogcow
258 1.1 dogcow uca.bulkin = uca.bulkout = -1;
259 1.1 dogcow for (i = 0; i < id->bNumEndpoints; i++) {
260 1.1 dogcow int addr, dir, attr;
261 1.1 dogcow
262 1.1 dogcow ed = usbd_interface2endpoint_descriptor(iface, i);
263 1.1 dogcow if (ed == NULL) {
264 1.1 dogcow printf("%s: could not read endpoint descriptor"
265 1.1 dogcow ": %s\n", devname, usbd_errstr(err));
266 1.1 dogcow goto bad;
267 1.1 dogcow }
268 1.1 dogcow addr = ed->bEndpointAddress;
269 1.1 dogcow dir = UE_GET_DIR(ed->bEndpointAddress);
270 1.1 dogcow attr = ed->bmAttributes & UE_XFERTYPE;
271 1.1 dogcow if (dir == UE_DIR_IN && attr == UE_BULK)
272 1.1 dogcow uca.bulkin = addr;
273 1.1 dogcow else if (dir == UE_DIR_OUT && attr == UE_BULK)
274 1.1 dogcow uca.bulkout = addr;
275 1.1 dogcow else
276 1.1 dogcow printf("%s: unexpected endpoint\n", devname);
277 1.1 dogcow }
278 1.1 dogcow if (uca.bulkin == -1) {
279 1.1 dogcow printf("%s: Could not find data bulk in\n",
280 1.1 dogcow USBDEVNAME(sc->sc_dev));
281 1.1 dogcow goto bad;
282 1.1 dogcow }
283 1.1 dogcow if (uca.bulkout == -1) {
284 1.1 dogcow printf("%s: Could not find data bulk out\n",
285 1.1 dogcow USBDEVNAME(sc->sc_dev));
286 1.1 dogcow goto bad;
287 1.1 dogcow }
288 1.1 dogcow
289 1.1 dogcow DPRINTF(("uslsa: in=0x%x out=0x%x\n", uca.bulkin, uca.bulkout));
290 1.1 dogcow sc->sc_subdev = config_found_sm_loc(self, "ucombus", NULL, &uca,
291 1.1 dogcow ucomprint, ucomsubmatch);
292 1.1 dogcow
293 1.1 dogcow USB_ATTACH_SUCCESS_RETURN;
294 1.1 dogcow
295 1.1 dogcow bad:
296 1.1 dogcow DPRINTF(("uslsa_attach: ATTACH ERROR\n"));
297 1.1 dogcow sc->sc_dying = 1;
298 1.1 dogcow USB_ATTACH_ERROR_RETURN;
299 1.1 dogcow }
300 1.1 dogcow
301 1.1 dogcow int
302 1.1 dogcow uslsa_activate(device_ptr_t self, enum devact act)
303 1.1 dogcow {
304 1.1 dogcow struct uslsa_softc *sc = (struct uslsa_softc *) self;
305 1.1 dogcow int rv = 0;
306 1.1 dogcow
307 1.1 dogcow switch (act) {
308 1.1 dogcow case DVACT_ACTIVATE:
309 1.1 dogcow return (EOPNOTSUPP);
310 1.1 dogcow break;
311 1.1 dogcow
312 1.1 dogcow case DVACT_DEACTIVATE:
313 1.1 dogcow sc->sc_dying = 1;
314 1.1 dogcow if (sc->sc_subdev)
315 1.1 dogcow rv = config_deactivate(sc->sc_subdev);
316 1.1 dogcow break;
317 1.1 dogcow }
318 1.1 dogcow return (rv);
319 1.1 dogcow }
320 1.1 dogcow
321 1.1 dogcow USB_DETACH(uslsa)
322 1.1 dogcow {
323 1.1 dogcow USB_DETACH_START(uslsa, sc);
324 1.1 dogcow int rv = 0;
325 1.1 dogcow
326 1.1 dogcow DPRINTF(("uslsa_detach: sc=%p flags=%d\n", sc, flags));
327 1.1 dogcow
328 1.1 dogcow sc->sc_dying = 1;
329 1.1 dogcow
330 1.1 dogcow if (sc->sc_subdev != NULL)
331 1.1 dogcow rv = config_detach(sc->sc_subdev, flags);
332 1.1 dogcow
333 1.1 dogcow usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
334 1.1 dogcow USBDEV(sc->sc_dev));
335 1.1 dogcow
336 1.1 dogcow return (rv);
337 1.1 dogcow }
338 1.1 dogcow
339 1.1 dogcow static void
340 1.1 dogcow uslsa_get_status(void *vsc, int portno, u_char *lsr, u_char *msr)
341 1.1 dogcow {
342 1.1 dogcow struct uslsa_softc *sc;
343 1.1 dogcow usb_device_request_t req;
344 1.1 dogcow usbd_status err;
345 1.1 dogcow int actlen;
346 1.1 dogcow uint16_t flowreg;
347 1.1 dogcow
348 1.1 dogcow sc = vsc;
349 1.1 dogcow
350 1.1 dogcow DPRINTF(("uslsa_get_status:\n"));
351 1.1 dogcow
352 1.1 dogcow req.bmRequestType = USLSA_REQUEST_GET;
353 1.1 dogcow req.bRequest = USLSA_REQ_GET_FLOW;
354 1.1 dogcow USETW(req.wValue, 0);
355 1.1 dogcow USETW(req.wIndex, 0);
356 1.1 dogcow USETW(req.wLength, sizeof(flowreg));
357 1.1 dogcow
358 1.1 dogcow err = usbd_do_request_flags(sc->sc_udev, &req, &flowreg,
359 1.1 dogcow USBD_SHORT_XFER_OK, &actlen, USBD_DEFAULT_TIMEOUT);
360 1.1 dogcow if (err)
361 1.1 dogcow printf("%s: uslsa_get_status: %s\n",
362 1.1 dogcow USBDEVNAME(sc->sc_dev), usbd_errstr(err));
363 1.1 dogcow
364 1.1 dogcow DPRINTF(("uslsa_get_status: flowreg=0x%x\n", flowreg));
365 1.1 dogcow
366 1.1 dogcow sc->sc_msr = (u_char)(USLSA_FLOW_MSR_MASK & flowreg);
367 1.1 dogcow
368 1.1 dogcow if (lsr != NULL)
369 1.1 dogcow *lsr = sc->sc_lsr;
370 1.1 dogcow if (msr != NULL)
371 1.1 dogcow *msr = sc->sc_msr;
372 1.1 dogcow }
373 1.1 dogcow
374 1.1 dogcow static void
375 1.1 dogcow uslsa_set(void *vsc, int portno, int reg, int onoff)
376 1.1 dogcow {
377 1.1 dogcow struct uslsa_softc *sc;
378 1.1 dogcow
379 1.1 dogcow sc = vsc;
380 1.1 dogcow
381 1.1 dogcow DPRINTF(("uslsa_set: sc=%p, port=%d reg=%d onoff=%d\n", sc, portno,
382 1.1 dogcow reg, onoff));
383 1.1 dogcow
384 1.1 dogcow switch (reg) {
385 1.1 dogcow case UCOM_SET_DTR:
386 1.1 dogcow if (uslsa_request_set(sc, USLSA_REQ_SET_FLOW,
387 1.1 dogcow (onoff ? (USLSA_FLOW_DTR | USLSA_FLOW_SET_DTR) :
388 1.1 dogcow USLSA_FLOW_SET_DTR)))
389 1.1 dogcow printf("%s: uslsa_set_dtr failed\n",
390 1.1 dogcow USBDEVNAME(sc->sc_dev));
391 1.1 dogcow break;
392 1.1 dogcow case UCOM_SET_RTS:
393 1.1 dogcow if (uslsa_request_set(sc, USLSA_REQ_SET_FLOW,
394 1.1 dogcow (onoff ? (USLSA_FLOW_RTS | USLSA_FLOW_SET_RTS) :
395 1.1 dogcow USLSA_FLOW_SET_RTS)))
396 1.1 dogcow printf("%s: uslsa_set_rts failed\n",
397 1.1 dogcow USBDEVNAME(sc->sc_dev));
398 1.1 dogcow break;
399 1.1 dogcow case UCOM_SET_BREAK:
400 1.1 dogcow if (uslsa_request_set(sc, USLSA_REQ_SET_BREAK,
401 1.1 dogcow (onoff ? USLSA_BREAK_ENABLE :
402 1.1 dogcow USLSA_BREAK_DISABLE)))
403 1.1 dogcow printf("%s: uslsa_set_break failed\n",
404 1.1 dogcow USBDEVNAME(sc->sc_dev));
405 1.1 dogcow break;
406 1.1 dogcow default:
407 1.1 dogcow break;
408 1.1 dogcow }
409 1.1 dogcow }
410 1.1 dogcow
411 1.1 dogcow static int
412 1.1 dogcow uslsa_param(void *vsc, int portno, struct termios * t)
413 1.1 dogcow {
414 1.1 dogcow struct uslsa_softc *sc;
415 1.1 dogcow uint16_t data;
416 1.1 dogcow
417 1.1 dogcow sc = vsc;
418 1.1 dogcow
419 1.1 dogcow DPRINTF(("uslsa_param: sc=%p\n", sc));
420 1.1 dogcow
421 1.1 dogcow switch (t->c_ospeed) {
422 1.1 dogcow case B600:
423 1.1 dogcow case B1200:
424 1.1 dogcow case B2400:
425 1.1 dogcow case B4800:
426 1.1 dogcow case B9600:
427 1.1 dogcow case B19200:
428 1.1 dogcow case B38400:
429 1.1 dogcow case B57600:
430 1.1 dogcow case B115200:
431 1.1 dogcow case B230400:
432 1.1 dogcow case B460800:
433 1.1 dogcow case B921600:
434 1.1 dogcow data = USLSA_BPS(t->c_ospeed);
435 1.1 dogcow break;
436 1.1 dogcow default:
437 1.1 dogcow printf("%s: uslsa_param: unsupported data rate, "
438 1.1 dogcow "forcing default of 115200bps\n",
439 1.1 dogcow USBDEVNAME(sc->sc_dev));
440 1.1 dogcow data = USLSA_BPS(B115200);
441 1.1 dogcow };
442 1.1 dogcow
443 1.1 dogcow if (uslsa_request_set(sc, USLSA_REQ_SET_BPS, data))
444 1.1 dogcow printf("%s: uslsa_param: setting data rate failed\n",
445 1.1 dogcow USBDEVNAME(sc->sc_dev));
446 1.1 dogcow
447 1.1 dogcow data = 0;
448 1.1 dogcow
449 1.1 dogcow if (ISSET(t->c_cflag, CSTOPB))
450 1.1 dogcow data |= USLSA_DPS_STOP_TWO;
451 1.1 dogcow else
452 1.1 dogcow data |= USLSA_DPS_STOP_ONE;
453 1.1 dogcow
454 1.1 dogcow if (ISSET(t->c_cflag, PARENB)) {
455 1.1 dogcow if (ISSET(t->c_cflag, PARODD))
456 1.1 dogcow data |= USLSA_DPS_PARITY_ODD;
457 1.1 dogcow else
458 1.1 dogcow data |= USLSA_DPS_PARITY_EVEN;
459 1.1 dogcow } else
460 1.1 dogcow data |= USLSA_DPS_PARITY_NONE;
461 1.1 dogcow
462 1.1 dogcow switch (ISSET(t->c_cflag, CSIZE)) {
463 1.1 dogcow case CS5:
464 1.1 dogcow data |= USLSA_DPS_DATA_FIVE;
465 1.1 dogcow break;
466 1.1 dogcow case CS6:
467 1.1 dogcow data |= USLSA_DPS_DATA_SIX;
468 1.1 dogcow break;
469 1.1 dogcow case CS7:
470 1.1 dogcow data |= USLSA_DPS_DATA_SEVEN;
471 1.1 dogcow break;
472 1.1 dogcow case CS8:
473 1.1 dogcow data |= USLSA_DPS_DATA_EIGHT;
474 1.1 dogcow break;
475 1.1 dogcow }
476 1.1 dogcow
477 1.1 dogcow DPRINTF(("uslsa_param: setting DPS register to 0x%x\n", data));
478 1.1 dogcow if (uslsa_request_set(sc, USLSA_REQ_SET_DPS, data))
479 1.1 dogcow printf("%s: setting DPS register failed: invalid argument\n",
480 1.1 dogcow USBDEVNAME(sc->sc_dev));
481 1.1 dogcow
482 1.1 dogcow uslsa_set_flow(sc, t->c_cflag, t->c_iflag);
483 1.1 dogcow
484 1.1 dogcow return 0;
485 1.1 dogcow }
486 1.1 dogcow
487 1.1 dogcow
488 1.1 dogcow static int
489 1.1 dogcow uslsa_open(void *vsc, int portno)
490 1.1 dogcow {
491 1.1 dogcow struct uslsa_softc *sc;
492 1.1 dogcow
493 1.1 dogcow sc = vsc;
494 1.1 dogcow
495 1.1 dogcow DPRINTF(("uslsa_open: sc=%p\n", sc));
496 1.1 dogcow
497 1.1 dogcow if (sc->sc_dying)
498 1.1 dogcow return (EIO);
499 1.1 dogcow
500 1.1 dogcow if (uslsa_request_set(sc, USLSA_REQ_SET_STATE, USLSA_STATE_ENABLE))
501 1.1 dogcow return (EIO);
502 1.1 dogcow
503 1.1 dogcow return 0;
504 1.1 dogcow }
505 1.1 dogcow
506 1.1 dogcow void
507 1.1 dogcow uslsa_close(void *vsc, int portno)
508 1.1 dogcow {
509 1.1 dogcow struct uslsa_softc *sc;
510 1.1 dogcow
511 1.1 dogcow sc = vsc;
512 1.1 dogcow
513 1.1 dogcow if (sc->sc_dying)
514 1.1 dogcow return;
515 1.1 dogcow
516 1.1 dogcow DPRINTF(("uslsa_close: sc=%p\n", sc));
517 1.1 dogcow
518 1.1 dogcow if (uslsa_request_set(sc, USLSA_REQ_SET_STATE,
519 1.1 dogcow USLSA_STATE_DISABLE))
520 1.1 dogcow printf("%s: disable-on-close failed\n",
521 1.1 dogcow USBDEVNAME(sc->sc_dev));
522 1.1 dogcow }
523 1.1 dogcow
524 1.1 dogcow /*
525 1.1 dogcow * uslsa_request_set(), wrapper for doing sets with usbd_do_request()
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.1 dogcow usbd_status err;
532 1.1 dogcow
533 1.1 dogcow req.bmRequestType = USLSA_REQUEST_SET;
534 1.1 dogcow req.bRequest = request;
535 1.1 dogcow USETW(req.wValue, value);
536 1.1 dogcow USETW(req.wIndex, 0);
537 1.1 dogcow USETW(req.wLength, 0);
538 1.1 dogcow
539 1.1 dogcow err = usbd_do_request(sc->sc_udev, &req, 0);
540 1.1 dogcow if (err)
541 1.1 dogcow printf("%s: uslsa_request: %s\n",
542 1.1 dogcow USBDEVNAME(sc->sc_dev), usbd_errstr(err));
543 1.1 dogcow return err;
544 1.1 dogcow }
545 1.1 dogcow
546 1.1 dogcow /*
547 1.1 dogcow * uslsa_set_flow() does some magic to set up hardware flow control
548 1.1 dogcow */
549 1.1 dogcow static void
550 1.1 dogcow uslsa_set_flow(struct uslsa_softc *sc, tcflag_t cflag, tcflag_t iflag)
551 1.1 dogcow {
552 1.1 dogcow uint8_t mysterydata[16];
553 1.1 dogcow usb_device_request_t req;
554 1.1 dogcow usbd_status err;
555 1.1 dogcow
556 1.1 dogcow DPRINTF(("uslsa_set_flow: cflag = 0x%x, iflag = 0x%x\n",
557 1.1 dogcow cflag, iflag));
558 1.1 dogcow
559 1.1 dogcow req.bmRequestType = USLSA_REQUEST_GET;
560 1.1 dogcow req.bRequest = USLSA_REQ_GET_MODEM;
561 1.1 dogcow USETW(req.wValue, 0);
562 1.1 dogcow USETW(req.wIndex, 0);
563 1.1 dogcow USETW(req.wLength, 16);
564 1.1 dogcow
565 1.1 dogcow err = usbd_do_request(sc->sc_udev, &req, mysterydata);
566 1.1 dogcow if (err)
567 1.1 dogcow printf("%s: uslsa_set_flow: %s\n",
568 1.1 dogcow USBDEVNAME(sc->sc_dev), usbd_errstr(err));
569 1.1 dogcow
570 1.1 dogcow if (ISSET(cflag, CRTSCTS)) {
571 1.1 dogcow mysterydata[0] &= ~0x7b;
572 1.1 dogcow mysterydata[0] |= 0x09;
573 1.1 dogcow mysterydata[4] = 0x80;
574 1.1 dogcow } else {
575 1.1 dogcow mysterydata[0] &= ~0x7b;
576 1.1 dogcow mysterydata[0] |= 0x01;
577 1.1 dogcow mysterydata[4] = 0x40;
578 1.1 dogcow }
579 1.1 dogcow
580 1.1 dogcow req.bmRequestType = USLSA_REQUEST_SET;
581 1.1 dogcow req.bRequest = USLSA_REQ_SET_MODEM;
582 1.1 dogcow USETW(req.wValue, 0);
583 1.1 dogcow USETW(req.wIndex, 0);
584 1.1 dogcow USETW(req.wLength, 16);
585 1.1 dogcow
586 1.1 dogcow err = usbd_do_request(sc->sc_udev, &req, mysterydata);
587 1.1 dogcow if (err)
588 1.1 dogcow printf("%s: uslsa_set_flow: %s\n",
589 1.1 dogcow USBDEVNAME(sc->sc_dev), usbd_errstr(err));
590 1.1 dogcow }
591