ulpt.c revision 1.97.2.3 1 1.97.2.3 pgoyette /* $NetBSD: ulpt.c,v 1.97.2.3 2016/07/26 05:54:40 pgoyette Exp $ */
2 1.1 augustss
3 1.1 augustss /*
4 1.60 augustss * Copyright (c) 1998, 2003 The NetBSD Foundation, Inc.
5 1.1 augustss * All rights reserved.
6 1.1 augustss *
7 1.3 augustss * This code is derived from software contributed to The NetBSD Foundation
8 1.37 augustss * by Lennart Augustsson (lennart (at) augustsson.net) at
9 1.3 augustss * Carlstedt Research & Technology.
10 1.1 augustss *
11 1.1 augustss * Redistribution and use in source and binary forms, with or without
12 1.1 augustss * modification, are permitted provided that the following conditions
13 1.1 augustss * are met:
14 1.1 augustss * 1. Redistributions of source code must retain the above copyright
15 1.1 augustss * notice, this list of conditions and the following disclaimer.
16 1.1 augustss * 2. Redistributions in binary form must reproduce the above copyright
17 1.1 augustss * notice, this list of conditions and the following disclaimer in the
18 1.1 augustss * documentation and/or other materials provided with the distribution.
19 1.1 augustss *
20 1.1 augustss * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
21 1.1 augustss * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
22 1.1 augustss * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
23 1.1 augustss * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
24 1.1 augustss * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
25 1.1 augustss * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
26 1.1 augustss * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
27 1.1 augustss * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
28 1.1 augustss * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
29 1.1 augustss * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30 1.1 augustss * POSSIBILITY OF SUCH DAMAGE.
31 1.11 augustss */
32 1.11 augustss
33 1.11 augustss /*
34 1.40 augustss * Printer Class spec: http://www.usb.org/developers/data/devclass/usbprint109.PDF
35 1.1 augustss */
36 1.44 lukem
37 1.44 lukem #include <sys/cdefs.h>
38 1.97.2.3 pgoyette __KERNEL_RCSID(0, "$NetBSD: ulpt.c,v 1.97.2.3 2016/07/26 05:54:40 pgoyette Exp $");
39 1.27 augustss
40 1.1 augustss #include <sys/param.h>
41 1.1 augustss #include <sys/systm.h>
42 1.1 augustss #include <sys/proc.h>
43 1.1 augustss #include <sys/kernel.h>
44 1.60 augustss #include <sys/fcntl.h>
45 1.8 augustss #include <sys/device.h>
46 1.1 augustss #include <sys/ioctl.h>
47 1.1 augustss #include <sys/uio.h>
48 1.1 augustss #include <sys/conf.h>
49 1.12 augustss #include <sys/vnode.h>
50 1.1 augustss #include <sys/syslog.h>
51 1.97.2.1 pgoyette #include <sys/localcount.h>
52 1.1 augustss
53 1.60 augustss #include <machine/vmparam.h> /* PAGE_SIZE */
54 1.60 augustss
55 1.1 augustss #include <dev/usb/usb.h>
56 1.1 augustss #include <dev/usb/usbdi.h>
57 1.1 augustss #include <dev/usb/usbdi_util.h>
58 1.1 augustss #include <dev/usb/usbdevs.h>
59 1.1 augustss #include <dev/usb/usb_quirks.h>
60 1.1 augustss
61 1.1 augustss #define TIMEOUT hz*16 /* wait up to 16 seconds for a ready */
62 1.1 augustss #define STEP hz/4
63 1.1 augustss
64 1.1 augustss #define LPTPRI (PZERO+8)
65 1.60 augustss #define ULPT_BSIZE PAGE_SIZE
66 1.60 augustss
67 1.60 augustss #define ULPT_READS_PER_SEC 5
68 1.96 skrll /* XXX Why is 10 us a reasonable value? */
69 1.60 augustss #define ULPT_READ_TIMO 10
70 1.1 augustss
71 1.27 augustss #ifdef ULPT_DEBUG
72 1.85 dyoung #define DPRINTFN(n,x) if (ulptdebug>=(n)) printf x
73 1.1 augustss int ulptdebug = 0;
74 1.79 gdt /*
75 1.79 gdt * The strategy for debug levels is:
76 1.79 gdt * 1: attach-time operations
77 1.79 gdt * 2: open/close/status/reset
78 1.79 gdt * 3: read/write basic
79 1.79 gdt * 4: read/write details
80 1.79 gdt * 10: left over from previous debug code
81 1.79 gdt */
82 1.1 augustss #else
83 1.1 augustss #define DPRINTFN(n,x)
84 1.1 augustss #endif
85 1.1 augustss
86 1.1 augustss #define UR_GET_DEVICE_ID 0
87 1.1 augustss #define UR_GET_PORT_STATUS 1
88 1.1 augustss #define UR_SOFT_RESET 2
89 1.1 augustss
90 1.1 augustss #define LPS_NERR 0x08 /* printer no error */
91 1.1 augustss #define LPS_SELECT 0x10 /* printer selected */
92 1.1 augustss #define LPS_NOPAPER 0x20 /* printer out of paper */
93 1.1 augustss #define LPS_INVERT (LPS_SELECT|LPS_NERR)
94 1.1 augustss #define LPS_MASK (LPS_SELECT|LPS_NERR|LPS_NOPAPER)
95 1.1 augustss
96 1.1 augustss struct ulpt_softc {
97 1.85 dyoung device_t sc_dev;
98 1.96 skrll struct usbd_device *sc_udev; /* device */
99 1.96 skrll struct usbd_interface *sc_iface; /* interface */
100 1.1 augustss int sc_ifaceno;
101 1.42 augustss
102 1.42 augustss int sc_out;
103 1.96 skrll struct usbd_pipe *sc_out_pipe; /* bulk out pipe */
104 1.96 skrll struct usbd_xfer *sc_out_xfer;
105 1.60 augustss void *sc_out_buf;
106 1.42 augustss
107 1.42 augustss int sc_in;
108 1.96 skrll struct usbd_pipe *sc_in_pipe; /* bulk in pipe */
109 1.96 skrll struct usbd_xfer *sc_in_xfer;
110 1.60 augustss void *sc_in_buf;
111 1.60 augustss
112 1.85 dyoung struct callout sc_read_callout; /* to drain input on write-only opens */
113 1.60 augustss int sc_has_callout;
114 1.1 augustss
115 1.1 augustss u_char sc_state;
116 1.1 augustss #define ULPT_OPEN 0x01 /* device is open */
117 1.1 augustss #define ULPT_OBUSY 0x02 /* printer is busy doing output */
118 1.1 augustss #define ULPT_INIT 0x04 /* waiting to initialize for open */
119 1.1 augustss u_char sc_flags;
120 1.1 augustss #define ULPT_NOPRIME 0x40 /* don't prime on open */
121 1.1 augustss u_char sc_laststatus;
122 1.12 augustss
123 1.12 augustss int sc_refcnt;
124 1.12 augustss u_char sc_dying;
125 1.1 augustss };
126 1.1 augustss
127 1.52 gehenna dev_type_open(ulptopen);
128 1.52 gehenna dev_type_close(ulptclose);
129 1.52 gehenna dev_type_write(ulptwrite);
130 1.60 augustss dev_type_read(ulptread);
131 1.52 gehenna dev_type_ioctl(ulptioctl);
132 1.52 gehenna
133 1.52 gehenna const struct cdevsw ulpt_cdevsw = {
134 1.97.2.3 pgoyette DEVSW_MODULE_INIT
135 1.94 dholland .d_open = ulptopen,
136 1.94 dholland .d_close = ulptclose,
137 1.94 dholland .d_read = ulptread,
138 1.94 dholland .d_write = ulptwrite,
139 1.94 dholland .d_ioctl = ulptioctl,
140 1.94 dholland .d_stop = nostop,
141 1.94 dholland .d_tty = notty,
142 1.94 dholland .d_poll = nopoll,
143 1.94 dholland .d_mmap = nommap,
144 1.94 dholland .d_kqfilter = nokqfilter,
145 1.95 dholland .d_discard = nodiscard,
146 1.94 dholland .d_flag = D_OTHER
147 1.52 gehenna };
148 1.27 augustss
149 1.38 augustss void ulpt_disco(void *);
150 1.1 augustss
151 1.96 skrll int ulpt_do_write(struct ulpt_softc *, struct uio *, int);
152 1.96 skrll int ulpt_do_read(struct ulpt_softc *, struct uio *, int);
153 1.38 augustss int ulpt_status(struct ulpt_softc *);
154 1.38 augustss void ulpt_reset(struct ulpt_softc *);
155 1.38 augustss int ulpt_statusmsg(u_char, struct ulpt_softc *);
156 1.97 msaitoh void ulpt_read_cb(struct usbd_xfer *, void *, usbd_status);
157 1.60 augustss void ulpt_tick(void *xsc);
158 1.1 augustss
159 1.42 augustss #if 0
160 1.38 augustss void ieee1284_print_id(char *);
161 1.42 augustss #endif
162 1.16 augustss
163 1.1 augustss #define ULPTUNIT(s) (minor(s) & 0x1f)
164 1.1 augustss #define ULPTFLAGS(s) (minor(s) & 0xe0)
165 1.1 augustss
166 1.27 augustss
167 1.97 msaitoh int ulpt_match(device_t, cfdata_t, void *);
168 1.97 msaitoh void ulpt_attach(device_t, device_t, void *);
169 1.97 msaitoh int ulpt_detach(device_t, int);
170 1.97 msaitoh int ulpt_activate(device_t, enum devact);
171 1.1 augustss
172 1.85 dyoung extern struct cfdriver ulpt_cd;
173 1.85 dyoung
174 1.85 dyoung CFATTACH_DECL_NEW(ulpt, sizeof(struct ulpt_softc), ulpt_match, ulpt_attach,
175 1.85 dyoung ulpt_detach, ulpt_activate);
176 1.85 dyoung
177 1.96 skrll int
178 1.85 dyoung ulpt_match(device_t parent, cfdata_t match, void *aux)
179 1.1 augustss {
180 1.96 skrll struct usbif_attach_arg *uiaa = aux;
181 1.79 gdt /* XXX Print something useful, or don't. */
182 1.1 augustss DPRINTFN(10,("ulpt_match\n"));
183 1.78 drochner
184 1.96 skrll if (uiaa->uiaa_class == UICLASS_PRINTER &&
185 1.96 skrll uiaa->uiaa_subclass == UISUBCLASS_PRINTER &&
186 1.96 skrll (uiaa->uiaa_proto == UIPROTO_PRINTER_UNI ||
187 1.96 skrll uiaa->uiaa_proto == UIPROTO_PRINTER_BI ||
188 1.96 skrll uiaa->uiaa_proto == UIPROTO_PRINTER_1284))
189 1.96 skrll return UMATCH_IFACECLASS_IFACESUBCLASS_IFACEPROTO;
190 1.96 skrll return UMATCH_NONE;
191 1.1 augustss }
192 1.1 augustss
193 1.96 skrll void
194 1.85 dyoung ulpt_attach(device_t parent, device_t self, void *aux)
195 1.1 augustss {
196 1.85 dyoung struct ulpt_softc *sc = device_private(self);
197 1.96 skrll struct usbif_attach_arg *uiaa = aux;
198 1.96 skrll struct usbd_device *dev = uiaa->uiaa_device;
199 1.96 skrll struct usbd_interface *iface = uiaa->uiaa_iface;
200 1.42 augustss usb_interface_descriptor_t *ifcd = usbd_get_interface_descriptor(iface);
201 1.69 christos const usb_interface_descriptor_t *id;
202 1.42 augustss usbd_status err;
203 1.67 augustss char *devinfop;
204 1.1 augustss usb_endpoint_descriptor_t *ed;
205 1.96 skrll uint8_t epcount;
206 1.42 augustss int i, altno;
207 1.65 augustss usbd_desc_iter_t iter;
208 1.50 augustss
209 1.81 cube sc->sc_dev = self;
210 1.81 cube
211 1.83 plunky aprint_naive("\n");
212 1.83 plunky aprint_normal("\n");
213 1.83 plunky
214 1.67 augustss devinfop = usbd_devinfo_alloc(dev, 0);
215 1.81 cube aprint_normal_dev(self, "%s, iclass %d/%d\n",
216 1.67 augustss devinfop, ifcd->bInterfaceClass, ifcd->bInterfaceSubClass);
217 1.67 augustss usbd_devinfo_free(devinfop);
218 1.1 augustss
219 1.65 augustss /* Loop through descriptors looking for a bidir mode. */
220 1.65 augustss usb_desc_iter_init(dev, &iter);
221 1.65 augustss for (altno = 0;;) {
222 1.69 christos id = (const usb_interface_descriptor_t *)usb_desc_iter_next(&iter);
223 1.65 augustss if (!id)
224 1.65 augustss break;
225 1.42 augustss if (id->bDescriptorType == UDESC_INTERFACE &&
226 1.42 augustss id->bInterfaceNumber == ifcd->bInterfaceNumber) {
227 1.42 augustss if (id->bInterfaceClass == UICLASS_PRINTER &&
228 1.42 augustss id->bInterfaceSubClass == UISUBCLASS_PRINTER &&
229 1.56 augustss (id->bInterfaceProtocol == UIPROTO_PRINTER_BI /*||
230 1.56 augustss id->bInterfaceProtocol == UIPROTO_PRINTER_1284*/))
231 1.42 augustss goto found;
232 1.42 augustss altno++;
233 1.66 perry }
234 1.42 augustss }
235 1.42 augustss id = ifcd; /* not found, use original */
236 1.42 augustss found:
237 1.42 augustss if (id != ifcd) {
238 1.42 augustss /* Found a new bidir setting */
239 1.79 gdt DPRINTFN(1, ("ulpt_attach: set altno = %d\n", altno));
240 1.42 augustss err = usbd_set_interface(iface, altno);
241 1.42 augustss if (err) {
242 1.81 cube aprint_error_dev(self,
243 1.81 cube "setting alternate interface failed\n");
244 1.42 augustss sc->sc_dying = 1;
245 1.85 dyoung return;
246 1.42 augustss }
247 1.1 augustss }
248 1.1 augustss
249 1.42 augustss epcount = 0;
250 1.42 augustss (void)usbd_endpoint_count(iface, &epcount);
251 1.42 augustss
252 1.42 augustss sc->sc_in = -1;
253 1.42 augustss sc->sc_out = -1;
254 1.42 augustss for (i = 0; i < epcount; i++) {
255 1.42 augustss ed = usbd_interface2endpoint_descriptor(iface, i);
256 1.42 augustss if (ed == NULL) {
257 1.81 cube aprint_error_dev(self, "couldn't get ep %d\n", i);
258 1.85 dyoung return;
259 1.42 augustss }
260 1.42 augustss if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
261 1.42 augustss UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
262 1.42 augustss sc->sc_in = ed->bEndpointAddress;
263 1.42 augustss } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
264 1.42 augustss UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
265 1.42 augustss sc->sc_out = ed->bEndpointAddress;
266 1.42 augustss }
267 1.42 augustss }
268 1.42 augustss if (sc->sc_out == -1) {
269 1.81 cube aprint_error_dev(self, "could not find bulk out endpoint\n");
270 1.12 augustss sc->sc_dying = 1;
271 1.85 dyoung return;
272 1.12 augustss }
273 1.42 augustss
274 1.42 augustss if (usbd_get_quirks(dev)->uq_flags & UQ_BROKEN_BIDIR) {
275 1.42 augustss /* This device doesn't handle reading properly. */
276 1.42 augustss sc->sc_in = -1;
277 1.42 augustss }
278 1.51 augustss
279 1.81 cube aprint_normal_dev(self, "using %s-directional mode\n",
280 1.51 augustss sc->sc_in >= 0 ? "bi" : "uni");
281 1.42 augustss
282 1.42 augustss sc->sc_iface = iface;
283 1.1 augustss sc->sc_ifaceno = id->bInterfaceNumber;
284 1.42 augustss sc->sc_udev = dev;
285 1.1 augustss
286 1.22 augustss #if 0
287 1.22 augustss /*
288 1.36 augustss * This code is disabled because for some mysterious reason it causes
289 1.22 augustss * printing not to work. But only sometimes, and mostly with
290 1.22 augustss * UHCI and less often with OHCI. *sigh*
291 1.22 augustss */
292 1.22 augustss {
293 1.22 augustss usb_config_descriptor_t *cd = usbd_get_config_descriptor(dev);
294 1.22 augustss usb_device_request_t req;
295 1.22 augustss int len, alen;
296 1.22 augustss
297 1.1 augustss req.bmRequestType = UT_READ_CLASS_INTERFACE;
298 1.1 augustss req.bRequest = UR_GET_DEVICE_ID;
299 1.1 augustss USETW(req.wValue, cd->bConfigurationValue);
300 1.1 augustss USETW2(req.wIndex, id->bInterfaceNumber, id->bAlternateSetting);
301 1.68 soren USETW(req.wLength, DEVINFOSIZE - 1);
302 1.68 soren err = usbd_do_request_flags(dev, &req, devinfop, USBD_SHORT_XFER_OK,
303 1.48 augustss &alen, USBD_DEFAULT_TIMEOUT);
304 1.28 augustss if (err) {
305 1.85 dyoung printf("%s: cannot get device id\n", device_xname(sc->sc_dev));
306 1.16 augustss } else if (alen <= 2) {
307 1.16 augustss printf("%s: empty device id, no printer connected?\n",
308 1.85 dyoung device_xname(sc->sc_dev));
309 1.16 augustss } else {
310 1.68 soren /* devinfop now contains an IEEE-1284 device ID */
311 1.68 soren len = ((devinfop[0] & 0xff) << 8) | (devinfop[1] & 0xff);
312 1.68 soren if (len > DEVINFOSIZE - 3)
313 1.68 soren len = DEVINFOSIZE - 3;
314 1.68 soren devinfop[len] = 0;
315 1.85 dyoung printf("%s: device id <", device_xname(sc->sc_dev));
316 1.68 soren ieee1284_print_id(devinfop+2);
317 1.16 augustss printf(">\n");
318 1.1 augustss }
319 1.22 augustss }
320 1.22 augustss #endif
321 1.1 augustss
322 1.97 msaitoh usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev, sc->sc_dev);
323 1.31 augustss
324 1.79 gdt DPRINTFN(1, ("ulpt_attach: sc=%p in=%d out=%d\n",
325 1.79 gdt sc, sc->sc_out, sc->sc_in));
326 1.79 gdt
327 1.85 dyoung return;
328 1.1 augustss }
329 1.1 augustss
330 1.1 augustss int
331 1.85 dyoung ulpt_activate(device_t self, enum devact act)
332 1.12 augustss {
333 1.81 cube struct ulpt_softc *sc = device_private(self);
334 1.17 augustss
335 1.17 augustss switch (act) {
336 1.17 augustss case DVACT_DEACTIVATE:
337 1.17 augustss sc->sc_dying = 1;
338 1.84 dyoung return 0;
339 1.84 dyoung default:
340 1.84 dyoung return EOPNOTSUPP;
341 1.17 augustss }
342 1.12 augustss }
343 1.12 augustss
344 1.96 skrll int
345 1.85 dyoung ulpt_detach(device_t self, int flags)
346 1.12 augustss {
347 1.85 dyoung struct ulpt_softc *sc = device_private(self);
348 1.27 augustss int s;
349 1.12 augustss int maj, mn;
350 1.12 augustss
351 1.79 gdt DPRINTFN(1, ("ulpt_detach: sc=%p\n", sc));
352 1.12 augustss
353 1.12 augustss sc->sc_dying = 1;
354 1.42 augustss if (sc->sc_out_pipe != NULL)
355 1.42 augustss usbd_abort_pipe(sc->sc_out_pipe);
356 1.42 augustss if (sc->sc_in_pipe != NULL)
357 1.42 augustss usbd_abort_pipe(sc->sc_in_pipe);
358 1.12 augustss
359 1.12 augustss s = splusb();
360 1.12 augustss if (--sc->sc_refcnt >= 0) {
361 1.12 augustss /* There is noone to wake, aborting the pipe is enough */
362 1.12 augustss /* Wait for processes to go away. */
363 1.90 mrg usb_detach_waitold(sc->sc_dev);
364 1.12 augustss }
365 1.12 augustss splx(s);
366 1.12 augustss
367 1.12 augustss /* locate the major number */
368 1.52 gehenna maj = cdevsw_lookup_major(&ulpt_cdevsw);
369 1.12 augustss
370 1.12 augustss /* Nuke the vnodes for any open instances (calls close). */
371 1.72 thorpej mn = device_unit(self);
372 1.12 augustss vdevgone(maj, mn, mn, VCHR);
373 1.57 scw vdevgone(maj, mn | ULPT_NOPRIME , mn | ULPT_NOPRIME, VCHR);
374 1.31 augustss
375 1.97 msaitoh usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, sc->sc_dev);
376 1.12 augustss
377 1.96 skrll return 0;
378 1.12 augustss }
379 1.12 augustss
380 1.12 augustss int
381 1.38 augustss ulpt_status(struct ulpt_softc *sc)
382 1.1 augustss {
383 1.1 augustss usb_device_request_t req;
384 1.28 augustss usbd_status err;
385 1.1 augustss u_char status;
386 1.1 augustss
387 1.1 augustss req.bmRequestType = UT_READ_CLASS_INTERFACE;
388 1.1 augustss req.bRequest = UR_GET_PORT_STATUS;
389 1.1 augustss USETW(req.wValue, 0);
390 1.1 augustss USETW(req.wIndex, sc->sc_ifaceno);
391 1.1 augustss USETW(req.wLength, 1);
392 1.28 augustss err = usbd_do_request(sc->sc_udev, &req, &status);
393 1.79 gdt DPRINTFN(2, ("ulpt_status: status=0x%02x err=%d\n", status, err));
394 1.28 augustss if (!err)
395 1.96 skrll return status;
396 1.1 augustss else
397 1.96 skrll return 0;
398 1.1 augustss }
399 1.1 augustss
400 1.1 augustss void
401 1.38 augustss ulpt_reset(struct ulpt_softc *sc)
402 1.1 augustss {
403 1.1 augustss usb_device_request_t req;
404 1.1 augustss
405 1.79 gdt DPRINTFN(2, ("ulpt_reset\n"));
406 1.1 augustss req.bRequest = UR_SOFT_RESET;
407 1.1 augustss USETW(req.wValue, 0);
408 1.1 augustss USETW(req.wIndex, sc->sc_ifaceno);
409 1.1 augustss USETW(req.wLength, 0);
410 1.41 augustss
411 1.41 augustss /*
412 1.41 augustss * There was a mistake in the USB printer 1.0 spec that gave the
413 1.42 augustss * request type as UT_WRITE_CLASS_OTHER; it should have been
414 1.41 augustss * UT_WRITE_CLASS_INTERFACE. Many printers use the old one,
415 1.41 augustss * so we try both.
416 1.41 augustss */
417 1.49 augustss req.bmRequestType = UT_WRITE_CLASS_OTHER;
418 1.42 augustss if (usbd_do_request(sc->sc_udev, &req, 0)) { /* 1.0 */
419 1.41 augustss req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
420 1.42 augustss (void)usbd_do_request(sc->sc_udev, &req, 0); /* 1.1 */
421 1.41 augustss }
422 1.1 augustss }
423 1.1 augustss
424 1.42 augustss int ulptusein = 1;
425 1.42 augustss
426 1.1 augustss /*
427 1.1 augustss * Reset the printer, then wait until it's selected and not busy.
428 1.1 augustss */
429 1.1 augustss int
430 1.76 christos ulptopen(dev_t dev, int flag, int mode, struct lwp *l)
431 1.1 augustss {
432 1.1 augustss u_char flags = ULPTFLAGS(dev);
433 1.26 augustss struct ulpt_softc *sc;
434 1.28 augustss usbd_status err;
435 1.1 augustss int spin, error;
436 1.26 augustss
437 1.85 dyoung sc = device_lookup_private(&ulpt_cd, ULPTUNIT(dev));
438 1.85 dyoung if (sc == NULL)
439 1.85 dyoung return ENXIO;
440 1.1 augustss
441 1.30 augustss if (sc == NULL || sc->sc_iface == NULL || sc->sc_dying)
442 1.96 skrll return ENXIO;
443 1.1 augustss
444 1.1 augustss if (sc->sc_state)
445 1.96 skrll return EBUSY;
446 1.1 augustss
447 1.1 augustss sc->sc_state = ULPT_INIT;
448 1.1 augustss sc->sc_flags = flags;
449 1.79 gdt DPRINTFN(2, ("ulptopen: flags=0x%x\n", (unsigned)flags));
450 1.1 augustss
451 1.39 augustss error = 0;
452 1.39 augustss sc->sc_refcnt++;
453 1.39 augustss
454 1.1 augustss if ((flags & ULPT_NOPRIME) == 0)
455 1.1 augustss ulpt_reset(sc);
456 1.1 augustss
457 1.1 augustss for (spin = 0; (ulpt_status(sc) & LPS_SELECT) == 0; spin += STEP) {
458 1.79 gdt DPRINTFN(2, ("ulpt_open: waiting a while\n"));
459 1.1 augustss if (spin >= TIMEOUT) {
460 1.39 augustss error = EBUSY;
461 1.1 augustss sc->sc_state = 0;
462 1.39 augustss goto done;
463 1.1 augustss }
464 1.1 augustss
465 1.1 augustss /* wait 1/4 second, give up if we get a signal */
466 1.77 christos error = tsleep((void *)sc, LPTPRI | PCATCH, "ulptop", STEP);
467 1.1 augustss if (error != EWOULDBLOCK) {
468 1.1 augustss sc->sc_state = 0;
469 1.39 augustss goto done;
470 1.39 augustss }
471 1.39 augustss
472 1.39 augustss if (sc->sc_dying) {
473 1.39 augustss error = ENXIO;
474 1.39 augustss sc->sc_state = 0;
475 1.39 augustss goto done;
476 1.1 augustss }
477 1.1 augustss }
478 1.1 augustss
479 1.42 augustss err = usbd_open_pipe(sc->sc_iface, sc->sc_out, 0, &sc->sc_out_pipe);
480 1.28 augustss if (err) {
481 1.39 augustss error = EIO;
482 1.60 augustss goto err0;
483 1.60 augustss }
484 1.96 skrll error = usbd_create_xfer(sc->sc_out_pipe, ULPT_BSIZE, 0, 0,
485 1.96 skrll &sc->sc_out_xfer);
486 1.96 skrll if (error)
487 1.60 augustss goto err2;
488 1.96 skrll sc->sc_out_buf = usbd_get_buffer(sc->sc_out_xfer);
489 1.60 augustss
490 1.42 augustss if (ulptusein && sc->sc_in != -1) {
491 1.79 gdt DPRINTFN(2, ("ulpt_open: opening input pipe %d\n", sc->sc_in));
492 1.42 augustss err = usbd_open_pipe(sc->sc_iface, sc->sc_in,0,&sc->sc_in_pipe);
493 1.42 augustss if (err) {
494 1.42 augustss error = EIO;
495 1.60 augustss goto err2;
496 1.60 augustss }
497 1.96 skrll error = usbd_create_xfer(sc->sc_in_pipe, ULPT_BSIZE,
498 1.96 skrll USBD_SHORT_XFER_OK, 0, &sc->sc_in_xfer);
499 1.96 skrll if (error)
500 1.60 augustss goto err3;
501 1.96 skrll sc->sc_in_buf = usbd_get_buffer(sc->sc_in_xfer);
502 1.68 soren /* If it's not opened for read then set up a reader. */
503 1.70 rpaulo if (!(flag & FREAD)) {
504 1.79 gdt DPRINTFN(2, ("ulpt_open: start read callout\n"));
505 1.85 dyoung callout_init(&sc->sc_read_callout, 0);
506 1.85 dyoung callout_reset(&sc->sc_read_callout, hz/5, ulpt_tick, sc);
507 1.60 augustss sc->sc_has_callout = 1;
508 1.42 augustss }
509 1.42 augustss }
510 1.1 augustss
511 1.1 augustss sc->sc_state = ULPT_OPEN;
512 1.60 augustss goto done;
513 1.60 augustss
514 1.60 augustss err3:
515 1.60 augustss usbd_close_pipe(sc->sc_in_pipe);
516 1.60 augustss sc->sc_in_pipe = NULL;
517 1.60 augustss err2:
518 1.96 skrll usbd_destroy_xfer(sc->sc_out_xfer);
519 1.60 augustss sc->sc_out_xfer = NULL;
520 1.96 skrll
521 1.60 augustss usbd_close_pipe(sc->sc_out_pipe);
522 1.60 augustss sc->sc_out_pipe = NULL;
523 1.60 augustss err0:
524 1.60 augustss sc->sc_state = 0;
525 1.1 augustss
526 1.39 augustss done:
527 1.39 augustss if (--sc->sc_refcnt < 0)
528 1.90 mrg usb_detach_wakeupold(sc->sc_dev);
529 1.39 augustss
530 1.79 gdt DPRINTFN(2, ("ulptopen: done, error=%d\n", error));
531 1.96 skrll return error;
532 1.1 augustss }
533 1.1 augustss
534 1.79 gdt /*
535 1.79 gdt * XXX Document return value semantics.
536 1.79 gdt */
537 1.1 augustss int
538 1.38 augustss ulpt_statusmsg(u_char status, struct ulpt_softc *sc)
539 1.1 augustss {
540 1.1 augustss u_char new;
541 1.1 augustss
542 1.1 augustss status = (status ^ LPS_INVERT) & LPS_MASK;
543 1.1 augustss new = status & ~sc->sc_laststatus;
544 1.1 augustss sc->sc_laststatus = status;
545 1.1 augustss
546 1.1 augustss if (new & LPS_SELECT)
547 1.85 dyoung log(LOG_NOTICE, "%s: offline\n", device_xname(sc->sc_dev));
548 1.79 gdt if (new & LPS_NOPAPER)
549 1.85 dyoung log(LOG_NOTICE, "%s: out of paper\n", device_xname(sc->sc_dev));
550 1.79 gdt if (new & LPS_NERR)
551 1.85 dyoung log(LOG_NOTICE, "%s: output error\n", device_xname(sc->sc_dev));
552 1.1 augustss
553 1.96 skrll return status;
554 1.1 augustss }
555 1.1 augustss
556 1.1 augustss int
557 1.76 christos ulptclose(dev_t dev, int flag, int mode,
558 1.76 christos struct lwp *l)
559 1.1 augustss {
560 1.26 augustss struct ulpt_softc *sc;
561 1.26 augustss
562 1.85 dyoung sc = device_lookup_private(&ulpt_cd, ULPTUNIT(dev));
563 1.13 augustss
564 1.13 augustss if (sc->sc_state != ULPT_OPEN)
565 1.13 augustss /* We are being forced to close before the open completed. */
566 1.96 skrll return 0;
567 1.1 augustss
568 1.60 augustss if (sc->sc_has_callout) {
569 1.79 gdt DPRINTFN(2, ("ulptclose: stopping read callout\n"));
570 1.92 martin callout_halt(&sc->sc_read_callout, NULL);
571 1.92 martin callout_destroy(&sc->sc_read_callout);
572 1.60 augustss sc->sc_has_callout = 0;
573 1.60 augustss }
574 1.60 augustss
575 1.42 augustss if (sc->sc_out_pipe != NULL) {
576 1.60 augustss usbd_abort_pipe(sc->sc_out_pipe);
577 1.42 augustss }
578 1.60 augustss if (sc->sc_out_xfer != NULL) {
579 1.96 skrll usbd_destroy_xfer(sc->sc_out_xfer);
580 1.60 augustss sc->sc_out_xfer = NULL;
581 1.60 augustss }
582 1.96 skrll if (sc->sc_out_pipe != NULL) {
583 1.96 skrll usbd_close_pipe(sc->sc_out_pipe);
584 1.96 skrll sc->sc_out_pipe = NULL;
585 1.96 skrll }
586 1.42 augustss if (sc->sc_in_pipe != NULL) {
587 1.42 augustss usbd_abort_pipe(sc->sc_in_pipe);
588 1.60 augustss }
589 1.60 augustss if (sc->sc_in_xfer != NULL) {
590 1.96 skrll usbd_destroy_xfer(sc->sc_in_xfer);
591 1.60 augustss sc->sc_in_xfer = NULL;
592 1.42 augustss }
593 1.96 skrll if (sc->sc_in_pipe != NULL) {
594 1.96 skrll usbd_close_pipe(sc->sc_in_pipe);
595 1.96 skrll sc->sc_in_pipe = NULL;
596 1.96 skrll }
597 1.1 augustss
598 1.1 augustss sc->sc_state = 0;
599 1.1 augustss
600 1.79 gdt DPRINTFN(2, ("ulptclose: closed\n"));
601 1.96 skrll return 0;
602 1.1 augustss }
603 1.1 augustss
604 1.1 augustss int
605 1.76 christos ulpt_do_write(struct ulpt_softc *sc, struct uio *uio, int flags)
606 1.1 augustss {
607 1.96 skrll uint32_t n;
608 1.1 augustss int error = 0;
609 1.23 augustss void *bufp;
610 1.96 skrll struct usbd_xfer *xfer;
611 1.28 augustss usbd_status err;
612 1.1 augustss
613 1.79 gdt DPRINTFN(3, ("ulptwrite\n"));
614 1.60 augustss xfer = sc->sc_out_xfer;
615 1.60 augustss bufp = sc->sc_out_buf;
616 1.1 augustss while ((n = min(ULPT_BSIZE, uio->uio_resid)) != 0) {
617 1.1 augustss ulpt_statusmsg(ulpt_status(sc), sc);
618 1.23 augustss error = uiomove(bufp, n, uio);
619 1.6 augustss if (error)
620 1.6 augustss break;
621 1.79 gdt DPRINTFN(4, ("ulptwrite: transfer %d bytes\n", n));
622 1.96 skrll err = usbd_bulk_transfer(xfer, sc->sc_out_pipe, 0,
623 1.96 skrll USBD_NO_TIMEOUT, bufp, &n);
624 1.28 augustss if (err) {
625 1.79 gdt DPRINTFN(3, ("ulptwrite: error=%d\n", err));
626 1.1 augustss error = EIO;
627 1.1 augustss break;
628 1.1 augustss }
629 1.1 augustss }
630 1.12 augustss
631 1.96 skrll return error;
632 1.12 augustss }
633 1.12 augustss
634 1.12 augustss int
635 1.38 augustss ulptwrite(dev_t dev, struct uio *uio, int flags)
636 1.12 augustss {
637 1.26 augustss struct ulpt_softc *sc;
638 1.26 augustss int error;
639 1.26 augustss
640 1.85 dyoung sc = device_lookup_private(&ulpt_cd, ULPTUNIT(dev));
641 1.21 augustss
642 1.21 augustss if (sc->sc_dying)
643 1.96 skrll return EIO;
644 1.12 augustss
645 1.12 augustss sc->sc_refcnt++;
646 1.12 augustss error = ulpt_do_write(sc, uio, flags);
647 1.12 augustss if (--sc->sc_refcnt < 0)
648 1.90 mrg usb_detach_wakeupold(sc->sc_dev);
649 1.96 skrll return error;
650 1.1 augustss }
651 1.1 augustss
652 1.79 gdt /*
653 1.79 gdt * Perform a read operation according to the given uio.
654 1.79 gdt * This should respect nonblocking I/O status.
655 1.96 skrll *
656 1.79 gdt * XXX Doing a short read when more data is available seems to be
657 1.79 gdt * problematic. See
658 1.79 gdt * http://www.freebsd.org/cgi/query-pr.cgi?pr=91538&cat= for a fix.
659 1.79 gdt * However, this will be unnecessary given a proper fix for the next
660 1.79 gdt * problem, and most actual callers read a lot.
661 1.79 gdt *
662 1.79 gdt * XXX This code should interact properly with select/poll, and that
663 1.79 gdt * requires the USB transactions to be queued and function before the
664 1.79 gdt * user does a read. Read will then consume data from a buffer, and
665 1.79 gdt * not interact with the device. See ucom.c for an example of how to
666 1.79 gdt * do this.
667 1.79 gdt */
668 1.1 augustss int
669 1.76 christos ulpt_do_read(struct ulpt_softc *sc, struct uio *uio, int flags)
670 1.60 augustss {
671 1.96 skrll uint32_t n, nread, nreq;
672 1.79 gdt int error = 0, nonblocking, timeout;
673 1.60 augustss void *bufp;
674 1.96 skrll struct usbd_xfer *xfer;
675 1.79 gdt usbd_status err = USBD_NORMAL_COMPLETION;
676 1.60 augustss
677 1.79 gdt /* XXX Resolve with background reader process. KASSERT? */
678 1.79 gdt if (sc->sc_in_pipe == NULL)
679 1.79 gdt return EIO;
680 1.60 augustss
681 1.79 gdt if (flags & IO_NDELAY)
682 1.79 gdt nonblocking = 1;
683 1.79 gdt else
684 1.79 gdt nonblocking = 0;
685 1.79 gdt
686 1.79 gdt if (nonblocking)
687 1.79 gdt timeout = USBD_DEFAULT_TIMEOUT; /* 5 ms */
688 1.79 gdt else
689 1.79 gdt timeout = USBD_NO_TIMEOUT;
690 1.79 gdt
691 1.82 bouyer DPRINTFN(3, ("ulptread nonblocking=%d uio_reside=%ld timeout=%d\n",
692 1.82 bouyer nonblocking, (u_long)uio->uio_resid, timeout));
693 1.60 augustss
694 1.60 augustss xfer = sc->sc_in_xfer;
695 1.60 augustss bufp = sc->sc_in_buf;
696 1.79 gdt nread = 0;
697 1.79 gdt while ((nreq = min(ULPT_BSIZE, uio->uio_resid)) != 0) {
698 1.79 gdt KASSERT(error == 0);
699 1.79 gdt if (error != 0) {
700 1.79 gdt printf("ulptread: pre-switch error %d != 0", error);
701 1.79 gdt goto done;
702 1.79 gdt }
703 1.79 gdt
704 1.79 gdt /*
705 1.79 gdt * XXX Even with the short timeout, this will tsleep,
706 1.79 gdt * but it should be adequately prompt in practice.
707 1.79 gdt */
708 1.79 gdt n = nreq;
709 1.79 gdt DPRINTFN(4, ("ulptread: transfer %d bytes, nonblocking=%d timeout=%d\n",
710 1.79 gdt n, nonblocking, timeout));
711 1.60 augustss err = usbd_bulk_transfer(xfer, sc->sc_in_pipe,
712 1.96 skrll USBD_SHORT_XFER_OK, timeout, bufp, &n);
713 1.79 gdt
714 1.79 gdt DPRINTFN(4, ("ulptread: transfer complete nreq %d n %d nread %d err %d\n",
715 1.79 gdt nreq, n, nread, err));
716 1.79 gdt /*
717 1.79 gdt * Process "err" return, jumping to done if we set "error".
718 1.79 gdt */
719 1.79 gdt switch (err) {
720 1.79 gdt case USBD_NORMAL_COMPLETION:
721 1.79 gdt if (n == 0) {
722 1.79 gdt DPRINTFN(3, ("ulptread: NORMAL n==0\n"));
723 1.79 gdt }
724 1.79 gdt break;
725 1.79 gdt
726 1.79 gdt case USBD_SHORT_XFER:
727 1.79 gdt /* We said SHORT_XFER_OK, so shouldn't happen. */
728 1.79 gdt DPRINTFN(3, ("ulptread: SHORT n=%d\n", n));
729 1.79 gdt break;
730 1.79 gdt
731 1.79 gdt case USBD_TIMEOUT:
732 1.79 gdt if (nonblocking == 0) {
733 1.79 gdt /* XXX Cannot happen; perhaps KASSERT. */
734 1.79 gdt printf("ulptread: timeout in blocking mode\n");
735 1.79 gdt error = EIO;
736 1.79 gdt goto done;
737 1.79 gdt }
738 1.79 gdt
739 1.79 gdt DPRINTFN(3, ("ulptread: TIMEOUT n %d nread %d error %d\n",
740 1.79 gdt n, nread, error));
741 1.79 gdt /*
742 1.79 gdt * Don't set error until we understand why
743 1.79 gdt * this happens.
744 1.79 gdt */
745 1.79 gdt break;
746 1.79 gdt
747 1.79 gdt case USBD_INTERRUPTED:
748 1.79 gdt /*
749 1.79 gdt * The tsleep in usbd_bulk_transfer was
750 1.79 gdt * interrupted. Reflect it to the caller so
751 1.79 gdt * that reading can be interrupted.
752 1.79 gdt */
753 1.79 gdt error = EINTR;
754 1.79 gdt DPRINTFN(3, ("ulptread: EINTR error %d\n", error));
755 1.79 gdt goto done;
756 1.79 gdt break;
757 1.79 gdt
758 1.79 gdt default:
759 1.79 gdt /* Assume all other return codes are really errors. */
760 1.60 augustss error = EIO;
761 1.79 gdt DPRINTFN(3, ("ulptread: n %d err %d error %d\n",
762 1.79 gdt n, err, error));
763 1.79 gdt goto done;
764 1.60 augustss break;
765 1.60 augustss }
766 1.79 gdt /* XXX KASSERT */
767 1.79 gdt if (error != 0) {
768 1.79 gdt printf("ulptread: post-switch error %d != 0", error);
769 1.79 gdt goto done;
770 1.79 gdt }
771 1.79 gdt
772 1.79 gdt if (n > 0) {
773 1.79 gdt /*
774 1.79 gdt * Record progress to enable later choosing
775 1.79 gdt * between short reads and EWOULDBLOCK.
776 1.79 gdt */
777 1.79 gdt nread += n;
778 1.79 gdt
779 1.79 gdt /* Copy to userspace, giving up on any error. */
780 1.79 gdt error = uiomove(bufp, n, uio);
781 1.79 gdt if (error != 0)
782 1.79 gdt break;
783 1.79 gdt } else {
784 1.79 gdt /*
785 1.79 gdt * We read 0 bytes, and therefore are done,
786 1.79 gdt * even if we aren't in nonblocking mode.
787 1.79 gdt */
788 1.79 gdt if (error == 0 && nread == 0)
789 1.79 gdt error = EWOULDBLOCK;
790 1.79 gdt DPRINTFN(3, ("ulptread: read 0=>done error %d\n",
791 1.79 gdt error));
792 1.79 gdt goto done;
793 1.79 gdt }
794 1.79 gdt
795 1.79 gdt /*
796 1.79 gdt * A short transfer indicates no more data will be
797 1.79 gdt * forthcoming. Terminate this read regardless of
798 1.79 gdt * whether we are in nonblocking mode. XXX Reconsider
799 1.79 gdt * for blocking mode; maybe we should continue to
800 1.79 gdt * block, but maybe it just doesn't make senes to do
801 1.79 gdt * blocking reads from devices like this.
802 1.79 gdt */
803 1.79 gdt if (err == USBD_SHORT_XFER) {
804 1.79 gdt DPRINTFN(3, ("ulptread: SHORT=>done n %d nread %d err %d error %d\n",
805 1.79 gdt n, nread, err, error));
806 1.60 augustss break;
807 1.79 gdt }
808 1.60 augustss }
809 1.60 augustss
810 1.79 gdt done:
811 1.79 gdt DPRINTFN(3, ("ulptread: finished n %d nread %d err %d error %d\n",
812 1.79 gdt n, nread, err, error));
813 1.96 skrll return error;
814 1.60 augustss }
815 1.60 augustss
816 1.60 augustss int
817 1.60 augustss ulptread(dev_t dev, struct uio *uio, int flags)
818 1.60 augustss {
819 1.60 augustss struct ulpt_softc *sc;
820 1.60 augustss int error;
821 1.60 augustss
822 1.85 dyoung sc = device_lookup_private(&ulpt_cd, ULPTUNIT(dev));
823 1.60 augustss
824 1.60 augustss if (sc->sc_dying)
825 1.96 skrll return EIO;
826 1.60 augustss
827 1.60 augustss sc->sc_refcnt++;
828 1.60 augustss error = ulpt_do_read(sc, uio, flags);
829 1.60 augustss if (--sc->sc_refcnt < 0)
830 1.90 mrg usb_detach_wakeupold(sc->sc_dev);
831 1.96 skrll return error;
832 1.60 augustss }
833 1.60 augustss
834 1.60 augustss void
835 1.96 skrll ulpt_read_cb(struct usbd_xfer *xfer, void *priv,
836 1.76 christos usbd_status status)
837 1.60 augustss {
838 1.60 augustss usbd_status err;
839 1.96 skrll uint32_t n;
840 1.96 skrll void *xsc;
841 1.60 augustss struct ulpt_softc *sc;
842 1.60 augustss
843 1.60 augustss usbd_get_xfer_status(xfer, &xsc, NULL, &n, &err);
844 1.60 augustss sc = xsc;
845 1.60 augustss
846 1.79 gdt DPRINTFN(4, ("ulpt_read_cb: start sc=%p, err=%d n=%d\n", sc, err, n));
847 1.60 augustss
848 1.60 augustss #ifdef ULPT_DEBUG
849 1.60 augustss if (!err && n > 0)
850 1.79 gdt DPRINTFN(3, ("ulpt_tick: discarding %d bytes\n", n));
851 1.60 augustss #endif
852 1.60 augustss if (!err || err == USBD_TIMEOUT)
853 1.85 dyoung callout_reset(&sc->sc_read_callout, hz / ULPT_READS_PER_SEC,
854 1.60 augustss ulpt_tick, sc);
855 1.60 augustss }
856 1.60 augustss
857 1.79 gdt /*
858 1.79 gdt * For devices which are not opened for reading, this function is
859 1.79 gdt * called continuously to start read bulk transfers to avoid the
860 1.79 gdt * printer overflowing its output buffer.
861 1.96 skrll *
862 1.79 gdt * XXX This should be adapted for continuous reads to allow select to
863 1.79 gdt * work; see do_ulpt_read().
864 1.79 gdt */
865 1.60 augustss void
866 1.60 augustss ulpt_tick(void *xsc)
867 1.60 augustss {
868 1.60 augustss struct ulpt_softc *sc = xsc;
869 1.93 martin usbd_status err __unused;
870 1.60 augustss
871 1.60 augustss if (sc == NULL || sc->sc_dying)
872 1.60 augustss return;
873 1.60 augustss
874 1.96 skrll usbd_setup_xfer(sc->sc_in_xfer, sc, sc->sc_in_buf, ULPT_BSIZE,
875 1.96 skrll USBD_SHORT_XFER_OK, ULPT_READ_TIMO, ulpt_read_cb);
876 1.60 augustss err = usbd_transfer(sc->sc_in_xfer);
877 1.79 gdt DPRINTFN(3, ("ulpt_tick: sc=%p err=%d\n", sc, err));
878 1.60 augustss }
879 1.60 augustss
880 1.60 augustss int
881 1.77 christos ulptioctl(dev_t dev, u_long cmd, void *data,
882 1.76 christos int flag, struct lwp *l)
883 1.1 augustss {
884 1.93 martin #if 0
885 1.79 gdt struct ulpt_softc *sc;
886 1.79 gdt
887 1.85 dyoung sc = device_lookup_private(&ulpt_cd, ULPTUNIT(dev));
888 1.93 martin #endif
889 1.79 gdt
890 1.79 gdt switch (cmd) {
891 1.79 gdt case FIONBIO:
892 1.79 gdt return 0;
893 1.79 gdt }
894 1.79 gdt
895 1.75 christos return ENODEV;
896 1.16 augustss }
897 1.16 augustss
898 1.22 augustss #if 0
899 1.16 augustss /* XXX This does not belong here. */
900 1.16 augustss /*
901 1.17 augustss * Print select parts of a IEEE 1284 device ID.
902 1.16 augustss */
903 1.16 augustss void
904 1.38 augustss ieee1284_print_id(char *str)
905 1.16 augustss {
906 1.16 augustss char *p, *q;
907 1.16 augustss
908 1.16 augustss for (p = str-1; p; p = strchr(p, ';')) {
909 1.16 augustss p++; /* skip ';' */
910 1.16 augustss if (strncmp(p, "MFG:", 4) == 0 ||
911 1.16 augustss strncmp(p, "MANUFACTURER:", 14) == 0 ||
912 1.16 augustss strncmp(p, "MDL:", 4) == 0 ||
913 1.16 augustss strncmp(p, "MODEL:", 6) == 0) {
914 1.16 augustss q = strchr(p, ';');
915 1.16 augustss if (q)
916 1.16 augustss printf("%.*s", (int)(q - p + 1), p);
917 1.16 augustss }
918 1.16 augustss }
919 1.1 augustss }
920 1.22 augustss #endif
921