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