svwsata.c revision 1.3
1 /* $NetBSD: svwsata.c,v 1.3 2006/03/29 04:16:50 thorpej Exp $ */ 2 3 /* 4 * Copyright (c) 2005 Mark Kettenis 5 * 6 * Permission to use, copy, modify, and distribute this software for any 7 * purpose with or without fee is hereby granted, provided that the above 8 * copyright notice and this permission notice appear in all copies. 9 * 10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 11 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 12 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 13 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 14 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 15 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 16 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 17 */ 18 19 #include <sys/cdefs.h> 20 __KERNEL_RCSID(0, "$NetBSD: svwsata.c,v 1.3 2006/03/29 04:16:50 thorpej Exp $"); 21 22 #include <sys/param.h> 23 #include <sys/systm.h> 24 25 #include <dev/ata/atareg.h> 26 #include <dev/ata/satareg.h> 27 #include <dev/ata/satavar.h> 28 #include <dev/pci/pcivar.h> 29 #include <dev/pci/pcidevs.h> 30 #include <dev/pci/pciidereg.h> 31 #include <dev/pci/pciidevar.h> 32 #include <dev/pci/pciide_svwsata_reg.h> 33 34 static int svwsata_match(struct device *, struct cfdata *, void *); 35 static void svwsata_attach(struct device *, struct device *, void *); 36 37 static void svwsata_chip_map(struct pciide_softc *, struct pci_attach_args *) __unused; 38 static void svwsata_mapreg_dma(struct pciide_softc *, struct pci_attach_args *); 39 static void svwsata_mapchan(struct pciide_channel *); 40 static void svwsata_drv_probe(struct ata_channel *chp); 41 42 CFATTACH_DECL(svwsata, sizeof(struct pciide_softc), 43 svwsata_match, svwsata_attach, NULL, NULL); 44 45 static const struct pciide_product_desc pciide_svwsata_products[] = { 46 { PCI_PRODUCT_SERVERWORKS_K2_SATA, 47 0, 48 "ServerWorks K2 SATA Controller", 49 svwsata_chip_map 50 }, 51 { PCI_PRODUCT_SERVERWORKS_FRODO4_SATA, 52 0, 53 "ServerWorks Frodo4 SATA Controller", 54 svwsata_chip_map 55 }, 56 { PCI_PRODUCT_SERVERWORKS_FRODO8_SATA, 57 0, 58 "ServerWorks Frodo8 SATA Controller", 59 svwsata_chip_map 60 }, 61 { PCI_PRODUCT_SERVERWORKS_HT1000_SATA, 62 0, 63 "ServerWorks HT-1000 SATA Controller", 64 svwsata_chip_map 65 }, 66 { 0, 67 0, 68 NULL, 69 NULL, 70 } 71 }; 72 73 static int 74 svwsata_match(struct device *parent, struct cfdata *match, void *aux) 75 { 76 struct pci_attach_args *pa = aux; 77 78 if (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_SERVERWORKS) { 79 if (pciide_lookup_product(pa->pa_id, 80 pciide_svwsata_products)) 81 return (2); 82 } 83 return (0); 84 } 85 86 static void 87 svwsata_attach(struct device *parent, struct device *self, void *aux) 88 { 89 struct pci_attach_args *pa = aux; 90 struct pciide_softc *sc = (void *)self; 91 92 pciide_common_attach(sc, pa, 93 pciide_lookup_product(pa->pa_id, pciide_svwsata_products)); 94 } 95 96 static void 97 svwsata_chip_map(struct pciide_softc *sc, struct pci_attach_args *pa) 98 { 99 struct pciide_channel *cp; 100 pci_intr_handle_t intrhandle; 101 pcireg_t interface; 102 const char *intrstr; 103 int channel; 104 105 if (pciide_chipen(sc, pa) == 0) 106 return; 107 108 /* The 4-port version has a dummy second function. */ 109 if (pci_conf_read(sc->sc_pc, sc->sc_tag, 110 PCI_MAPREG_START + 0x14) == 0) { 111 aprint_normal("\n"); 112 return; 113 } 114 115 if (pci_mapreg_map(pa, PCI_MAPREG_START + 0x14, 116 PCI_MAPREG_TYPE_MEM | 117 PCI_MAPREG_MEM_TYPE_32BIT, 0, 118 &sc->sc_ba5_st, &sc->sc_ba5_sh, 119 NULL, NULL) != 0) { 120 aprint_error(": unable to map BA5 register space\n"); 121 return; 122 } 123 124 aprint_normal(": DMA"); 125 svwsata_mapreg_dma(sc, pa); 126 aprint_normal("\n"); 127 128 sc->sc_wdcdev.sc_atac.atac_cap |= ATAC_CAP_DATA16 | ATAC_CAP_DATA32; 129 sc->sc_wdcdev.sc_atac.atac_pio_cap = 4; 130 if (sc->sc_dma_ok) { 131 sc->sc_wdcdev.sc_atac.atac_cap |= ATAC_CAP_DMA | ATAC_CAP_UDMA; 132 sc->sc_wdcdev.irqack = pciide_irqack; 133 sc->sc_wdcdev.sc_atac.atac_dma_cap = 2; 134 sc->sc_wdcdev.sc_atac.atac_udma_cap = 6; 135 } 136 137 sc->sc_wdcdev.sc_atac.atac_channels = sc->wdc_chanarray; 138 sc->sc_wdcdev.sc_atac.atac_nchannels = 4; 139 sc->sc_wdcdev.sc_atac.atac_set_modes = sata_setup_channel; 140 141 /* We can use SControl and SStatus to probe for drives. */ 142 sc->sc_wdcdev.sc_atac.atac_probe = svwsata_drv_probe; 143 144 wdc_allocate_regs(&sc->sc_wdcdev); 145 146 /* Map and establish the interrupt handler. */ 147 if(pci_intr_map(pa, &intrhandle) != 0) { 148 aprint_error("%s: couldn't map native-PCI interrupt\n", 149 sc->sc_wdcdev.sc_atac.atac_dev.dv_xname); 150 return; 151 } 152 intrstr = pci_intr_string(pa->pa_pc, intrhandle); 153 sc->sc_pci_ih = pci_intr_establish(pa->pa_pc, intrhandle, IPL_BIO, 154 pciide_pci_intr, sc); 155 if (sc->sc_pci_ih != NULL) { 156 aprint_normal("%s: using %s for native-PCI interrupt\n", 157 sc->sc_wdcdev.sc_atac.atac_dev.dv_xname, 158 intrstr ? intrstr : "unknown interrupt"); 159 } else { 160 aprint_error("%s: couldn't establish native-PCI interrupt", 161 sc->sc_wdcdev.sc_atac.atac_dev.dv_xname); 162 if (intrstr != NULL) 163 aprint_normal(" at %s", intrstr); 164 aprint_normal("\n"); 165 return; 166 } 167 168 interface = PCIIDE_INTERFACE_BUS_MASTER_DMA | 169 PCIIDE_INTERFACE_PCI(0) | PCIIDE_INTERFACE_PCI(1); 170 171 172 for (channel = 0; channel < sc->sc_wdcdev.sc_atac.atac_nchannels; 173 channel++) { 174 cp = &sc->pciide_channels[channel]; 175 176 if (pciide_chansetup(sc, channel, interface) == 0) 177 continue; 178 svwsata_mapchan(cp); 179 } 180 } 181 182 static void 183 svwsata_mapreg_dma(struct pciide_softc *sc, struct pci_attach_args *pa) 184 { 185 struct pciide_channel *pc; 186 int chan, reg; 187 bus_size_t size; 188 189 sc->sc_wdcdev.dma_arg = sc; 190 sc->sc_wdcdev.dma_init = pciide_dma_init; 191 sc->sc_wdcdev.dma_start = pciide_dma_start; 192 sc->sc_wdcdev.dma_finish = pciide_dma_finish; 193 194 if (device_cfdata(&sc->sc_wdcdev.sc_atac.atac_dev)->cf_flags & 195 PCIIDE_OPTIONS_NODMA) { 196 aprint_normal( 197 ", but unused (forced off by config file)"); 198 sc->sc_dma_ok = 0; 199 return; 200 } 201 202 /* 203 * Slice off a subregion of BA5 for each of the channel's DMA 204 * registers. 205 */ 206 207 sc->sc_dma_iot = sc->sc_ba5_st; 208 for (chan = 0; chan < 4; chan++) { 209 pc = &sc->pciide_channels[chan]; 210 for (reg = 0; reg < IDEDMA_NREGS; reg++) { 211 size = 4; 212 if (size > (IDEDMA_SCH_OFFSET - reg)) 213 size = IDEDMA_SCH_OFFSET - reg; 214 if (bus_space_subregion(sc->sc_ba5_st, 215 sc->sc_ba5_sh, 216 (chan << 8) + SVWSATA_DMA + reg, 217 size, &pc->dma_iohs[reg]) != 0) { 218 sc->sc_dma_ok = 0; 219 aprint_normal(", but can't subregion offset " 220 "%lu size %lu", 221 (u_long) (chan << 8) + SVWSATA_DMA + reg, 222 (u_long) size); 223 return; 224 } 225 } 226 } 227 228 /* DMA registers all set up! */ 229 sc->sc_dmat = pa->pa_dmat; 230 sc->sc_dma_ok = 1; 231 } 232 233 static void 234 svwsata_mapchan(struct pciide_channel *cp) 235 { 236 struct ata_channel *wdc_cp = &cp->ata_channel; 237 struct pciide_softc *sc = CHAN_TO_PCIIDE(wdc_cp); 238 struct wdc_regs *wdr = CHAN_TO_WDC_REGS(wdc_cp); 239 int i; 240 241 cp->compat = 0; 242 cp->ih = sc->sc_pci_ih; 243 244 wdr->cmd_iot = sc->sc_ba5_st; 245 if (bus_space_subregion(sc->sc_ba5_st, sc->sc_ba5_sh, 246 (wdc_cp->ch_channel << 8) + SVWSATA_TF0, 247 SVWSATA_TF8 - SVWSATA_TF0, &wdr->cmd_baseioh) != 0) { 248 aprint_error("%s: couldn't map %s cmd regs\n", 249 sc->sc_wdcdev.sc_atac.atac_dev.dv_xname, cp->name); 250 goto bad; 251 } 252 253 wdr->ctl_iot = sc->sc_ba5_st; 254 if (bus_space_subregion(sc->sc_ba5_st, sc->sc_ba5_sh, 255 (wdc_cp->ch_channel << 8) + SVWSATA_TF8, 4, 256 &cp->ctl_baseioh) != 0) { 257 aprint_error("%s: couldn't map %s ctl regs\n", 258 sc->sc_wdcdev.sc_atac.atac_dev.dv_xname, cp->name); 259 goto bad; 260 } 261 wdr->ctl_ioh = cp->ctl_baseioh; 262 263 for (i = 0; i < WDC_NREG; i++) { 264 if (bus_space_subregion(wdr->cmd_iot, wdr->cmd_baseioh, 265 i << 2, i == 0 ? 4 : 1, 266 &wdr->cmd_iohs[i]) != 0) { 267 aprint_error("%s: couldn't subregion %s channel " 268 "cmd regs\n", 269 sc->sc_wdcdev.sc_atac.atac_dev.dv_xname, cp->name); 270 goto bad; 271 } 272 } 273 wdc_init_shadow_regs(wdc_cp); 274 wdr->data32iot = wdr->cmd_iot; 275 wdr->data32ioh = wdr->cmd_iohs[0]; 276 277 wdcattach(wdc_cp); 278 return; 279 280 bad: 281 cp->ata_channel.ch_flags |= ATACH_DISABLED; 282 } 283 284 static void 285 svwsata_drv_probe(struct ata_channel *chp) 286 { 287 struct pciide_softc *sc = CHAN_TO_PCIIDE(chp); 288 struct wdc_regs *wdr = CHAN_TO_WDC_REGS(chp); 289 int channel = chp->ch_channel; 290 uint32_t scontrol, sstatus; 291 uint8_t scnt, sn, cl, ch; 292 int i, s; 293 294 /* XXX This should be done by other code. */ 295 for (i = 0; i < 2; i++) { 296 chp->ch_drive[i].chnl_softc = chp; 297 chp->ch_drive[i].drive = i; 298 } 299 300 /* 301 * Request communication initialization sequence, any speed. 302 * Performing this is the equivalent of an ATA Reset. 303 */ 304 scontrol = SControl_DET_INIT | SControl_SPD_ANY; 305 306 /* 307 * XXX We don't yet support SATA power management; disable all 308 * power management state transitions. 309 */ 310 scontrol |= SControl_IPM_NONE; 311 312 bus_space_write_4(sc->sc_ba5_st, sc->sc_ba5_sh, 313 (channel << 8) + SVWSATA_SCONTROL, scontrol); 314 delay(50 * 1000); 315 scontrol &= ~SControl_DET_INIT; 316 bus_space_write_4(sc->sc_ba5_st, sc->sc_ba5_sh, 317 (channel << 8) + SVWSATA_SCONTROL, scontrol); 318 delay(50 * 1000); 319 320 sstatus = bus_space_read_4(sc->sc_ba5_st, sc->sc_ba5_sh, 321 (channel << 8) + SVWSATA_SSTATUS); 322 #if 0 323 printf("%s: port %d: SStatus=0x%08x, SControl=0x%08x\n", 324 sc->sc_wdcdev.sc_atac.atac_dev.dv_xname, chp->ch_channel, sstatus, 325 bus_space_read_4(sc->sc_ba5_st, sc->sc_ba5_sh, 326 (channel << 8) + SVWSATA_SSTATUS)); 327 #endif 328 switch (sstatus & SStatus_DET_mask) { 329 case SStatus_DET_NODEV: 330 /* No device; be silent. */ 331 break; 332 333 case SStatus_DET_DEV_NE: 334 aprint_error("%s: port %d: device connected, but " 335 "communication not established\n", 336 sc->sc_wdcdev.sc_atac.atac_dev.dv_xname, chp->ch_channel); 337 break; 338 339 case SStatus_DET_OFFLINE: 340 aprint_error("%s: port %d: PHY offline\n", 341 sc->sc_wdcdev.sc_atac.atac_dev.dv_xname, chp->ch_channel); 342 break; 343 344 case SStatus_DET_DEV: 345 /* 346 * XXX ATAPI detection doesn't currently work. Don't 347 * XXX know why. But, it's not like the standard method 348 * XXX can detect an ATAPI device connected via a SATA/PATA 349 * XXX bridge, so at least this is no worse. --thorpej 350 */ 351 bus_space_write_1(wdr->cmd_iot, wdr->cmd_iohs[wd_sdh], 0, 352 WDSD_IBM | (0 << 4)); 353 delay(10); /* 400ns delay */ 354 /* Save register contents. */ 355 scnt = bus_space_read_1(wdr->cmd_iot, 356 wdr->cmd_iohs[wd_seccnt], 0); 357 sn = bus_space_read_1(wdr->cmd_iot, 358 wdr->cmd_iohs[wd_sector], 0); 359 cl = bus_space_read_1(wdr->cmd_iot, 360 wdr->cmd_iohs[wd_cyl_lo], 0); 361 ch = bus_space_read_1(wdr->cmd_iot, 362 wdr->cmd_iohs[wd_cyl_hi], 0); 363 #if 0 364 printf("%s: port %d: scnt=0x%x sn=0x%x cl=0x%x ch=0x%x\n", 365 sc->sc_wdcdev.sc_atac.atac_dev.dv_xname, chp->ch_channel, 366 scnt, sn, cl, ch); 367 #endif 368 /* 369 * scnt and sn are supposed to be 0x1 for ATAPI, but in some 370 * cases we get wrong values here, so ignore it. 371 */ 372 s = splbio(); 373 if (cl == 0x14 && ch == 0xeb) 374 chp->ch_drive[0].drive_flags |= DRIVE_ATAPI; 375 else 376 chp->ch_drive[0].drive_flags |= DRIVE_ATA; 377 splx(s); 378 379 aprint_normal("%s: port %d: device present, speed: %s\n", 380 sc->sc_wdcdev.sc_atac.atac_dev.dv_xname, chp->ch_channel, 381 sata_speed(sstatus)); 382 break; 383 384 default: 385 aprint_error("%s: port %d: unknown SStatus: 0x%08x\n", 386 sc->sc_wdcdev.sc_atac.atac_dev.dv_xname, chp->ch_channel, sstatus); 387 } 388 } 389
Indexes created Sat Sep 27 21:09:56 GMT 2025