1 /* $NetBSD: wdc_spd.c,v 1.29 2017/10/20 07:06:07 jdolecek Exp $ */ 2 3 /*- 4 * Copyright (c) 2001, 2003 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by UCHIYAMA Yasushi. 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_spd.c,v 1.29 2017/10/20 07:06:07 jdolecek Exp $"); 34 35 #include <sys/param.h> 36 #include <sys/systm.h> 37 #include <sys/malloc.h> 38 39 #define __read_1(a) \ 40 ({ \ 41 u_int32_t ra_ = (a); \ 42 u_int8_t r = (*(volatile u_int8_t *)ra_); \ 43 \ 44 if (ra_ == 0xb400004e) /* (wdc)STAT LED off */ \ 45 SPD_LED_OFF(); \ 46 \ 47 (r); \ 48 }) 49 #define __write_1(a, v) \ 50 { \ 51 u_int32_t wa_ = (a); \ 52 (*(volatile u_int8_t *)wa_) = (v); \ 53 \ 54 if (wa_ == 0xb400004e) /* (wdc)CMD LED on */ \ 55 SPD_LED_ON(); \ 56 } 57 #define _PLAYSTATION2_BUS_SPACE_PRIVATE 58 #include <machine/bus.h> 59 60 #include <dev/ata/atavar.h> 61 #include <dev/ic/wdcvar.h> 62 63 #include <playstation2/ee/eevar.h> 64 #include <playstation2/dev/spdvar.h> 65 #include <playstation2/dev/spdreg.h> 66 67 #define WDC_SPD_HDD_AUXREG_OFFSET 0x1c 68 69 struct wdc_spd_softc { 70 struct wdc_softc sc_wdcdev; 71 struct ata_channel *sc_chanlist[1]; 72 struct ata_channel sc_channel; 73 struct wdc_regs sc_wdc_regs; 74 void *sc_ih; 75 }; 76 77 #ifdef DEBUG 78 #define STATIC 79 #else 80 #define STATIC static 81 #endif 82 83 STATIC int wdc_spd_match(device_t, cfdata_t, void *); 84 STATIC void wdc_spd_attach(device_t, device_t, void *); 85 86 CFATTACH_DECL_NEW(wdc_spd, sizeof (struct wdc_spd_softc), 87 wdc_spd_match, wdc_spd_attach, NULL, NULL); 88 89 extern struct cfdriver wdc_cd; 90 91 STATIC void __wdc_spd_enable(void); 92 STATIC void __wdc_spd_disable(void) __attribute__((__unused__)); 93 STATIC void __wdc_spd_bus_space(struct wdc_regs *); 94 95 /* 96 * wdc register is 16 bit wide. 97 */ 98 #define VADDR(h, o) ((h) + (o)) 99 _BUS_SPACE_READ(_wdc_spd, 1, 8) 100 _BUS_SPACE_READ(_wdc_spd, 2, 16) 101 _BUS_SPACE_READ_MULTI(_wdc_spd, 1, 8) 102 _BUS_SPACE_READ_MULTI(_wdc_spd, 2, 16) 103 _BUS_SPACE_READ_REGION(_wdc_spd, 1, 8) 104 _BUS_SPACE_READ_REGION(_wdc_spd, 2, 16) 105 _BUS_SPACE_WRITE(_wdc_spd, 1, 8) 106 _BUS_SPACE_WRITE(_wdc_spd, 2, 16) 107 _BUS_SPACE_WRITE_MULTI(_wdc_spd, 1, 8) 108 _BUS_SPACE_WRITE_MULTI(_wdc_spd, 2, 16) 109 _BUS_SPACE_WRITE_REGION(_wdc_spd, 1, 8) 110 _BUS_SPACE_WRITE_REGION(_wdc_spd, 2, 16) 111 _BUS_SPACE_SET_MULTI(_wdc_spd, 1, 8) 112 _BUS_SPACE_SET_MULTI(_wdc_spd, 2, 16) 113 _BUS_SPACE_SET_REGION(_wdc_spd, 1, 8) 114 _BUS_SPACE_SET_REGION(_wdc_spd, 2, 16) 115 _BUS_SPACE_COPY_REGION(_wdc_spd, 1, 8) 116 _BUS_SPACE_COPY_REGION(_wdc_spd, 2, 16) 117 #undef VADDR 118 119 STATIC const struct playstation2_bus_space _wdc_spd_space = { 120 pbs_map : _BUS_SPACE_NO_MAP, 121 pbs_unmap : _BUS_SPACE_NO_UNMAP, 122 pbs_subregion : _BUS_SPACE_NO_SUBREGION, 123 pbs_alloc : _BUS_SPACE_NO_ALLOC, 124 pbs_free : _BUS_SPACE_NO_FREE, 125 pbs_vaddr : _BUS_SPACE_NO_VADDR, 126 pbs_r_1 : _wdc_spd_read_1, 127 pbs_r_2 : _wdc_spd_read_2, 128 pbs_r_4 : _BUS_SPACE_NO_READ(4, 32), 129 pbs_r_8 : _BUS_SPACE_NO_READ(8, 64), 130 pbs_rm_1 : _wdc_spd_read_multi_1, 131 pbs_rm_2 : _wdc_spd_read_multi_2, 132 pbs_rm_4 : _BUS_SPACE_NO_READ_MULTI(4, 32), 133 pbs_rm_8 : _BUS_SPACE_NO_READ_MULTI(8, 64), 134 pbs_rr_1 : _wdc_spd_read_region_1, 135 pbs_rr_2 : _wdc_spd_read_region_2, 136 pbs_rr_4 : _BUS_SPACE_NO_READ_REGION(4, 32), 137 pbs_rr_8 : _BUS_SPACE_NO_READ_REGION(8, 64), 138 pbs_w_1 : _wdc_spd_write_1, 139 pbs_w_2 : _wdc_spd_write_2, 140 pbs_w_4 : _BUS_SPACE_NO_WRITE(4, 32), 141 pbs_w_8 : _BUS_SPACE_NO_WRITE(8, 64), 142 pbs_wm_1 : _wdc_spd_write_multi_1, 143 pbs_wm_2 : _wdc_spd_write_multi_2, 144 pbs_wm_4 : _BUS_SPACE_NO_WRITE_MULTI(4, 32), 145 pbs_wm_8 : _BUS_SPACE_NO_WRITE_MULTI(8, 64), 146 pbs_wr_1 : _wdc_spd_write_region_1, 147 pbs_wr_2 : _wdc_spd_write_region_2, 148 pbs_wr_4 : _BUS_SPACE_NO_WRITE_REGION(4, 32), 149 pbs_wr_8 : _BUS_SPACE_NO_WRITE_REGION(8, 64), 150 pbs_sm_1 : _wdc_spd_set_multi_1, 151 pbs_sm_2 : _wdc_spd_set_multi_2, 152 pbs_sm_4 : _BUS_SPACE_NO_SET_MULTI(4, 32), 153 pbs_sm_8 : _BUS_SPACE_NO_SET_MULTI(8, 64), 154 pbs_sr_1 : _wdc_spd_set_region_1, 155 pbs_sr_2 : _wdc_spd_set_region_2, 156 pbs_sr_4 : _BUS_SPACE_NO_SET_REGION(4, 32), 157 pbs_sr_8 : _BUS_SPACE_NO_SET_REGION(8, 64), 158 pbs_c_1 : _wdc_spd_copy_region_1, 159 pbs_c_2 : _wdc_spd_copy_region_2, 160 pbs_c_4 : _BUS_SPACE_NO_COPY_REGION(4, 32), 161 pbs_c_8 : _BUS_SPACE_NO_COPY_REGION(8, 64), 162 }; 163 164 int 165 wdc_spd_match(device_t parent, cfdata_t cf, void *aux) 166 { 167 struct spd_attach_args *spa = aux; 168 struct wdc_regs wdr; 169 int i, result; 170 171 if (spa->spa_slot != SPD_HDD) 172 return (0); 173 174 __wdc_spd_bus_space(&wdr); 175 176 for (i = 0, result = 0; i < 8; i++) { /* 8 sec */ 177 if (result == 0) 178 result = wdcprobe(&wdr); 179 delay(1000000); 180 } 181 182 return (result); 183 } 184 185 void 186 wdc_spd_attach(device_t parent, device_t self, void *aux) 187 { 188 struct spd_attach_args *spa = aux; 189 struct wdc_spd_softc *sc = device_private(self); 190 struct wdc_softc *wdc = &sc->sc_wdcdev; 191 struct ata_channel *ch = &sc->sc_channel; 192 193 aprint_normal(": %s\n", spa->spa_product_name); 194 195 sc->sc_wdcdev.sc_atac.atac_dev = self; 196 sc->sc_wdcdev.regs = &sc->sc_wdc_regs; 197 198 wdc->sc_atac.atac_cap = 199 ATAC_CAP_DMA | ATAC_CAP_UDMA | ATAC_CAP_DATA16; 200 wdc->sc_atac.atac_pio_cap = 0; 201 sc->sc_chanlist[0] = &sc->sc_channel; 202 wdc->sc_atac.atac_channels = sc->sc_chanlist; 203 wdc->sc_atac.atac_nchannels = 1; 204 ch->ch_channel = 0; 205 ch->ch_atac = &sc->sc_wdcdev.sc_atac; 206 ch->ch_ndrives = 2; 207 208 __wdc_spd_bus_space(CHAN_TO_WDC_REGS(ch)); 209 210 spd_intr_establish(SPD_HDD, wdcintr, &sc->sc_channel); 211 212 __wdc_spd_enable(); 213 214 wdcattach(&sc->sc_channel); 215 } 216 217 void 218 __wdc_spd_bus_space(struct wdc_regs *wdr) 219 { 220 int i; 221 222 wdr->cmd_iot = &_wdc_spd_space; 223 for (i = 0; i < 8; i++) 224 wdr->cmd_iohs[i] = SPD_HDD_IO_BASE + i * 2; /* wdc register is 16 bit wide. */ 225 wdc_init_shadow_regs(wdr); 226 wdr->ctl_iot = &_wdc_spd_space; 227 wdr->ctl_ioh = SPD_HDD_IO_BASE + WDC_SPD_HDD_AUXREG_OFFSET; 228 wdr->data32iot = wdr->cmd_iot; 229 wdr->data32ioh = SPD_HDD_IO_BASE; 230 } 231 232 void 233 __wdc_spd_enable(void) 234 { 235 u_int16_t r; 236 237 r = _reg_read_2(SPD_INTR_ENABLE_REG16); 238 r |= SPD_INTR_HDD; 239 _reg_write_2(SPD_INTR_ENABLE_REG16, r); 240 } 241 242 void 243 __wdc_spd_disable(void) 244 { 245 u_int16_t r; 246 247 r = _reg_read_2(SPD_INTR_ENABLE_REG16); 248 r &= ~SPD_INTR_HDD; 249 _reg_write_2(SPD_INTR_ENABLE_REG16, r); 250 } 251