Home | History | Annotate | Line # | Download | only in dev
wdc_obio.c revision 1.9
      1 /*	$NetBSD: wdc_obio.c,v 1.9 2017/10/07 16:05:32 jdolecek Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 1998, 2003 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Charles M. Hannum and by Onno van der Linden.
      9  *
     10  * Redistribution and use in source and binary forms, with or without
     11  * modification, are permitted provided that the following conditions
     12  * are met:
     13  * 1. Redistributions of source code must retain the above copyright
     14  *    notice, this list of conditions and the following disclaimer.
     15  * 2. Redistributions in binary form must reproduce the above copyright
     16  *    notice, this list of conditions and the following disclaimer in the
     17  *    documentation and/or other materials provided with the distribution.
     18  *
     19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  * POSSIBILITY OF SUCH DAMAGE.
     30  */
     31 
     32 #include <sys/cdefs.h>
     33 __KERNEL_RCSID(0, "$NetBSD: wdc_obio.c,v 1.9 2017/10/07 16:05:32 jdolecek Exp $");
     34 
     35 #include <sys/types.h>
     36 #include <sys/param.h>
     37 #include <sys/systm.h>
     38 #include <sys/device.h>
     39 #include <sys/malloc.h>
     40 
     41 #include <sys/bus.h>
     42 #include <machine/intr.h>
     43 
     44 #include <dev/ata/atavar.h>
     45 #include <dev/ic/wdcvar.h>
     46 
     47 #include <landisk/dev/obiovar.h>
     48 
     49 struct wdc_obio_softc {
     50 	struct	wdc_softc sc_wdcdev;
     51 	struct	ata_channel *sc_chanlist[1];
     52 	struct	ata_channel sc_channel;
     53 	struct	wdc_regs sc_wdc_regs;
     54 	void	*sc_ih;
     55 };
     56 
     57 static int	wdc_obio_probe(device_t, cfdata_t, void *);
     58 static void	wdc_obio_attach(device_t, device_t, void *);
     59 
     60 CFATTACH_DECL_NEW(wdc_obio, sizeof(struct wdc_obio_softc),
     61     wdc_obio_probe, wdc_obio_attach, NULL, NULL);
     62 
     63 #define	WDC_OBIO_REG_NPORTS	WDC_NREG
     64 #define	WDC_OBIO_REG_SIZE	(WDC_OBIO_REG_NPORTS * 2)
     65 #define	WDC_OBIO_AUXREG_NPORTS	1
     66 #define	WDC_OBIO_AUXREG_SIZE	(WDC_OBIO_AUXREG_NPORTS * 2)
     67 #define	WDC_OBIO_AUXREG_OFFSET	0x2c
     68 
     69 static int
     70 wdc_obio_probe(device_t parent, cfdata_t cfp, void *aux)
     71 {
     72 	struct obio_attach_args *oa = aux;
     73 	struct wdc_regs wdr;
     74 	int result = 0;
     75 	int i;
     76 
     77 	if (oa->oa_nio < 1)
     78 		return (0);
     79 	if (oa->oa_nirq < 1)
     80 		return (0);
     81 
     82 	if (oa->oa_io[0].or_addr == IOBASEUNK)
     83 		return (0);
     84 	if (oa->oa_irq[0].or_irq == IRQUNK)
     85 		return (0);
     86 
     87 	wdr.cmd_iot = oa->oa_iot;
     88 	if (bus_space_map(wdr.cmd_iot, oa->oa_io[0].or_addr,
     89 	    WDC_OBIO_REG_SIZE, 0, &wdr.cmd_baseioh)) {
     90 		goto out;
     91 	}
     92 	for (i = 0; i < WDC_OBIO_REG_NPORTS; i++) {
     93 		if (bus_space_subregion(wdr.cmd_iot, wdr.cmd_baseioh,
     94 		    i * 2, (i == 0) ? 2 : 1, &wdr.cmd_iohs[i])) {
     95 			goto outunmap;
     96 		}
     97 	}
     98 	wdc_init_shadow_regs(&wdr);
     99 
    100 	wdr.ctl_iot = oa->oa_iot;
    101 	if (bus_space_map(wdr.ctl_iot,
    102 	    oa->oa_io[0].or_addr + WDC_OBIO_AUXREG_OFFSET,
    103 	    WDC_OBIO_AUXREG_SIZE, 0, &wdr.ctl_ioh)) {
    104 		goto outunmap;
    105 	}
    106 
    107 	result = wdcprobe(&wdr);
    108 	if (result) {
    109 		oa->oa_nio = 1;
    110 		oa->oa_io[0].or_size = WDC_OBIO_REG_SIZE;
    111 		oa->oa_nirq = 1;
    112 		oa->oa_niomem = 0;
    113 	}
    114 
    115 	bus_space_unmap(wdr.ctl_iot, wdr.ctl_ioh, WDC_OBIO_AUXREG_SIZE);
    116 outunmap:
    117 	bus_space_unmap(wdr.cmd_iot, wdr.cmd_baseioh, WDC_OBIO_REG_SIZE);
    118 out:
    119 	return (result);
    120 }
    121 
    122 static void
    123 wdc_obio_attach(device_t parent, device_t self, void *aux)
    124 {
    125 	struct wdc_obio_softc *sc = device_private(self);
    126 	struct obio_attach_args *oa = aux;
    127 	struct wdc_regs *wdr;
    128 	int i;
    129 
    130 	aprint_naive("\n");
    131 	aprint_normal("\n");
    132 
    133 	sc->sc_wdcdev.sc_atac.atac_dev = self;
    134 	sc->sc_wdcdev.regs = wdr = &sc->sc_wdc_regs;
    135 
    136 	wdr->cmd_iot = oa->oa_iot;
    137 	wdr->ctl_iot = oa->oa_iot;
    138 	if (bus_space_map(wdr->cmd_iot, oa->oa_io[0].or_addr,
    139 	    WDC_OBIO_REG_SIZE, 0, &wdr->cmd_baseioh)
    140 	 || bus_space_map(wdr->ctl_iot,
    141 	    oa->oa_io[0].or_addr + WDC_OBIO_AUXREG_OFFSET,
    142 	    WDC_OBIO_AUXREG_SIZE, 0, &wdr->ctl_ioh)) {
    143 		aprint_error_dev(self, "couldn't map registers\n");
    144 		return;
    145 	}
    146 
    147 	for (i = 0; i < WDC_OBIO_REG_NPORTS; i++) {
    148 		if (bus_space_subregion(wdr->cmd_iot,
    149 		      wdr->cmd_baseioh, i * 2, (i == 0) ? 2 : 1,
    150 		      &wdr->cmd_iohs[i]) != 0) {
    151 			aprint_error_dev(self,
    152 			    "couldn't subregion registers\n");
    153 			return;
    154 		}
    155 	}
    156 
    157 	sc->sc_ih = obio_intr_establish(oa->oa_irq[0].or_irq, IPL_BIO, wdcintr,
    158 	    &sc->sc_channel);
    159 
    160 	sc->sc_wdcdev.cap |= WDC_CAPABILITY_PREATA;
    161 	sc->sc_wdcdev.sc_atac.atac_cap |= ATAC_CAP_DATA16;
    162 	sc->sc_wdcdev.sc_atac.atac_pio_cap = 0;
    163 	sc->sc_chanlist[0] = &sc->sc_channel;
    164 	sc->sc_wdcdev.sc_atac.atac_channels = sc->sc_chanlist;
    165 	sc->sc_wdcdev.sc_atac.atac_nchannels = 1;
    166 	sc->sc_wdcdev.wdc_maxdrives = 2;
    167 	sc->sc_channel.ch_channel = 0;
    168 	sc->sc_channel.ch_atac = &sc->sc_wdcdev.sc_atac;
    169 	sc->sc_channel.ch_queue = ata_queue_alloc(1);
    170 
    171 	wdc_init_shadow_regs(wdr);
    172 
    173 	wdcattach(&sc->sc_channel);
    174 }
    175