ppi.c revision 1.42 1 1.42 tsutsui /* $NetBSD: ppi.c,v 1.42 2008/06/18 12:25:13 tsutsui Exp $ */
2 1.15 thorpej
3 1.15 thorpej /*-
4 1.15 thorpej * Copyright (c) 1996, 1997 The NetBSD Foundation, Inc.
5 1.15 thorpej * All rights reserved.
6 1.15 thorpej *
7 1.15 thorpej * This code is derived from software contributed to The NetBSD Foundation
8 1.15 thorpej * by Jason R. Thorpe.
9 1.15 thorpej *
10 1.15 thorpej * Redistribution and use in source and binary forms, with or without
11 1.15 thorpej * modification, are permitted provided that the following conditions
12 1.15 thorpej * are met:
13 1.15 thorpej * 1. Redistributions of source code must retain the above copyright
14 1.15 thorpej * notice, this list of conditions and the following disclaimer.
15 1.15 thorpej * 2. Redistributions in binary form must reproduce the above copyright
16 1.15 thorpej * notice, this list of conditions and the following disclaimer in the
17 1.15 thorpej * documentation and/or other materials provided with the distribution.
18 1.15 thorpej *
19 1.15 thorpej * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.15 thorpej * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.15 thorpej * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.15 thorpej * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.15 thorpej * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.15 thorpej * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.15 thorpej * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.15 thorpej * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.15 thorpej * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.15 thorpej * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.15 thorpej * POSSIBILITY OF SUCH DAMAGE.
30 1.15 thorpej */
31 1.6 cgd
32 1.1 cgd /*
33 1.5 mycroft * Copyright (c) 1982, 1990, 1993
34 1.5 mycroft * The Regents of the University of California. All rights reserved.
35 1.1 cgd *
36 1.1 cgd * Redistribution and use in source and binary forms, with or without
37 1.1 cgd * modification, are permitted provided that the following conditions
38 1.1 cgd * are met:
39 1.1 cgd * 1. Redistributions of source code must retain the above copyright
40 1.1 cgd * notice, this list of conditions and the following disclaimer.
41 1.1 cgd * 2. Redistributions in binary form must reproduce the above copyright
42 1.1 cgd * notice, this list of conditions and the following disclaimer in the
43 1.1 cgd * documentation and/or other materials provided with the distribution.
44 1.27 agc * 3. Neither the name of the University nor the names of its contributors
45 1.1 cgd * may be used to endorse or promote products derived from this software
46 1.1 cgd * without specific prior written permission.
47 1.1 cgd *
48 1.1 cgd * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
49 1.1 cgd * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
50 1.1 cgd * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
51 1.1 cgd * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
52 1.1 cgd * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
53 1.1 cgd * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
54 1.1 cgd * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
55 1.1 cgd * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
56 1.1 cgd * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
57 1.1 cgd * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
58 1.1 cgd * SUCH DAMAGE.
59 1.1 cgd *
60 1.6 cgd * @(#)ppi.c 8.1 (Berkeley) 6/16/93
61 1.1 cgd */
62 1.1 cgd
63 1.1 cgd /*
64 1.1 cgd * Printer/Plotter HPIB interface
65 1.1 cgd */
66 1.20 gmcgarry
67 1.20 gmcgarry #include <sys/cdefs.h>
68 1.42 tsutsui __KERNEL_RCSID(0, "$NetBSD: ppi.c,v 1.42 2008/06/18 12:25:13 tsutsui Exp $");
69 1.1 cgd
70 1.3 mycroft #include <sys/param.h>
71 1.3 mycroft #include <sys/systm.h>
72 1.18 thorpej #include <sys/callout.h>
73 1.12 scottr #include <sys/conf.h>
74 1.12 scottr #include <sys/device.h>
75 1.3 mycroft #include <sys/errno.h>
76 1.12 scottr #include <sys/malloc.h>
77 1.12 scottr #include <sys/proc.h>
78 1.3 mycroft #include <sys/uio.h>
79 1.11 thorpej
80 1.11 thorpej #include <hp300/dev/hpibvar.h>
81 1.1 cgd
82 1.3 mycroft #include <hp300/dev/ppiioctl.h>
83 1.1 cgd
84 1.30 tsutsui #include "ioconf.h"
85 1.30 tsutsui
86 1.1 cgd struct ppi_softc {
87 1.39 tsutsui device_t sc_dev;
88 1.1 cgd int sc_flags;
89 1.11 thorpej struct hpibqueue sc_hq; /* HP-IB job queue entry */
90 1.1 cgd struct ppiparam sc_param;
91 1.1 cgd #define sc_burst sc_param.burst
92 1.1 cgd #define sc_timo sc_param.timo
93 1.1 cgd #define sc_delay sc_param.delay
94 1.1 cgd int sc_sec;
95 1.11 thorpej int sc_slave; /* HP-IB slave address */
96 1.18 thorpej struct callout sc_timo_ch;
97 1.18 thorpej struct callout sc_start_ch;
98 1.11 thorpej };
99 1.1 cgd
100 1.1 cgd /* sc_flags values */
101 1.28 tsutsui #define PPIF_ALIVE 0x01
102 1.28 tsutsui #define PPIF_OPEN 0x02
103 1.1 cgd #define PPIF_UIO 0x04
104 1.1 cgd #define PPIF_TIMO 0x08
105 1.1 cgd #define PPIF_DELAY 0x10
106 1.1 cgd
107 1.39 tsutsui static int ppimatch(device_t, cfdata_t, void *);
108 1.39 tsutsui static void ppiattach(device_t, device_t, void *);
109 1.11 thorpej
110 1.39 tsutsui CFATTACH_DECL_NEW(ppi, sizeof(struct ppi_softc),
111 1.23 thorpej ppimatch, ppiattach, NULL, NULL);
112 1.11 thorpej
113 1.29 thorpej static dev_type_open(ppiopen);
114 1.29 thorpej static dev_type_close(ppiclose);
115 1.29 thorpej static dev_type_read(ppiread);
116 1.29 thorpej static dev_type_write(ppiwrite);
117 1.29 thorpej static dev_type_ioctl(ppiioctl);
118 1.21 gehenna
119 1.21 gehenna const struct cdevsw ppi_cdevsw = {
120 1.21 gehenna ppiopen, ppiclose, ppiread, ppiwrite, ppiioctl,
121 1.24 jdolecek nostop, notty, nopoll, nommap, nokqfilter,
122 1.21 gehenna };
123 1.21 gehenna
124 1.29 thorpej static void ppistart(void *);
125 1.29 thorpej static void ppinoop(void *);
126 1.11 thorpej
127 1.29 thorpej static void ppitimo(void *);
128 1.29 thorpej static int ppirw(dev_t, struct uio *);
129 1.29 thorpej static int ppihztoms(int);
130 1.29 thorpej static int ppimstohz(int);
131 1.11 thorpej
132 1.1 cgd #define UNIT(x) minor(x)
133 1.1 cgd
134 1.1 cgd #ifdef DEBUG
135 1.1 cgd int ppidebug = 0x80;
136 1.1 cgd #define PDB_FOLLOW 0x01
137 1.1 cgd #define PDB_IO 0x02
138 1.1 cgd #define PDB_NOCHECK 0x80
139 1.1 cgd #endif
140 1.1 cgd
141 1.29 thorpej static int
142 1.39 tsutsui ppimatch(device_t parent, cfdata_t cf, void *aux)
143 1.1 cgd {
144 1.11 thorpej struct hpibbus_attach_args *ha = aux;
145 1.11 thorpej
146 1.11 thorpej /*
147 1.11 thorpej * The printer/plotter doesn't return an ID tag.
148 1.11 thorpej * The check below prevents us from matching a CS80
149 1.11 thorpej * device by mistake.
150 1.11 thorpej */
151 1.11 thorpej if (ha->ha_id & 0x200)
152 1.34 tsutsui return 0;
153 1.1 cgd
154 1.1 cgd /*
155 1.11 thorpej * To prevent matching all unused slots on the bus, we
156 1.11 thorpej * don't allow wildcarded locators.
157 1.1 cgd */
158 1.39 tsutsui if (cf->hpibbuscf_slave == HPIBBUSCF_SLAVE_DEFAULT ||
159 1.39 tsutsui cf->hpibbuscf_punit == HPIBBUSCF_PUNIT_DEFAULT)
160 1.34 tsutsui return 0;
161 1.7 thorpej
162 1.34 tsutsui return 1;
163 1.7 thorpej }
164 1.7 thorpej
165 1.29 thorpej static void
166 1.39 tsutsui ppiattach(device_t parent, device_t self, void *aux)
167 1.7 thorpej {
168 1.39 tsutsui struct ppi_softc *sc = device_private(self);
169 1.11 thorpej struct hpibbus_attach_args *ha = aux;
170 1.7 thorpej
171 1.39 tsutsui sc->sc_dev = self;
172 1.39 tsutsui aprint_normal("\n");
173 1.7 thorpej
174 1.11 thorpej sc->sc_slave = ha->ha_slave;
175 1.11 thorpej
176 1.37 he callout_init(&sc->sc_timo_ch, 0);
177 1.37 he callout_init(&sc->sc_start_ch, 0);
178 1.18 thorpej
179 1.11 thorpej /* Initialize the hpib queue entry. */
180 1.11 thorpej sc->sc_hq.hq_softc = sc;
181 1.11 thorpej sc->sc_hq.hq_slave = sc->sc_slave;
182 1.11 thorpej sc->sc_hq.hq_start = ppistart;
183 1.11 thorpej sc->sc_hq.hq_go = ppinoop;
184 1.11 thorpej sc->sc_hq.hq_intr = ppinoop;
185 1.11 thorpej
186 1.1 cgd sc->sc_flags = PPIF_ALIVE;
187 1.1 cgd }
188 1.1 cgd
189 1.29 thorpej static void
190 1.29 thorpej ppinoop(void *arg)
191 1.11 thorpej {
192 1.11 thorpej /* Noop! */
193 1.11 thorpej }
194 1.11 thorpej
195 1.11 thorpej int
196 1.31 christos ppiopen(dev_t dev, int flags, int fmt, struct lwp *l)
197 1.1 cgd {
198 1.11 thorpej struct ppi_softc *sc;
199 1.11 thorpej
200 1.41 cegger sc = device_lookup_private(&ppi_cd,UNIT(dev));
201 1.41 cegger if (sc == NULL)
202 1.41 cegger return ENXIO;
203 1.41 cegger
204 1.42 tsutsui if ((sc->sc_flags & PPIF_ALIVE) == 0)
205 1.34 tsutsui return ENXIO;
206 1.1 cgd
207 1.1 cgd #ifdef DEBUG
208 1.1 cgd if (ppidebug & PDB_FOLLOW)
209 1.10 christos printf("ppiopen(%x, %x): flags %x\n",
210 1.1 cgd dev, flags, sc->sc_flags);
211 1.1 cgd #endif
212 1.1 cgd if (sc->sc_flags & PPIF_OPEN)
213 1.34 tsutsui return EBUSY;
214 1.1 cgd sc->sc_flags |= PPIF_OPEN;
215 1.1 cgd sc->sc_burst = PPI_BURST;
216 1.1 cgd sc->sc_timo = ppimstohz(PPI_TIMO);
217 1.1 cgd sc->sc_delay = ppimstohz(PPI_DELAY);
218 1.1 cgd sc->sc_sec = -1;
219 1.34 tsutsui return 0;
220 1.1 cgd }
221 1.1 cgd
222 1.29 thorpej static int
223 1.31 christos ppiclose(dev_t dev, int flags, int fmt, struct lwp *l)
224 1.1 cgd {
225 1.41 cegger struct ppi_softc *sc = device_lookup_private(&ppi_cd, UNIT(dev));
226 1.1 cgd
227 1.1 cgd #ifdef DEBUG
228 1.1 cgd if (ppidebug & PDB_FOLLOW)
229 1.10 christos printf("ppiclose(%x, %x): flags %x\n",
230 1.1 cgd dev, flags, sc->sc_flags);
231 1.1 cgd #endif
232 1.1 cgd sc->sc_flags &= ~PPIF_OPEN;
233 1.34 tsutsui return 0;
234 1.1 cgd }
235 1.1 cgd
236 1.29 thorpej static void
237 1.29 thorpej ppistart(void *arg)
238 1.1 cgd {
239 1.11 thorpej struct ppi_softc *sc = arg;
240 1.11 thorpej
241 1.1 cgd #ifdef DEBUG
242 1.1 cgd if (ppidebug & PDB_FOLLOW)
243 1.39 tsutsui printf("ppistart(%x)\n", device_unit(sc->sc_dev));
244 1.1 cgd #endif
245 1.11 thorpej sc->sc_flags &= ~PPIF_DELAY;
246 1.11 thorpej wakeup(sc);
247 1.1 cgd }
248 1.1 cgd
249 1.29 thorpej static void
250 1.29 thorpej ppitimo(void *arg)
251 1.1 cgd {
252 1.11 thorpej struct ppi_softc *sc = arg;
253 1.11 thorpej
254 1.1 cgd #ifdef DEBUG
255 1.1 cgd if (ppidebug & PDB_FOLLOW)
256 1.39 tsutsui printf("ppitimo(%x)\n", device_unit(sc->sc_dev));
257 1.1 cgd #endif
258 1.11 thorpej sc->sc_flags &= ~(PPIF_UIO|PPIF_TIMO);
259 1.11 thorpej wakeup(sc);
260 1.1 cgd }
261 1.1 cgd
262 1.29 thorpej static int
263 1.29 thorpej ppiread(dev_t dev, struct uio *uio, int flags)
264 1.1 cgd {
265 1.1 cgd
266 1.1 cgd #ifdef DEBUG
267 1.1 cgd if (ppidebug & PDB_FOLLOW)
268 1.13 scottr printf("ppiread(%x, %p)\n", dev, uio);
269 1.1 cgd #endif
270 1.34 tsutsui return ppirw(dev, uio);
271 1.1 cgd }
272 1.1 cgd
273 1.29 thorpej static int
274 1.29 thorpej ppiwrite(dev_t dev, struct uio *uio, int flags)
275 1.1 cgd {
276 1.1 cgd
277 1.1 cgd #ifdef DEBUG
278 1.1 cgd if (ppidebug & PDB_FOLLOW)
279 1.13 scottr printf("ppiwrite(%x, %p)\n", dev, uio);
280 1.1 cgd #endif
281 1.34 tsutsui return ppirw(dev, uio);
282 1.1 cgd }
283 1.1 cgd
284 1.29 thorpej static int
285 1.29 thorpej ppirw(dev_t dev, struct uio *uio)
286 1.1 cgd {
287 1.41 cegger struct ppi_softc *sc = device_lookup_private(&ppi_cd, UNIT(dev));
288 1.35 ad int s, s2, len, cnt;
289 1.12 scottr char *cp;
290 1.1 cgd int error = 0, gotdata = 0;
291 1.11 thorpej int buflen, ctlr, slave;
292 1.1 cgd char *buf;
293 1.1 cgd
294 1.1 cgd if (uio->uio_resid == 0)
295 1.34 tsutsui return 0;
296 1.1 cgd
297 1.39 tsutsui ctlr = device_unit(device_parent(sc->sc_dev));
298 1.11 thorpej slave = sc->sc_slave;
299 1.11 thorpej
300 1.1 cgd #ifdef DEBUG
301 1.1 cgd if (ppidebug & (PDB_FOLLOW|PDB_IO))
302 1.13 scottr printf("ppirw(%x, %p, %c): burst %d, timo %d, resid %x\n",
303 1.1 cgd dev, uio, uio->uio_rw == UIO_READ ? 'R' : 'W',
304 1.1 cgd sc->sc_burst, sc->sc_timo, uio->uio_resid);
305 1.1 cgd #endif
306 1.5 mycroft buflen = min(sc->sc_burst, uio->uio_resid);
307 1.1 cgd buf = (char *)malloc(buflen, M_DEVBUF, M_WAITOK);
308 1.1 cgd sc->sc_flags |= PPIF_UIO;
309 1.1 cgd if (sc->sc_timo > 0) {
310 1.1 cgd sc->sc_flags |= PPIF_TIMO;
311 1.18 thorpej callout_reset(&sc->sc_timo_ch, sc->sc_timo, ppitimo, sc);
312 1.1 cgd }
313 1.12 scottr len = cnt = 0;
314 1.1 cgd while (uio->uio_resid > 0) {
315 1.5 mycroft len = min(buflen, uio->uio_resid);
316 1.1 cgd cp = buf;
317 1.1 cgd if (uio->uio_rw == UIO_WRITE) {
318 1.1 cgd error = uiomove(cp, len, uio);
319 1.1 cgd if (error)
320 1.1 cgd break;
321 1.1 cgd }
322 1.1 cgd again:
323 1.35 ad s = splsoftclock();
324 1.35 ad s2 = splbio();
325 1.11 thorpej if ((sc->sc_flags & PPIF_UIO) &&
326 1.39 tsutsui hpibreq(device_parent(sc->sc_dev), &sc->sc_hq) == 0)
327 1.19 thorpej (void) tsleep(sc, PRIBIO + 1, "ppirw", 0);
328 1.1 cgd /*
329 1.1 cgd * Check if we timed out during sleep or uiomove
330 1.1 cgd */
331 1.35 ad splx(s2);
332 1.1 cgd if ((sc->sc_flags & PPIF_UIO) == 0) {
333 1.1 cgd #ifdef DEBUG
334 1.1 cgd if (ppidebug & PDB_IO)
335 1.10 christos printf("ppirw: uiomove/sleep timo, flags %x\n",
336 1.1 cgd sc->sc_flags);
337 1.1 cgd #endif
338 1.1 cgd if (sc->sc_flags & PPIF_TIMO) {
339 1.18 thorpej callout_stop(&sc->sc_timo_ch);
340 1.1 cgd sc->sc_flags &= ~PPIF_TIMO;
341 1.1 cgd }
342 1.1 cgd splx(s);
343 1.1 cgd break;
344 1.1 cgd }
345 1.1 cgd splx(s);
346 1.1 cgd /*
347 1.1 cgd * Perform the operation
348 1.1 cgd */
349 1.1 cgd if (uio->uio_rw == UIO_WRITE)
350 1.11 thorpej cnt = hpibsend(ctlr, slave, sc->sc_sec, cp, len);
351 1.1 cgd else
352 1.11 thorpej cnt = hpibrecv(ctlr, slave, sc->sc_sec, cp, len);
353 1.1 cgd s = splbio();
354 1.39 tsutsui hpibfree(device_parent(sc->sc_dev), &sc->sc_hq);
355 1.1 cgd #ifdef DEBUG
356 1.1 cgd if (ppidebug & PDB_IO)
357 1.13 scottr printf("ppirw: %s(%d, %d, %x, %p, %d) -> %d\n",
358 1.1 cgd uio->uio_rw == UIO_READ ? "recv" : "send",
359 1.11 thorpej ctlr, slave, sc->sc_sec, cp, len, cnt);
360 1.1 cgd #endif
361 1.1 cgd splx(s);
362 1.1 cgd if (uio->uio_rw == UIO_READ) {
363 1.1 cgd if (cnt) {
364 1.1 cgd error = uiomove(cp, cnt, uio);
365 1.1 cgd if (error)
366 1.1 cgd break;
367 1.1 cgd gotdata++;
368 1.1 cgd }
369 1.1 cgd /*
370 1.1 cgd * Didn't get anything this time, but did in the past.
371 1.1 cgd * Consider us done.
372 1.1 cgd */
373 1.1 cgd else if (gotdata)
374 1.1 cgd break;
375 1.1 cgd }
376 1.1 cgd s = splsoftclock();
377 1.1 cgd /*
378 1.1 cgd * Operation timeout (or non-blocking), quit now.
379 1.1 cgd */
380 1.1 cgd if ((sc->sc_flags & PPIF_UIO) == 0) {
381 1.1 cgd #ifdef DEBUG
382 1.1 cgd if (ppidebug & PDB_IO)
383 1.10 christos printf("ppirw: timeout/done\n");
384 1.1 cgd #endif
385 1.1 cgd splx(s);
386 1.1 cgd break;
387 1.1 cgd }
388 1.1 cgd /*
389 1.1 cgd * Implement inter-read delay
390 1.1 cgd */
391 1.1 cgd if (sc->sc_delay > 0) {
392 1.1 cgd sc->sc_flags |= PPIF_DELAY;
393 1.18 thorpej callout_reset(&sc->sc_start_ch, sc->sc_delay,
394 1.18 thorpej ppistart, sc);
395 1.12 scottr error = tsleep(sc, (PCATCH|PZERO) + 1, "hpib", 0);
396 1.1 cgd if (error) {
397 1.1 cgd splx(s);
398 1.1 cgd break;
399 1.1 cgd }
400 1.1 cgd }
401 1.1 cgd splx(s);
402 1.1 cgd /*
403 1.1 cgd * Must not call uiomove again til we've used all data
404 1.1 cgd * that we already grabbed.
405 1.1 cgd */
406 1.1 cgd if (uio->uio_rw == UIO_WRITE && cnt != len) {
407 1.1 cgd cp += cnt;
408 1.1 cgd len -= cnt;
409 1.1 cgd cnt = 0;
410 1.1 cgd goto again;
411 1.1 cgd }
412 1.1 cgd }
413 1.1 cgd s = splsoftclock();
414 1.1 cgd if (sc->sc_flags & PPIF_TIMO) {
415 1.18 thorpej callout_stop(&sc->sc_timo_ch);
416 1.1 cgd sc->sc_flags &= ~PPIF_TIMO;
417 1.1 cgd }
418 1.1 cgd if (sc->sc_flags & PPIF_DELAY) {
419 1.18 thorpej callout_stop(&sc->sc_start_ch);
420 1.1 cgd sc->sc_flags &= ~PPIF_DELAY;
421 1.1 cgd }
422 1.1 cgd splx(s);
423 1.1 cgd /*
424 1.1 cgd * Adjust for those chars that we uiomove'ed but never wrote
425 1.1 cgd */
426 1.1 cgd if (uio->uio_rw == UIO_WRITE && cnt != len) {
427 1.1 cgd uio->uio_resid += (len - cnt);
428 1.1 cgd #ifdef DEBUG
429 1.1 cgd if (ppidebug & PDB_IO)
430 1.10 christos printf("ppirw: short write, adjust by %d\n",
431 1.1 cgd len-cnt);
432 1.1 cgd #endif
433 1.1 cgd }
434 1.1 cgd free(buf, M_DEVBUF);
435 1.1 cgd #ifdef DEBUG
436 1.1 cgd if (ppidebug & (PDB_FOLLOW|PDB_IO))
437 1.10 christos printf("ppirw: return %d, resid %d\n", error, uio->uio_resid);
438 1.1 cgd #endif
439 1.34 tsutsui return error;
440 1.1 cgd }
441 1.1 cgd
442 1.29 thorpej static int
443 1.36 christos ppiioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
444 1.1 cgd {
445 1.41 cegger struct ppi_softc *sc = device_lookup_private(&ppi_cd,UNIT(dev));
446 1.1 cgd struct ppiparam *pp, *upp;
447 1.1 cgd int error = 0;
448 1.1 cgd
449 1.1 cgd switch (cmd) {
450 1.1 cgd case PPIIOCGPARAM:
451 1.1 cgd pp = &sc->sc_param;
452 1.1 cgd upp = (struct ppiparam *)data;
453 1.1 cgd upp->burst = pp->burst;
454 1.1 cgd upp->timo = ppihztoms(pp->timo);
455 1.1 cgd upp->delay = ppihztoms(pp->delay);
456 1.1 cgd break;
457 1.1 cgd case PPIIOCSPARAM:
458 1.1 cgd pp = &sc->sc_param;
459 1.1 cgd upp = (struct ppiparam *)data;
460 1.1 cgd if (upp->burst < PPI_BURST_MIN || upp->burst > PPI_BURST_MAX ||
461 1.1 cgd upp->delay < PPI_DELAY_MIN || upp->delay > PPI_DELAY_MAX)
462 1.34 tsutsui return EINVAL;
463 1.1 cgd pp->burst = upp->burst;
464 1.1 cgd pp->timo = ppimstohz(upp->timo);
465 1.1 cgd pp->delay = ppimstohz(upp->delay);
466 1.1 cgd break;
467 1.1 cgd case PPIIOCSSEC:
468 1.1 cgd sc->sc_sec = *(int *)data;
469 1.1 cgd break;
470 1.1 cgd default:
471 1.34 tsutsui return EINVAL;
472 1.1 cgd }
473 1.34 tsutsui return error;
474 1.1 cgd }
475 1.1 cgd
476 1.29 thorpej static int
477 1.29 thorpej ppihztoms(int h)
478 1.1 cgd {
479 1.1 cgd extern int hz;
480 1.12 scottr int m = h;
481 1.1 cgd
482 1.1 cgd if (m > 0)
483 1.1 cgd m = m * 1000 / hz;
484 1.34 tsutsui return m;
485 1.1 cgd }
486 1.1 cgd
487 1.29 thorpej static int
488 1.29 thorpej ppimstohz(int m)
489 1.1 cgd {
490 1.1 cgd extern int hz;
491 1.12 scottr int h = m;
492 1.1 cgd
493 1.1 cgd if (h > 0) {
494 1.1 cgd h = h * hz / 1000;
495 1.1 cgd if (h == 0)
496 1.1 cgd h = 1000 / hz;
497 1.1 cgd }
498 1.34 tsutsui return h;
499 1.1 cgd }
500