[BACK]Return to hotplug.c CVS log [TXT][DIR] Up to [local] / sys / dev

Annotation of sys/dev/hotplug.c, Revision 1.1.1.1

1.1       nbrk        1: /*     $OpenBSD: hotplug.c,v 1.8 2006/05/28 16:43:49 mk Exp $  */
                      2: /*
                      3:  * Copyright (c) 2004 Alexander Yurchenko <grange@openbsd.org>
                      4:  *
                      5:  * Permission to use, copy, modify, and distribute this software for any
                      6:  * purpose with or without fee is hereby granted, provided that the above
                      7:  * copyright notice and this permission notice appear in all copies.
                      8:  *
                      9:  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
                     10:  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
                     11:  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
                     12:  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
                     13:  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
                     14:  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
                     15:  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
                     16:  */
                     17:
                     18: /*
                     19:  * Device attachment and detachment notifications.
                     20:  */
                     21:
                     22: #include <sys/param.h>
                     23: #include <sys/systm.h>
                     24: #include <sys/conf.h>
                     25: #include <sys/device.h>
                     26: #include <sys/fcntl.h>
                     27: #include <sys/hotplug.h>
                     28: #include <sys/ioctl.h>
                     29: #include <sys/poll.h>
                     30: #include <sys/vnode.h>
                     31:
                     32: #define HOTPLUG_MAXEVENTS      16
                     33:
                     34: static int opened;
                     35: static struct hotplug_event evqueue[HOTPLUG_MAXEVENTS];
                     36: static int evqueue_head, evqueue_tail, evqueue_count;
                     37: static struct selinfo hotplug_sel;
                     38:
                     39: void filt_hotplugrdetach(struct knote *);
                     40: int  filt_hotplugread(struct knote *, long);
                     41:
                     42: struct filterops hotplugread_filtops =
                     43:        { 1, NULL, filt_hotplugrdetach, filt_hotplugread};
                     44:
                     45: #define EVQUEUE_NEXT(p) (p == HOTPLUG_MAXEVENTS - 1 ? 0 : p + 1)
                     46:
                     47:
                     48: int hotplug_put_event(struct hotplug_event *);
                     49: int hotplug_get_event(struct hotplug_event *);
                     50:
                     51: void hotplugattach(int);
                     52:
                     53: void
                     54: hotplugattach(int count)
                     55: {
                     56:        opened = 0;
                     57:        evqueue_head = 0;
                     58:        evqueue_tail = 0;
                     59:        evqueue_count = 0;
                     60: }
                     61:
                     62: void
                     63: hotplug_device_attach(enum devclass class, char *name)
                     64: {
                     65:        struct hotplug_event he;
                     66:
                     67:        he.he_type = HOTPLUG_DEVAT;
                     68:        he.he_devclass = class;
                     69:        strlcpy(he.he_devname, name, sizeof(he.he_devname));
                     70:        hotplug_put_event(&he);
                     71: }
                     72:
                     73: void
                     74: hotplug_device_detach(enum devclass class, char *name)
                     75: {
                     76:        struct hotplug_event he;
                     77:
                     78:        he.he_type = HOTPLUG_DEVDT;
                     79:        he.he_devclass = class;
                     80:        strlcpy(he.he_devname, name, sizeof(he.he_devname));
                     81:        hotplug_put_event(&he);
                     82: }
                     83:
                     84: int
                     85: hotplug_put_event(struct hotplug_event *he)
                     86: {
                     87:        if (evqueue_count == HOTPLUG_MAXEVENTS && opened) {
                     88:                printf("hotplug: event lost, queue full\n");
                     89:                return (1);
                     90:        }
                     91:
                     92:        evqueue[evqueue_head] = *he;
                     93:        evqueue_head = EVQUEUE_NEXT(evqueue_head);
                     94:        if (evqueue_count == HOTPLUG_MAXEVENTS)
                     95:                evqueue_tail = EVQUEUE_NEXT(evqueue_tail);
                     96:        else
                     97:                evqueue_count++;
                     98:        wakeup(&evqueue);
                     99:        selwakeup(&hotplug_sel);
                    100:        KNOTE(&hotplug_sel.si_note, 0);
                    101:        return (0);
                    102: }
                    103:
                    104: int
                    105: hotplug_get_event(struct hotplug_event *he)
                    106: {
                    107:        int s;
                    108:
                    109:        if (evqueue_count == 0)
                    110:                return (1);
                    111:
                    112:        s = splbio();
                    113:        *he = evqueue[evqueue_tail];
                    114:        evqueue_tail = EVQUEUE_NEXT(evqueue_tail);
                    115:        evqueue_count--;
                    116:        splx(s);
                    117:        return (0);
                    118: }
                    119:
                    120: int
                    121: hotplugopen(dev_t dev, int flag, int mode, struct proc *p)
                    122: {
                    123:        if (minor(dev) != 0)
                    124:                return (ENXIO);
                    125:        if ((flag & FWRITE))
                    126:                return (EPERM);
                    127:        if (opened)
                    128:                return (EBUSY);
                    129:        opened = 1;
                    130:        return (0);
                    131: }
                    132:
                    133: int
                    134: hotplugclose(dev_t dev, int flag, int mode, struct proc *p)
                    135: {
                    136:        struct hotplug_event he;
                    137:
                    138:        while (hotplug_get_event(&he) == 0)
                    139:                ;
                    140:        opened = 0;
                    141:        return (0);
                    142: }
                    143:
                    144: int
                    145: hotplugread(dev_t dev, struct uio *uio, int flags)
                    146: {
                    147:        struct hotplug_event he;
                    148:        int error;
                    149:
                    150:        if (uio->uio_resid != sizeof(he))
                    151:                return (EINVAL);
                    152:
                    153: again:
                    154:        if (hotplug_get_event(&he) == 0)
                    155:                return (uiomove(&he, sizeof(he), uio));
                    156:        if (flags & IO_NDELAY)
                    157:                return (EAGAIN);
                    158:
                    159:        error = tsleep(evqueue, PRIBIO | PCATCH, "htplev", 0);
                    160:        if (error)
                    161:                return (error);
                    162:        goto again;
                    163: }
                    164:
                    165: int
                    166: hotplugioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
                    167: {
                    168:        switch (cmd) {
                    169:        case FIOASYNC:
                    170:                /* ignore */
                    171:        case FIONBIO:
                    172:                /* handled in the upper fs layer */
                    173:                break;
                    174:        default:
                    175:                return (ENOTTY);
                    176:        }
                    177:
                    178:        return (0);
                    179: }
                    180:
                    181: int
                    182: hotplugpoll(dev_t dev, int events, struct proc *p)
                    183: {
                    184:        int revents = 0;
                    185:
                    186:        if (events & (POLLIN | POLLRDNORM)) {
                    187:                if (evqueue_count > 0)
                    188:                        revents |= events & (POLLIN | POLLRDNORM);
                    189:                else
                    190:                        selrecord(p, &hotplug_sel);
                    191:        }
                    192:
                    193:        return (revents);
                    194: }
                    195:
                    196: int
                    197: hotplugkqfilter(dev_t dev, struct knote *kn)
                    198: {
                    199:        struct klist *klist;
                    200:        int s;
                    201:
                    202:        switch (kn->kn_filter) {
                    203:        case EVFILT_READ:
                    204:                klist = &hotplug_sel.si_note;
                    205:                kn->kn_fop = &hotplugread_filtops;
                    206:                break;
                    207:        default:
                    208:                return (1);
                    209:        }
                    210:
                    211:        s = splbio();
                    212:        SLIST_INSERT_HEAD(klist, kn, kn_selnext);
                    213:        splx(s);
                    214:        return (0);
                    215: }
                    216:
                    217: void
                    218: filt_hotplugrdetach(struct knote *kn)
                    219: {
                    220:        int s;
                    221:
                    222:        s = splbio();
                    223:        SLIST_REMOVE(&hotplug_sel.si_note, kn, knote, kn_selnext);
                    224:        splx(s);
                    225: }
                    226:
                    227: int
                    228: filt_hotplugread(struct knote *kn, long hint)
                    229: {
                    230:        kn->kn_data = evqueue_count;
                    231:
                    232:        return (evqueue_count > 0);
                    233: }

CVSweb