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

Annotation of sys/arch/landisk/dev/wdc_obio.c, Revision 1.1

1.1     ! nbrk        1: /*     $OpenBSD: wdc_obio.c,v 1.2 2006/10/28 15:51:33 kettenis Exp $   */
        !             2: /*     $NetBSD: wdc_obio.c,v 1.1 2006/09/01 21:26:18 uwe Exp $ */
        !             3:
        !             4: /*-
        !             5:  * Copyright (c) 1998, 2003 The NetBSD Foundation, Inc.
        !             6:  * All rights reserved.
        !             7:  *
        !             8:  * This code is derived from software contributed to The NetBSD Foundation
        !             9:  * by Charles M. Hannum and by Onno van der Linden.
        !            10:  *
        !            11:  * Redistribution and use in source and binary forms, with or without
        !            12:  * modification, are permitted provided that the following conditions
        !            13:  * are met:
        !            14:  * 1. Redistributions of source code must retain the above copyright
        !            15:  *    notice, this list of conditions and the following disclaimer.
        !            16:  * 2. Redistributions in binary form must reproduce the above copyright
        !            17:  *    notice, this list of conditions and the following disclaimer in the
        !            18:  *    documentation and/or other materials provided with the distribution.
        !            19:  * 3. All advertising materials mentioning features or use of this software
        !            20:  *    must display the following acknowledgement:
        !            21:  *        This product includes software developed by the NetBSD
        !            22:  *        Foundation, Inc. and its contributors.
        !            23:  * 4. Neither the name of The NetBSD Foundation nor the names of its
        !            24:  *    contributors may be used to endorse or promote products derived
        !            25:  *    from this software without specific prior written permission.
        !            26:  *
        !            27:  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
        !            28:  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
        !            29:  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
        !            30:  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
        !            31:  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
        !            32:  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
        !            33:  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
        !            34:  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
        !            35:  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
        !            36:  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
        !            37:  * POSSIBILITY OF SUCH DAMAGE.
        !            38:  */
        !            39:
        !            40: #include <sys/param.h>
        !            41: #include <sys/systm.h>
        !            42: #include <sys/device.h>
        !            43: #include <sys/malloc.h>
        !            44:
        !            45: #include <machine/bus.h>
        !            46: #include <machine/intr.h>
        !            47:
        !            48: #include <dev/ata/atavar.h>
        !            49: #include <dev/ic/wdcvar.h>
        !            50:
        !            51: #include <landisk/dev/obiovar.h>
        !            52:
        !            53: struct wdc_obio_softc {
        !            54:        struct  wdc_softc sc_wdcdev;
        !            55:        struct  channel_softc *sc_chanptr;
        !            56:        struct  channel_softc sc_channel;
        !            57:
        !            58:        void    *sc_ih;
        !            59: };
        !            60:
        !            61: int    wdc_obio_match(struct device *, void *, void *);
        !            62: void   wdc_obio_attach(struct device *, struct device *, void *);
        !            63:
        !            64: struct cfattach wdc_obio_ca = {
        !            65:        sizeof(struct wdc_obio_softc), wdc_obio_match, wdc_obio_attach
        !            66: };
        !            67:
        !            68: #define        WDC_OBIO_REG_NPORTS     WDC_NREG
        !            69: #define        WDC_OBIO_REG_SIZE       (WDC_OBIO_REG_NPORTS * 2)
        !            70: #define        WDC_OBIO_AUXREG_NPORTS  1
        !            71: #define        WDC_OBIO_AUXREG_SIZE    (WDC_OBIO_AUXREG_NPORTS * 2)
        !            72: #define        WDC_OBIO_AUXREG_OFFSET  0x2c
        !            73:
        !            74: u_int8_t wdc_obio_read_reg(struct channel_softc *chp,  enum wdc_regs reg);
        !            75: void wdc_obio_write_reg(struct channel_softc *chp,  enum wdc_regs reg,
        !            76:     u_int8_t val);
        !            77:
        !            78: struct channel_softc_vtbl wdc_obio_vtbl = {
        !            79:        wdc_obio_read_reg,
        !            80:        wdc_obio_write_reg,
        !            81:        wdc_default_lba48_write_reg,
        !            82:        wdc_default_read_raw_multi_2,
        !            83:        wdc_default_write_raw_multi_2,
        !            84:        wdc_default_read_raw_multi_4,
        !            85:        wdc_default_write_raw_multi_4
        !            86: };
        !            87:
        !            88: int
        !            89: wdc_obio_match(struct device *parent, void *vcf, void *aux)
        !            90: {
        !            91:        struct obio_attach_args *oa = aux;
        !            92:
        !            93:        if (oa->oa_nio != 1)
        !            94:                return (0);
        !            95:        if (oa->oa_nirq != 1)
        !            96:                return (0);
        !            97:        if (oa->oa_niomem != 0)
        !            98:                return (0);
        !            99:
        !           100:        if (oa->oa_io[0].or_addr == IOBASEUNK)
        !           101:                return (0);
        !           102:        if (oa->oa_irq[0].or_irq == IRQUNK)
        !           103:                return (0);
        !           104:
        !           105:        /* XXX should probe for hardware */
        !           106:
        !           107:        oa->oa_io[0].or_size = WDC_OBIO_REG_SIZE;
        !           108:
        !           109:        return (1);
        !           110: }
        !           111:
        !           112: void
        !           113: wdc_obio_attach(struct device *parent, struct device *self, void *aux)
        !           114: {
        !           115:        struct wdc_obio_softc *sc = (void *)self;
        !           116:        struct obio_attach_args *oa = aux;
        !           117:        struct channel_softc *chp = &sc->sc_channel;
        !           118:
        !           119:        printf("\n");
        !           120:
        !           121:        chp->cmd_iot = chp->ctl_iot = oa->oa_iot;
        !           122:        chp->_vtbl = &wdc_obio_vtbl;
        !           123:
        !           124:        if (bus_space_map(chp->cmd_iot, oa->oa_io[0].or_addr,
        !           125:            WDC_OBIO_REG_SIZE, 0, &chp->cmd_ioh)
        !           126:         || bus_space_map(chp->ctl_iot,
        !           127:            oa->oa_io[0].or_addr + WDC_OBIO_AUXREG_OFFSET,
        !           128:            WDC_OBIO_AUXREG_SIZE, 0, &chp->ctl_ioh)) {
        !           129:                printf(": couldn't map registers\n");
        !           130:                return;
        !           131:        }
        !           132:
        !           133:        sc->sc_ih = obio_intr_establish(oa->oa_irq[0].or_irq, IPL_BIO, wdcintr,
        !           134:            chp, self->dv_xname);
        !           135:
        !           136:        sc->sc_wdcdev.cap |= WDC_CAPABILITY_DATA16 | WDC_CAPABILITY_PREATA;
        !           137:        sc->sc_wdcdev.PIO_cap = 0;
        !           138:        sc->sc_chanptr = chp;
        !           139:        sc->sc_wdcdev.channels = &sc->sc_chanptr;
        !           140:        sc->sc_wdcdev.nchannels = 1;
        !           141:        chp->channel = 0;
        !           142:        chp->wdc = &sc->sc_wdcdev;
        !           143:
        !           144:        chp->ch_queue = malloc(sizeof(struct channel_queue), M_DEVBUF,
        !           145:            M_NOWAIT);
        !           146:        if (chp->ch_queue == NULL) {
        !           147:                printf("%s: can't allocate memory for command queue\n",
        !           148:                    self->dv_xname);
        !           149:                obio_intr_disestablish(sc->sc_ih);
        !           150:                return;
        !           151:        }
        !           152:
        !           153:        wdcattach(chp);
        !           154:        wdc_print_current_modes(chp);
        !           155: }
        !           156:
        !           157: u_int8_t
        !           158: wdc_obio_read_reg(struct channel_softc *chp,  enum wdc_regs reg)
        !           159: {
        !           160:        if (reg & _WDC_AUX)
        !           161:                return (bus_space_read_1(chp->ctl_iot, chp->ctl_ioh,
        !           162:                    (reg & _WDC_REGMASK) << 1));
        !           163:        else
        !           164:                return (bus_space_read_1(chp->cmd_iot, chp->cmd_ioh,
        !           165:                    (reg & _WDC_REGMASK) << 1));
        !           166: }
        !           167:
        !           168: void
        !           169: wdc_obio_write_reg(struct channel_softc *chp,  enum wdc_regs reg, u_int8_t val)
        !           170: {
        !           171:        if (reg & _WDC_AUX)
        !           172:                bus_space_write_1(chp->ctl_iot, chp->ctl_ioh,
        !           173:                    (reg & _WDC_REGMASK) << 1, val);
        !           174:        else
        !           175:                bus_space_write_1(chp->cmd_iot, chp->cmd_ioh,
        !           176:                    (reg & _WDC_REGMASK) << 1, val);
        !           177: }

CVSweb