Return to mms.c CVS log

Up to [Net/2] / Net2 / arch / i386 / isa

Annotation of Net2/arch/i386/isa/mms.c, revision 1.1

1.1     ! root        1: /*-
        !             2:  * Copyright (c) 1992, 1993 Erik Forsberg.
        !             3:  * All rights reserved.
        !             4:  *
        !             5:  * Redistribution and use in source and binary forms, with or without
        !             6:  * modification, are permitted provided that the following conditions
        !             7:  * are met:
        !             8:  * 1. Redistributions of source code must retain the above copyright
        !             9:  *    notice, this list of conditions and the following disclaimer.
        !            10:  *
        !            11:  * THIS SOFTWARE IS PROVIDED BY ``AS IS'' AND ANY EXPRESS OR IMPLIED
        !            12:  * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
        !            13:  * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
        !            14:  * NO EVENT SHALL I BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
        !            15:  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
        !            16:  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
        !            17:  * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
        !            18:  * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
        !            19:  * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
        !            20:  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
        !            21:  */
        !            22: 
        !            23: /*
        !            24:  *  Ported to 386bsd Oct 17, 1992 
        !            25:  *  Sandi Donno, Computer Science, University of Cape Town, South Africa
        !            26:  *  Please send bug reports to [email protected]
        !            27:  *
        !            28:  *  Thanks are also due to Rick Macklem, [email protected] -
        !            29:  *  although I was only partially successful in getting the alpha release
        !            30:  *  of his "driver for the Logitech and ATI Inport Bus mice for use with 
        !            31:  *  386bsd and the X386 port" to work with my Microsoft mouse, I nevertheless 
        !            32:  *  found his code to be an invaluable reference when porting this driver 
        !            33:  *  to 386bsd.
        !            34:  *
        !            35:  *  Further modifications for latest 386BSD+patchkit and port to NetBSD,
        !            36:  *  Andrew Herbert <[email protected]> - 8 June 1993
        !            37:  */
        !            38: 
        !            39: #include "mms.h"
        !            40: 
        !            41: #if NMMS > 0
        !            42: 
        !            43: #include "param.h"
        !            44: #include "kernel.h"
        !            45: #include "systm.h"
        !            46: #include "buf.h"
        !            47: #include "malloc.h"
        !            48: #include "ioctl.h"
        !            49: #include "tty.h"
        !            50: #include "file.h"
        !            51: #ifdef NetBSD
        !            52: #include "select.h"
        !            53: #endif
        !            54: #include "proc.h"
        !            55: #include "vnode.h"
        !            56: 
        !            57: #include "i386/include/mouse.h"
        !            58: #include "i386/include/pio.h"          /* Julian's fast IO macros */
        !            59: #include "i386/isa/isa_device.h"
        !            60: 
        !            61: #define ADDR   0       /* Offset for register select */
        !            62: #define DATA   1       /* Offset for InPort data */
        !            63: #define IDENT  2       /* Offset for identification register */
        !            64: 
        !            65: #define MMSUNIT(dev)   (minor(dev) >> 1)
        !            66: 
        !            67: #ifndef min
        !            68: #define min(x,y) (x < y ? x : y)
        !            69: #endif  min
        !            70: 
        !            71: int mmsprobe (struct isa_device *);
        !            72: int mmsattach (struct isa_device *);
        !            73: 
        !            74: static int mmsaddr[NMMS];      /* Base I/O port addresses per unit */
        !            75: 
        !            76: #define MSBSZ  1024            /* Output queue size (pwr of 2 is best) */
        !            77: 
        !            78: struct ringbuf {
        !            79:        int count, first, last;
        !            80:        char queue[MSBSZ];
        !            81: };
        !            82: 
        !            83: static struct mms_softc {      /* Driver status information */
        !            84:        struct ringbuf inq;     /* Input queue */
        !            85: #ifdef NetBSD
        !            86:        struct selinfo rsel;
        !            87: #else
        !            88:        pid_t   rsel;           /* Process selecting for Input */
        !            89: #endif
        !            90:        unsigned char state;    /* Mouse driver state */
        !            91:        unsigned char status;   /* Mouse button status */
        !            92:        int x, y;               /* accumulated motion in the X,Y axis */
        !            93: } mms_softc[NMMS];
        !            94: 
        !            95: #define OPEN   1               /* Device is open */
        !            96: #define ASLP   2               /* Waiting for mouse data */
        !            97: 
        !            98: struct isa_driver mmsdriver = { mmsprobe, mmsattach, "mms" };
        !            99: 
        !           100: int mmsprobe(struct isa_device *dvp)
        !           101: {
        !           102:        int ioport = dvp->id_iobase;
        !           103: 
        !           104:        /* Read identification register to see if present */
        !           105: 
        !           106:        if (inb(ioport+IDENT) != 0xDE)
        !           107:                return(0);
        !           108: 
        !           109:        /* Seems it was there; reset */
        !           110: 
        !           111:        outb(ioport+ADDR, 0x87);
        !           112:        return(4);
        !           113: }
        !           114: 
        !           115: int mmsattach(struct isa_device *dvp)
        !           116: {
        !           117:        int unit = dvp->id_unit;
        !           118:        int ioport = dvp->id_iobase;
        !           119:        struct mms_softc *sc = &mms_softc[unit];
        !           120: 
        !           121:        /* Save I/O base address */
        !           122: 
        !           123:        mmsaddr[unit] = ioport;
        !           124: 
        !           125:        /* Setup initial state */
        !           126: 
        !           127:        sc->state = 0;
        !           128: 
        !           129:        /* Done */
        !           130: 
        !           131:        return(0);
        !           132: }
        !           133: 
        !           134: int mmsopen(dev_t dev, int flag, int fmt, struct proc *p)
        !           135: {
        !           136:        int unit = MMSUNIT(dev);
        !           137:        struct mms_softc *sc;
        !           138:        int ioport;
        !           139: 
        !           140:        /* Validate unit number */
        !           141: 
        !           142:        if (unit >= NMMS)
        !           143:                return(ENXIO);
        !           144: 
        !           145:        /* Get device data */
        !           146: 
        !           147:        sc = &mms_softc[unit];
        !           148:        ioport = mmsaddr[unit];
        !           149: 
        !           150:        /* If device does not exist */
        !           151: 
        !           152:        if (ioport == 0)
        !           153:                return(ENXIO);
        !           154: 
        !           155:        /* Disallow multiple opens */
        !           156: 
        !           157:        if (sc->state & OPEN)
        !           158:                return(EBUSY);
        !           159: 
        !           160:        /* Initialize state */
        !           161: 
        !           162:        sc->state |= OPEN;
        !           163: #ifdef NetBSD
        !           164:        sc->rsel.si_pid = 0;
        !           165:        sc->rsel.si_coll = 0;
        !           166: #else
        !           167:        sc->rsel = 0;
        !           168: #endif
        !           169:        sc->status = 0;
        !           170:        sc->x = 0;
        !           171:        sc->y = 0;
        !           172: 
        !           173:        /* Allocate and initialize a ring buffer */
        !           174: 
        !           175:        sc->inq.count = sc->inq.first = sc->inq.last = 0;
        !           176: 
        !           177:        /* Setup Bus Mouse */
        !           178: 
        !           179:        outb(ioport+ADDR, 7);
        !           180:        outb(ioport+DATA, 0x09);
        !           181: 
        !           182:        /* Successful open */
        !           183: 
        !           184:        return(0);
        !           185: }
        !           186: 
        !           187: int mmsclose(dev_t dev, int flag, int fmt, struct proc *p)
        !           188: {
        !           189:        int unit, ioport;
        !           190:        struct mms_softc *sc;
        !           191: 
        !           192:        /* Get unit and associated info */
        !           193: 
        !           194:        unit = MMSUNIT(dev);
        !           195:        sc = &mms_softc[unit];
        !           196:        ioport = mmsaddr[unit];
        !           197: 
        !           198:        /* Reset Bus Mouse */
        !           199: 
        !           200:        outb(ioport+ADDR, 0x87);
        !           201: 
        !           202:        /* Complete the close */
        !           203: 
        !           204:        sc->state &= ~OPEN;
        !           205: 
        !           206:        /* close is almost always successful */
        !           207: 
        !           208:        return(0);
        !           209: }
        !           210: 
        !           211: int mmsread(dev_t dev, struct uio *uio, int flag)
        !           212: {
        !           213:        int s, error = 0;
        !           214:        unsigned length;
        !           215:        struct mms_softc *sc;
        !           216:        unsigned char buffer[100];
        !           217: 
        !           218:        /* Get device information */
        !           219: 
        !           220:        sc = &mms_softc[MMSUNIT(dev)];
        !           221: 
        !           222:        /* Block until mouse activity occured */
        !           223: 
        !           224:        s = spltty();
        !           225:        while (sc->inq.count == 0) {
        !           226:                if (minor(dev) & 0x1) {
        !           227:                        splx(s);
        !           228:                        return(EWOULDBLOCK);
        !           229:                }
        !           230:                sc->state |= ASLP;
        !           231:                error = tsleep((caddr_t)sc, PZERO | PCATCH, "mmsrea", 0);
        !           232:                if (error != 0) {
        !           233:                        splx(s);
        !           234:                        return(error);
        !           235:                }
        !           236:        }
        !           237: 
        !           238:        /* Transfer as many chunks as possible */
        !           239: 
        !           240:        while (sc->inq.count > 0 && uio->uio_resid > 0) {
        !           241:                length = min(sc->inq.count, uio->uio_resid);
        !           242:                if (length > sizeof(buffer))
        !           243:                        length = sizeof(buffer);
        !           244: 
        !           245:                /* Remove a small chunk from input queue */
        !           246: 
        !           247:                if (sc->inq.first + length >= MSBSZ) {
        !           248:                        bcopy(&sc->inq.queue[sc->inq.first], 
        !           249:                              buffer, MSBSZ - sc->inq.first);
        !           250:                        bcopy(sc->inq.queue, &buffer[MSBSZ-sc->inq.first], 
        !           251:                              length - (MSBSZ - sc->inq.first));
        !           252:                }
        !           253:                else
        !           254:                        bcopy(&sc->inq.queue[sc->inq.first], buffer, length);
        !           255:        
        !           256:                sc->inq.first = (sc->inq.first + length) % MSBSZ;
        !           257:                sc->inq.count -= length;
        !           258: 
        !           259:                /* Copy data to user process */
        !           260: 
        !           261:                error = uiomove(buffer, length, uio);
        !           262:                if (error)
        !           263:                        break;
        !           264:        }
        !           265: 
        !           266:        sc->x = sc->y = 0;
        !           267: 
        !           268:        /* Allow interrupts again */
        !           269: 
        !           270:        splx(s);
        !           271:        return(error);
        !           272: }
        !           273: 
        !           274: int mmsioctl(dev_t dev, caddr_t addr, int cmd, int flag, struct proc *p)
        !           275: {
        !           276:        struct mms_softc *sc;
        !           277:        struct mouseinfo info;
        !           278:        int s, error;
        !           279: 
        !           280:        /* Get device information */
        !           281: 
        !           282:        sc = &mms_softc[MMSUNIT(dev)];
        !           283: 
        !           284:        /* Perform IOCTL command */
        !           285: 
        !           286:        switch (cmd) {
        !           287: 
        !           288:        case MOUSEIOCREAD:
        !           289: 
        !           290:                /* Don't modify info while calculating */
        !           291: 
        !           292:                s = spltty();
        !           293: 
        !           294:                /* Build mouse status octet */
        !           295: 
        !           296:                info.status = sc->status;
        !           297:                if (sc->x || sc->y)
        !           298:                        info.status |= MOVEMENT;
        !           299: 
        !           300:                /* Encode X and Y motion as good as we can */
        !           301: 
        !           302:                if (sc->x > 127)
        !           303:                        info.xmotion = 127;
        !           304:                else if (sc->x < -128)
        !           305:                        info.xmotion = -128;
        !           306:                else
        !           307:                        info.xmotion = sc->x;
        !           308: 
        !           309:                if (sc->y > 127)
        !           310:                        info.ymotion = 127;
        !           311:                else if (sc->y < -128)
        !           312:                        info.ymotion = -128;
        !           313:                else
        !           314:                        info.ymotion = sc->y;
        !           315: 
        !           316:                /* Reset historical information */
        !           317: 
        !           318:                sc->x = 0;
        !           319:                sc->y = 0;
        !           320:                sc->status &= ~BUTCHNGMASK;
        !           321: 
        !           322:                /* Allow interrupts and copy result buffer */
        !           323: 
        !           324:                splx(s);
        !           325:                error = copyout(&info, addr, sizeof(struct mouseinfo));
        !           326:                break;
        !           327: 
        !           328:        default:
        !           329:                error = EINVAL;
        !           330:                break;
        !           331:                }
        !           332: 
        !           333:        /* Return error code */
        !           334: 
        !           335:        return(error);
        !           336: }
        !           337: 
        !           338: void mmsintr(unit)
        !           339:        int unit;
        !           340: {
        !           341:        struct mms_softc *sc = &mms_softc[unit];
        !           342:        int ioport = mmsaddr[unit];
        !           343:        char dx, dy, status;
        !           344: 
        !           345:        /* Freeze InPort registers (disabling interrupts) */
        !           346: 
        !           347:        outb(ioport+ADDR, 7);
        !           348:        outb(ioport+DATA, 0x29);
        !           349: 
        !           350:        /* Read mouse status */
        !           351: 
        !           352:        outb(ioport+ADDR, 0);
        !           353:        status = inb(ioport+DATA);
        !           354: 
        !           355:        /* Check if any movement detected */
        !           356: 
        !           357:        if (status & 0x40) {
        !           358:                outb(ioport+ADDR, 1);
        !           359:                dx = inb(ioport+DATA);
        !           360:                outb(ioport+ADDR, 2);
        !           361:                dy = inb(ioport+DATA);
        !           362:                dy = (dy == -128) ? 127 : -dy;
        !           363:        }
        !           364:        else
        !           365:                dx = dy = 0;
        !           366: 
        !           367:        /* Unfreeze InPort Registers (re-enables interrupts) */
        !           368: 
        !           369:        outb(ioport+ADDR, 7);
        !           370:        outb(ioport+DATA, 0x09);
        !           371: 
        !           372:        /* Update accumulated movements */
        !           373: 
        !           374:        sc->x += dx;
        !           375:        sc->y += dy;
        !           376: 
        !           377:        /* Inclusive OR status changes, but always save only last state */
        !           378: 
        !           379:        sc->status |= status & BUTCHNGMASK;
        !           380:        sc->status = (sc->status & ~BUTSTATMASK) | (status & BUTSTATMASK);
        !           381: 
        !           382:        /* If device in use and a change occurred... */
        !           383: 
        !           384:        if (sc->state & OPEN && status & 0x78 && sc->inq.count < (MSBSZ-5)) {
        !           385:                status &= BUTSTATMASK;
        !           386:                sc->inq.queue[sc->inq.last++] = 0x80 | (status ^ BUTSTATMASK);
        !           387:                sc->inq.queue[sc->inq.last++ % MSBSZ] = dx;
        !           388:                sc->inq.queue[sc->inq.last++ % MSBSZ] = dy;
        !           389:                sc->inq.queue[sc->inq.last++ % MSBSZ] = 0;
        !           390:                sc->inq.queue[sc->inq.last++ % MSBSZ] = 0;
        !           391:                sc->inq.last = sc->inq.last % MSBSZ;
        !           392:                sc->inq.count += 5;
        !           393: 
        !           394:                if (sc->state & ASLP) {
        !           395:                        sc->state &= ~ASLP;
        !           396:                        wakeup((caddr_t)sc);
        !           397:                }
        !           398: #ifdef NetBSD
        !           399:                selwakeup(&sc->rsel);
        !           400: #else
        !           401:                if (sc->rsel) {
        !           402:                        selwakeup(sc->rsel, 0);
        !           403:                        sc->rsel = 0;
        !           404:                }
        !           405: #endif
        !           406:                }
        !           407: }
        !           408: 
        !           409: int mmsselect(dev_t dev, int rw, struct proc *p)
        !           410: {
        !           411:        int s, ret;
        !           412:        struct mms_softc *sc = &mms_softc[MMSUNIT(dev)];
        !           413: 
        !           414:        /* Silly to select for output */
        !           415: 
        !           416:        if (rw == FWRITE)
        !           417:                return(0);
        !           418: 
        !           419:        /* Return true if a mouse event available */
        !           420: 
        !           421:        s = spltty();
        !           422:        if (sc->inq.count)
        !           423:                ret = 1;
        !           424:        else {
        !           425: #ifdef NetBSD
        !           426:                selrecord(p, &sc->rsel);
        !           427: #else
        !           428:                sc->rsel = p->p_pid;
        !           429: #endif
        !           430:                ret = 0;
        !           431:        }
        !           432:        splx(s);
        !           433: 
        !           434:        return(ret);
        !           435: }
        !           436: #endif

This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.