2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
4 * Copyright (c) 2000-2004
5 * Diomidis D. Spinellis, Athens, Greece
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer as
13 * the first lines of this file unmodified.
14 * 2. Redistributions in binary form must reproduce the above copyright
15 * notice, this list of conditions and the following disclaimer in the
16 * documentation and/or other materials provided with the distribution.
18 * THIS SOFTWARE IS PROVIDED BY Diomidis D. Spinellis ``AS IS'' AND ANY
19 * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
21 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL Diomidis D. Spinellis BE
22 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
25 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
26 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
27 * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
28 * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 * $Id: pbio.c,v 1.12 2003/10/11 13:05:08 dds Exp dds $
33 #include <sys/cdefs.h>
34 __FBSDID("$FreeBSD$");
36 #include <sys/param.h>
37 #include <sys/systm.h>
38 #include <sys/kernel.h> /* SYSINIT stuff */
40 #include <sys/resource.h>
41 #include <sys/syslog.h>
42 #include <sys/sysctl.h>
43 #include <sys/conf.h> /* cdevsw stuff */
44 #include <sys/malloc.h> /* malloc region definitions */
45 #include <sys/module.h>
46 #include <machine/bus.h>
47 #include <machine/resource.h>
49 #include <dev/pbio/pbioio.h> /* pbio IOCTL definitions */
51 #include <sys/fcntl.h>
52 #include <isa/isavar.h>
54 /* Function prototypes (these should all be static) */
55 static d_open_t pbioopen;
56 static d_close_t pbioclose;
57 static d_read_t pbioread;
58 static d_write_t pbiowrite;
59 static d_ioctl_t pbioioctl;
60 static d_poll_t pbiopoll;
61 static int pbioprobe(device_t);
62 static int pbioattach(device_t);
64 /* Device registers */
71 /* Per-port buffer size */
72 #define PBIO_BUFSIZ 64
74 /* Number of /dev entries */
80 static char *port_names[] = {"a", "b", "ch", "cl"};
82 #define PBIO_PNAME(n) (port_names[(n)])
84 #define UNIT(dev) (dev2unit(dev) >> 2)
85 #define PORT(dev) (dev2unit(dev) & 0x3)
87 #define PBIOPRI ((PZERO + 5) | PCATCH)
89 static struct cdevsw pbio_cdevsw = {
90 .d_version = D_VERSION,
91 .d_flags = D_NEEDGIANT,
102 * Data specific to each I/O port
106 int diff; /* When true read only differences */
107 int ipace; /* Input pace */
108 int opace; /* Output pace */
109 char oldval; /* Last value read */
110 char buff[PBIO_BUFSIZ]; /* Per-port data buffer */
114 * One of these per allocated device
117 struct portdata pd[PBIO_NPORTS];/* Per port data */
118 int iomode; /* Virtualized I/O mode port value */
119 /* The real port is write-only */
120 struct resource *res;
122 bus_space_handle_t bsh;
125 typedef struct pbio_softc *sc_p;
127 static device_method_t pbio_methods[] = {
128 /* Device interface */
129 DEVMETHOD(device_probe, pbioprobe),
130 DEVMETHOD(device_attach, pbioattach),
134 static devclass_t pbio_devclass;
135 #define pbio_addr(unit) \
136 ((struct pbio_softc *) devclass_get_softc(pbio_devclass, unit))
138 static char driver_name[] = "pbio";
140 static driver_t pbio_driver = {
143 sizeof(struct pbio_softc),
146 DRIVER_MODULE(pbio, isa, pbio_driver, pbio_devclass, 0, 0);
148 static __inline uint8_t
149 pbinb(struct pbio_softc *scp, int off)
152 return bus_space_read_1(scp->bst, scp->bsh, off);
156 pboutb(struct pbio_softc *scp, int off, uint8_t val)
159 bus_space_write_1(scp->bst, scp->bsh, off, val);
163 pbioprobe(device_t dev)
166 struct pbio_softc *scp = device_get_softc(dev);
167 #ifdef GENERIC_PBIO_PROBE
171 if (isa_get_logicalid(dev)) /* skip PnP probes */
174 scp->res = bus_alloc_resource_anywhere(dev, SYS_RES_IOPORT, &rid,
175 IO_PBIOSIZE, RF_ACTIVE);
176 if (scp->res == NULL)
179 #ifdef GENERIC_PBIO_PROBE
180 scp->bst = rman_get_bustag(scp->res);
181 scp->bsh = rman_get_bushandle(scp->res);
183 * try see if the device is there.
184 * This probe works only if the device has no I/O attached to it
185 * XXX Better allow flags to abort testing
187 /* Set all ports to output */
188 pboutb(scp, PBIO_CFG, 0x80);
189 printf("pbio val(CFG: 0x%03x)=0x%02x (should be 0x80)\n",
190 rman_get_start(scp->res), pbinb(scp, PBIO_CFG));
191 pboutb(scp, PBIO_PORTA, 0xa5);
192 val = pbinb(scp, PBIO_PORTA);
193 printf("pbio val=0x%02x (should be 0xa5)\n", val);
195 bus_release_resource(dev, SYS_RES_IOPORT, rid, sc->res);
198 pboutb(scp, PBIO_PORTA, 0x5a);
199 val = pbinb(scp, PBIO_PORTA);
200 printf("pbio val=0x%02x (should be 0x5a)\n", val);
202 bus_release_resource(dev, SYS_RES_IOPORT, rid, sc->res);
206 device_set_desc(dev, "Intel 8255 PPI (basic mode)");
207 /* Set all ports to input */
208 /* pboutb(scp, PBIO_CFG, 0x9b); */
209 bus_release_resource(dev, SYS_RES_IOPORT, rid, scp->res);
214 * Called if the probe succeeded.
215 * We can be destructive here as we know we have the device.
216 * we can also trust the unit number.
219 pbioattach (device_t dev)
224 struct pbio_softc *sc;
226 sc = device_get_softc(dev);
227 unit = device_get_unit(dev);
229 sc->res = bus_alloc_resource_anywhere(dev, SYS_RES_IOPORT, &rid,
230 IO_PBIOSIZE, RF_ACTIVE);
233 sc->bst = rman_get_bustag(sc->res);
234 sc->bsh = rman_get_bushandle(sc->res);
237 * Store whatever seems wise.
239 sc->iomode = 0x9b; /* All ports to input */
241 for (i = 0; i < PBIO_NPORTS; i++)
242 sc->pd[i].port = make_dev(&pbio_cdevsw, (unit << 2) + i, 0, 0,
243 0600, "pbio%d%s", unit, PBIO_PNAME(i));
248 pbioioctl (struct cdev *dev, u_long cmd, caddr_t data, int flag,
251 struct pbio_softc *scp;
256 scp = pbio_addr(unit);
261 scp->pd[port].diff = *(int *)data;
264 scp->pd[port].ipace = *(int *)data;
267 scp->pd[port].opace = *(int *)data;
270 *(int *)data = scp->pd[port].diff;
273 *(int *)data = scp->pd[port].ipace;
276 *(int *)data = scp->pd[port].opace;
285 pbioopen(struct cdev *dev, int oflags, int devtype, struct thread *td)
287 struct pbio_softc *scp;
288 int ocfg, port, unit;
289 int portbit; /* Port configuration bit */
293 scp = pbio_addr(unit);
298 case 0: portbit = 0x10; break; /* Port A */
299 case 1: portbit = 0x02; break; /* Port B */
300 case 2: portbit = 0x08; break; /* Port CH */
301 case 3: portbit = 0x01; break; /* Port CL */
302 default: return (ENODEV);
307 /* Writing == output; zero the bit */
308 pboutb(scp, PBIO_CFG, scp->iomode = (ocfg & (~portbit)));
309 else if (oflags & FREAD)
310 /* Reading == input; set the bit */
311 pboutb(scp, PBIO_CFG, scp->iomode = (ocfg | portbit));
319 pbioclose(struct cdev *dev, int fflag, int devtype, struct thread *td)
321 struct pbio_softc *scp;
325 scp = pbio_addr(unit);
333 * Return the value of a given port on a given I/O base address
334 * Handles the split C port nibbles and blocking
337 portval(int port, struct pbio_softc *scp, char *val)
344 *val = pbinb(scp, PBIO_PORTA);
347 *val = pbinb(scp, PBIO_PORTB);
350 *val = (pbinb(scp, PBIO_PORTC) >> 4) & 0xf;
353 *val = pbinb(scp, PBIO_PORTC) & 0xf;
359 if (scp->pd[port].diff) {
360 if (*val != scp->pd[port].oldval) {
361 scp->pd[port].oldval = *val;
364 err = tsleep((caddr_t)&(scp->pd[port].diff), PBIOPRI,
365 "pbiopl", max(1, scp->pd[port].ipace));
374 pbioread(struct cdev *dev, struct uio *uio, int ioflag)
376 struct pbio_softc *scp;
377 int err, i, port, ret, toread, unit;
382 scp = pbio_addr(unit);
386 while (uio->uio_resid > 0) {
387 toread = min(uio->uio_resid, PBIO_BUFSIZ);
388 if ((ret = uiomove(scp->pd[port].buff, toread, uio)) != 0)
390 for (i = 0; i < toread; i++) {
391 if ((err = portval(port, scp, &val)) != 0)
393 scp->pd[port].buff[i] = val;
394 if (!scp->pd[port].diff && scp->pd[port].ipace)
395 tsleep((caddr_t)&(scp->pd[port].ipace), PBIOPRI,
396 "pbioip", scp->pd[port].ipace);
403 pbiowrite(struct cdev *dev, struct uio *uio, int ioflag)
405 struct pbio_softc *scp;
406 int i, port, ret, towrite, unit;
411 scp = pbio_addr(unit);
415 while (uio->uio_resid > 0) {
416 towrite = min(uio->uio_resid, PBIO_BUFSIZ);
417 if ((ret = uiomove(scp->pd[port].buff, towrite, uio)) != 0)
419 for (i = 0; i < towrite; i++) {
420 val = scp->pd[port].buff[i];
423 pboutb(scp, PBIO_PORTA, val);
426 pboutb(scp, PBIO_PORTB, val);
429 oval = pbinb(scp, PBIO_PORTC);
432 pboutb(scp, PBIO_PORTC, val | oval);
435 oval = pbinb(scp, PBIO_PORTC);
438 pboutb(scp, PBIO_PORTC, oval | val);
441 if (scp->pd[port].opace)
442 tsleep((caddr_t)&(scp->pd[port].opace),
444 scp->pd[port].opace);
451 pbiopoll(struct cdev *dev, int which, struct thread *td)
453 struct pbio_softc *scp;
457 scp = pbio_addr(unit);
464 return (0); /* this is the wrong value I'm sure */