| 1 | /* $NetBSD: satapmp_subr.c,v 1.12 2013/05/03 20:02:08 jakllsch Exp $ */ |
| 2 | |
| 3 | /* |
| 4 | * Copyright (c) 2012 Manuel Bouyer. All rights reserved. |
| 5 | * |
| 6 | * Redistribution and use in source and binary forms, with or without |
| 7 | * modification, are permitted provided that the following conditions |
| 8 | * are met: |
| 9 | * 1. Redistributions of source code must retain the above copyright |
| 10 | * notice, this list of conditions and the following disclaimer. |
| 11 | * 2. Redistributions in binary form must reproduce the above copyright |
| 12 | * notice, this list of conditions and the following disclaimer in the |
| 13 | * documentation and/or other materials provided with the distribution. |
| 14 | * |
| 15 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
| 16 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
| 17 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
| 18 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
| 19 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
| 20 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
| 21 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
| 22 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| 23 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
| 24 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| 25 | */ |
| 26 | |
| 27 | #include <sys/cdefs.h> |
| 28 | __KERNEL_RCSID(0, "$NetBSD: satapmp_subr.c,v 1.12 2013/05/03 20:02:08 jakllsch Exp $" ); |
| 29 | |
| 30 | #include <sys/param.h> |
| 31 | #include <sys/systm.h> |
| 32 | #include <sys/kernel.h> |
| 33 | #include <sys/device.h> |
| 34 | #include <sys/conf.h> |
| 35 | #include <sys/fcntl.h> |
| 36 | #include <sys/proc.h> |
| 37 | #include <sys/errno.h> |
| 38 | #include <sys/kmem.h> |
| 39 | #include <sys/intr.h> |
| 40 | |
| 41 | #include <dev/ata/ataconf.h> |
| 42 | #include <dev/ata/atareg.h> |
| 43 | #include <dev/ata/atavar.h> |
| 44 | |
| 45 | #include <dev/ata/satapmpvar.h> |
| 46 | #include <dev/ata/satapmpreg.h> |
| 47 | #include <dev/ata/satavar.h> |
| 48 | #include <dev/ata/satareg.h> |
| 49 | |
| 50 | static int |
| 51 | satapmp_read_8(struct ata_channel *chp, int port, int reg, uint64_t *value) |
| 52 | { |
| 53 | struct ata_command ata_c; |
| 54 | struct atac_softc *atac = chp->ch_atac; |
| 55 | struct ata_drive_datas *drvp; |
| 56 | |
| 57 | KASSERT(port < PMP_MAX_DRIVES); |
| 58 | KASSERT(reg < PMP_GSCR_NREGS); |
| 59 | KASSERT(chp->ch_ndrives >= PMP_MAX_DRIVES); |
| 60 | drvp = &chp->ch_drive[PMP_PORT_CTL]; |
| 61 | KASSERT(drvp->drive == PMP_PORT_CTL); |
| 62 | |
| 63 | memset(&ata_c, 0, sizeof(struct ata_command)); |
| 64 | |
| 65 | ata_c.r_command = PMPC_READ_PORT; |
| 66 | ata_c.r_features = reg; |
| 67 | ata_c.r_device = port; |
| 68 | ata_c.timeout = 3000; /* 3s */ |
| 69 | ata_c.r_st_bmask = 0; |
| 70 | ata_c.r_st_pmask = WDCS_DRDY; |
| 71 | ata_c.flags = AT_LBA48 | AT_READREG | AT_WAIT; |
| 72 | |
| 73 | if ((*atac->atac_bustype_ata->ata_exec_command)(drvp, |
| 74 | &ata_c) != ATACMD_COMPLETE) { |
| 75 | aprint_error_dev(chp->atabus, |
| 76 | "PMP port %d register %d read failed\n" , port, reg); |
| 77 | return EIO; |
| 78 | } |
| 79 | if (ata_c.flags & (AT_TIMEOU | AT_DF)) { |
| 80 | aprint_error_dev(chp->atabus, |
| 81 | "PMP port %d register %d read failed, flags 0x%x\n" , |
| 82 | port, reg, ata_c.flags); |
| 83 | return EIO; |
| 84 | } |
| 85 | if (ata_c.flags & AT_ERROR) { |
| 86 | aprint_verbose_dev(chp->atabus, |
| 87 | "PMP port %d register %d read failed, error 0x%x\n" , |
| 88 | port, reg, ata_c.r_error); |
| 89 | return EIO; |
| 90 | } |
| 91 | |
| 92 | *value = ((uint64_t)((ata_c.r_lba >> 24) & 0xffffff) << 40) | |
| 93 | ((uint64_t)((ata_c.r_count >> 8) & 0xff) << 32) | |
| 94 | ((uint64_t)((ata_c.r_lba >> 0) & 0xffffff) << 8) | |
| 95 | ((uint64_t)((ata_c.r_count >> 0) & 0xff) << 0); |
| 96 | |
| 97 | return 0; |
| 98 | } |
| 99 | |
| 100 | static inline int |
| 101 | satapmp_read(struct ata_channel *chp, int port, int reg, uint32_t *value) |
| 102 | { |
| 103 | uint64_t value64; |
| 104 | int ret; |
| 105 | |
| 106 | ret = satapmp_read_8(chp, port, reg, &value64); |
| 107 | if (ret) |
| 108 | return ret; |
| 109 | |
| 110 | *value = value64 & 0xffffffff; |
| 111 | return ret; |
| 112 | } |
| 113 | |
| 114 | static int |
| 115 | satapmp_write_8(struct ata_channel *chp, int port, int reg, uint64_t value) |
| 116 | { |
| 117 | struct ata_command ata_c; |
| 118 | struct atac_softc *atac = chp->ch_atac; |
| 119 | struct ata_drive_datas *drvp; |
| 120 | |
| 121 | KASSERT(port < PMP_MAX_DRIVES); |
| 122 | KASSERT(reg < PMP_GSCR_NREGS); |
| 123 | KASSERT(chp->ch_ndrives >= PMP_MAX_DRIVES); |
| 124 | drvp = &chp->ch_drive[PMP_PORT_CTL]; |
| 125 | KASSERT(drvp->drive == PMP_PORT_CTL); |
| 126 | |
| 127 | memset(&ata_c, 0, sizeof(struct ata_command)); |
| 128 | |
| 129 | ata_c.r_command = PMPC_WRITE_PORT; |
| 130 | ata_c.r_features = reg; |
| 131 | ata_c.r_device = port; |
| 132 | ata_c.r_lba = (((value >> 40) & 0xffffff) << 24) | |
| 133 | (((value >> 8) & 0xffffff) << 0); |
| 134 | ata_c.r_count = (((value >> 32) & 0xff) << 8) | |
| 135 | (((value >> 0) & 0xff) << 0); |
| 136 | ata_c.timeout = 3000; /* 3s */ |
| 137 | ata_c.r_st_bmask = 0; |
| 138 | ata_c.r_st_pmask = WDCS_DRDY; |
| 139 | ata_c.flags = AT_LBA48 | AT_WAIT; |
| 140 | |
| 141 | if ((*atac->atac_bustype_ata->ata_exec_command)(drvp, |
| 142 | &ata_c) != ATACMD_COMPLETE) { |
| 143 | aprint_error_dev(chp->atabus, |
| 144 | "PMP port %d register %d write failed\n" , port, reg); |
| 145 | return EIO; |
| 146 | } |
| 147 | if (ata_c.flags & (AT_TIMEOU | AT_DF)) { |
| 148 | aprint_error_dev(chp->atabus, |
| 149 | "PMP port %d register %d write failed, flags 0x%x\n" , |
| 150 | port, reg, ata_c.flags); |
| 151 | return EIO; |
| 152 | } |
| 153 | if (ata_c.flags & AT_ERROR) { |
| 154 | aprint_verbose_dev(chp->atabus, |
| 155 | "PMP port %d register %d write failed, error 0x%x\n" , |
| 156 | port, reg, ata_c.r_error); |
| 157 | return EIO; |
| 158 | } |
| 159 | return 0; |
| 160 | } |
| 161 | |
| 162 | static inline int |
| 163 | satapmp_write(struct ata_channel *chp, int port, int reg, uint32_t value) |
| 164 | { |
| 165 | return satapmp_write_8(chp, port, reg, value); |
| 166 | } |
| 167 | |
| 168 | /* |
| 169 | * Reset one port's PHY and bring it online |
| 170 | * XXX duplicate of sata_reset_interface() |
| 171 | */ |
| 172 | static uint32_t |
| 173 | satapmp_reset_device_port(struct ata_channel *chp, int port) |
| 174 | { |
| 175 | uint32_t scontrol, sstatus; |
| 176 | int i; |
| 177 | |
| 178 | /* bring the PHY online */ |
| 179 | scontrol = SControl_IPM_NONE | SControl_SPD_ANY | SControl_DET_INIT; |
| 180 | if (satapmp_write(chp, port, PMP_PSCR_SControl, scontrol) != 0) |
| 181 | return 0; |
| 182 | |
| 183 | tsleep(chp, PRIBIO, "sataup" , mstohz(50)); |
| 184 | scontrol &= ~SControl_DET_INIT; |
| 185 | if (satapmp_write(chp, port, PMP_PSCR_SControl, scontrol) != 0) |
| 186 | return 0; |
| 187 | tsleep(chp, PRIBIO, "sataup" , mstohz(50)); |
| 188 | |
| 189 | /* wait up to 1s for device to come up */ |
| 190 | for (i = 0; i < 100; i++) { |
| 191 | |
| 192 | if (satapmp_read(chp, port, PMP_PSCR_SStatus, &sstatus) != 0) |
| 193 | return 0; |
| 194 | if ((sstatus & SStatus_DET_mask) == SStatus_DET_DEV) |
| 195 | break; |
| 196 | tsleep(chp, PRIBIO, "sataup" , mstohz(10)); |
| 197 | } |
| 198 | |
| 199 | switch (sstatus & SStatus_DET_mask) { |
| 200 | case SStatus_DET_NODEV: |
| 201 | /* No Device; be silent. */ |
| 202 | break; |
| 203 | case SStatus_DET_DEV_NE: |
| 204 | aprint_error("%s PMP port %d: device connected, but " |
| 205 | "communication not established\n" , |
| 206 | device_xname(chp->atabus), port); |
| 207 | break; |
| 208 | case SStatus_DET_OFFLINE: |
| 209 | aprint_error("%s PMP port %d: PHY offline\n" , |
| 210 | device_xname(chp->atabus), port); |
| 211 | break; |
| 212 | case SStatus_DET_DEV: |
| 213 | aprint_normal("%s PMP port %d: device present, speed: %s\n" , |
| 214 | device_xname(chp->atabus), port, sata_speed(sstatus)); |
| 215 | break; |
| 216 | default: |
| 217 | aprint_error("%s PMP port %d: unknown SStatus: 0x%08x\n" , |
| 218 | device_xname(chp->atabus), port, sstatus); |
| 219 | } |
| 220 | return(sstatus & SStatus_DET_mask); |
| 221 | } |
| 222 | |
| 223 | void |
| 224 | satapmp_rescan(struct ata_channel *chp) { |
| 225 | int i; |
| 226 | uint32_t sig; |
| 227 | |
| 228 | KASSERT(chp->ch_satapmp_nports <= PMP_PORT_CTL); |
| 229 | KASSERT(chp->ch_satapmp_nports <= chp->ch_ndrives); |
| 230 | |
| 231 | for (i = 0; i < chp->ch_satapmp_nports; i++) { |
| 232 | if (chp->ch_drive[i].drive_type != ATA_DRIVET_NONE || |
| 233 | satapmp_reset_device_port(chp, i) != SStatus_DET_DEV) { |
| 234 | continue; |
| 235 | } |
| 236 | if (satapmp_write(chp, i, PMP_PSCR_SError, 0xffffffff) != 0) { |
| 237 | aprint_error("%s PMP port %d: can't write SError\n" , |
| 238 | device_xname(chp->atabus), i); |
| 239 | continue; |
| 240 | } |
| 241 | chp->ch_atac->atac_bustype_ata->ata_reset_drive( |
| 242 | &chp->ch_drive[i], AT_WAIT, &sig); |
| 243 | |
| 244 | sata_interpret_sig(chp, i, sig); |
| 245 | } |
| 246 | } |
| 247 | |
| 248 | void |
| 249 | satapmp_attach(struct ata_channel *chp) |
| 250 | { |
| 251 | uint32_t id, rev, inf; |
| 252 | |
| 253 | if (satapmp_read(chp, PMP_PORT_CTL, PMP_GSCR_ID, &id) != 0 || |
| 254 | satapmp_read(chp, PMP_PORT_CTL, PMP_GSCR_REV, &rev) != 0 || |
| 255 | satapmp_read(chp, PMP_PORT_CTL, PMP_GSCR_INF, &inf) != 0) { |
| 256 | aprint_normal_dev(chp->atabus, "can't read PMP registers\n" ); |
| 257 | return; |
| 258 | } |
| 259 | |
| 260 | aprint_normal_dev(chp->atabus, |
| 261 | "SATA port multiplier, %d ports\n" , PMP_INF_NPORTS(inf)); |
| 262 | aprint_verbose_dev(chp->atabus, |
| 263 | "vendor 0x%04x, product 0x%04x" , |
| 264 | PMP_ID_VEND(id), PMP_ID_DEV(id)); |
| 265 | if (rev & PMP_REV_SPEC_11) { |
| 266 | aprint_verbose(", revision 1.1" ); |
| 267 | } else if (rev & PMP_REV_SPEC_10) { |
| 268 | aprint_verbose(", revision 1.0" ); |
| 269 | } else { |
| 270 | aprint_verbose(", unknown revision 0x%x" , rev & 0x0f); |
| 271 | } |
| 272 | aprint_verbose(", level %d\n" , PMP_REV_LEVEL(rev)); |
| 273 | |
| 274 | chp->ch_satapmp_nports = PMP_INF_NPORTS(inf); |
| 275 | |
| 276 | /* reset and bring up PHYs */ |
| 277 | satapmp_rescan(chp); |
| 278 | } |
| 279 | |