mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 1 | /* |
Wolfgang Denk | 142bdbe | 2007-05-15 23:38:05 +0200 | [diff] [blame] | 2 | * Copyright (C) Procsys. All rights reserved. |
| 3 | * Author: Mushtaq Khan <mushtaq_k@procsys.com> |
| 4 | * <mushtaqk_921@yahoo.co.in> |
| 5 | * |
Wolfgang Denk | d79de1d | 2013-07-08 09:37:19 +0200 | [diff] [blame] | 6 | * SPDX-License-Identifier: GPL-2.0+ |
Wolfgang Denk | 142bdbe | 2007-05-15 23:38:05 +0200 | [diff] [blame] | 7 | * |
| 8 | * with the reference to ata_piix driver in kernel 2.4.32 |
| 9 | */ |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 10 | |
| 11 | /* |
Wolfgang Denk | 142bdbe | 2007-05-15 23:38:05 +0200 | [diff] [blame] | 12 | * This file contains SATA controller and SATA drive initialization functions |
| 13 | */ |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 14 | |
| 15 | #include <common.h> |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 16 | #include <asm/io.h> |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 17 | #include <pci.h> |
| 18 | #include <command.h> |
| 19 | #include <config.h> |
| 20 | #include <asm/byteorder.h> |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 21 | #include <part.h> |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 22 | #include <ide.h> |
| 23 | #include <ata.h> |
Pavel Herrmann | 9e9f628 | 2012-09-27 23:18:04 +0000 | [diff] [blame] | 24 | #include <sata.h> |
Dave Liu | a566ebd | 2008-03-26 22:50:45 +0800 | [diff] [blame] | 25 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 26 | #define DEBUG_SATA 0 /* For debug prints set DEBUG_SATA to 1 */ |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 27 | |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 28 | #define SATA_DECL |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 29 | #define DRV_DECL /* For file specific declarations */ |
Dave Liu | c230272 | 2008-03-26 22:48:18 +0800 | [diff] [blame] | 30 | #include "ata_piix.h" |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 31 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 32 | /* Macros realted to PCI */ |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 33 | #define PCI_SATA_BUS 0x00 |
| 34 | #define PCI_SATA_DEV 0x1f |
| 35 | #define PCI_SATA_FUNC 0x02 |
| 36 | |
| 37 | #define PCI_SATA_BASE1 0x10 |
| 38 | #define PCI_SATA_BASE2 0x14 |
| 39 | #define PCI_SATA_BASE3 0x18 |
| 40 | #define PCI_SATA_BASE4 0x1c |
| 41 | #define PCI_SATA_BASE5 0x20 |
| 42 | #define PCI_PMR 0x90 |
| 43 | #define PCI_PI 0x09 |
| 44 | #define PCI_PCS 0x92 |
| 45 | #define PCI_DMA_CTL 0x48 |
| 46 | |
| 47 | #define PORT_PRESENT (1<<0) |
| 48 | #define PORT_ENABLED (1<<4) |
| 49 | |
| 50 | u32 bdf; |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 51 | u32 iobase1; /* Primary cmd block */ |
| 52 | u32 iobase2; /* Primary ctl block */ |
| 53 | u32 iobase3; /* Sec cmd block */ |
| 54 | u32 iobase4; /* sec ctl block */ |
| 55 | u32 iobase5; /* BMDMA*/ |
| 56 | |
| 57 | int pci_sata_init(void) |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 58 | { |
| 59 | u32 bus = PCI_SATA_BUS; |
| 60 | u32 dev = PCI_SATA_DEV; |
| 61 | u32 fun = PCI_SATA_FUNC; |
| 62 | u16 cmd = 0; |
| 63 | u8 lat = 0, pcibios_max_latency = 0xff; |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 64 | u8 pmr; /* Port mapping reg */ |
| 65 | u8 pi; /* Prgming Interface reg */ |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 66 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 67 | bdf = PCI_BDF(bus, dev, fun); |
| 68 | pci_read_config_dword(bdf, PCI_SATA_BASE1, &iobase1); |
| 69 | pci_read_config_dword(bdf, PCI_SATA_BASE2, &iobase2); |
| 70 | pci_read_config_dword(bdf, PCI_SATA_BASE3, &iobase3); |
| 71 | pci_read_config_dword(bdf, PCI_SATA_BASE4, &iobase4); |
| 72 | pci_read_config_dword(bdf, PCI_SATA_BASE5, &iobase5); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 73 | |
| 74 | if ((iobase1 == 0xFFFFFFFF) || (iobase2 == 0xFFFFFFFF) || |
| 75 | (iobase3 == 0xFFFFFFFF) || (iobase4 == 0xFFFFFFFF) || |
| 76 | (iobase5 == 0xFFFFFFFF)) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 77 | /* ERROR */ |
| 78 | printf("error no base addr for SATA controller\n"); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 79 | return 1; |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 80 | } |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 81 | |
| 82 | iobase1 &= 0xFFFFFFFE; |
| 83 | iobase2 &= 0xFFFFFFFE; |
| 84 | iobase3 &= 0xFFFFFFFE; |
| 85 | iobase4 &= 0xFFFFFFFE; |
| 86 | iobase5 &= 0xFFFFFFFE; |
| 87 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 88 | /* check for mode */ |
| 89 | pci_read_config_byte(bdf, PCI_PMR, &pmr); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 90 | if (pmr > 1) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 91 | puts("combined mode not supported\n"); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 92 | return 1; |
| 93 | } |
| 94 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 95 | pci_read_config_byte(bdf, PCI_PI, &pi); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 96 | if ((pi & 0x05) != 0x05) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 97 | puts("Sata is in Legacy mode\n"); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 98 | return 1; |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 99 | } else |
| 100 | puts("sata is in Native mode\n"); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 101 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 102 | /* MASTER CFG AND IO CFG */ |
| 103 | pci_read_config_word(bdf, PCI_COMMAND, &cmd); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 104 | cmd |= PCI_COMMAND_MASTER | PCI_COMMAND_IO; |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 105 | pci_write_config_word(bdf, PCI_COMMAND, cmd); |
| 106 | pci_read_config_byte(dev, PCI_LATENCY_TIMER, &lat); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 107 | |
| 108 | if (lat < 16) |
| 109 | lat = (64 <= pcibios_max_latency) ? 64 : pcibios_max_latency; |
| 110 | else if (lat > pcibios_max_latency) |
| 111 | lat = pcibios_max_latency; |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 112 | pci_write_config_byte(dev, PCI_LATENCY_TIMER, lat); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 113 | |
| 114 | return 0; |
| 115 | } |
| 116 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 117 | int sata_bus_probe(int port_no) |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 118 | { |
| 119 | int orig_mask, mask; |
| 120 | u16 pcs; |
| 121 | |
| 122 | mask = (PORT_PRESENT << port_no); |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 123 | pci_read_config_word(bdf, PCI_PCS, &pcs); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 124 | orig_mask = (int) pcs & 0xff; |
| 125 | if ((orig_mask & mask) != mask) |
| 126 | return 0; |
| 127 | else |
| 128 | return 1; |
| 129 | } |
| 130 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 131 | int init_sata(int dev) |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 132 | { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 133 | static int done; |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 134 | u8 i, rv = 0; |
| 135 | |
Dave Liu | a566ebd | 2008-03-26 22:50:45 +0800 | [diff] [blame] | 136 | if (!done) |
| 137 | done = 1; |
| 138 | else |
| 139 | return 0; |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 140 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 141 | rv = pci_sata_init(); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 142 | if (rv == 1) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 143 | puts("pci initialization failed\n"); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 144 | return 1; |
| 145 | } |
| 146 | |
| 147 | port[0].port_no = 0; |
| 148 | port[0].ioaddr.cmd_addr = iobase1; |
| 149 | port[0].ioaddr.altstatus_addr = port[0].ioaddr.ctl_addr = |
| 150 | iobase2 | ATA_PCI_CTL_OFS; |
| 151 | port[0].ioaddr.bmdma_addr = iobase5; |
| 152 | |
| 153 | port[1].port_no = 1; |
| 154 | port[1].ioaddr.cmd_addr = iobase3; |
| 155 | port[1].ioaddr.altstatus_addr = port[1].ioaddr.ctl_addr = |
| 156 | iobase4 | ATA_PCI_CTL_OFS; |
| 157 | port[1].ioaddr.bmdma_addr = iobase5 + 0x8; |
| 158 | |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 159 | for (i = 0; i < CONFIG_SYS_SATA_MAXBUS; i++) |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 160 | sata_port(&port[i].ioaddr); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 161 | |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 162 | for (i = 0; i < CONFIG_SYS_SATA_MAXBUS; i++) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 163 | if (!(sata_bus_probe(i))) { |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 164 | port[i].port_state = 0; |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 165 | printf("SATA#%d port is not present\n", i); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 166 | } else { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 167 | printf("SATA#%d port is present\n", i); |
| 168 | if (sata_bus_softreset(i)) |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 169 | port[i].port_state = 0; |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 170 | else |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 171 | port[i].port_state = 1; |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 172 | } |
| 173 | } |
| 174 | |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 175 | for (i = 0; i < CONFIG_SYS_SATA_MAXBUS; i++) { |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 176 | u8 j, devno; |
| 177 | |
| 178 | if (port[i].port_state == 0) |
| 179 | continue; |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 180 | for (j = 0; j < CONFIG_SYS_SATA_DEVS_PER_BUS; j++) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 181 | sata_identify(i, j); |
| 182 | set_Feature_cmd(i, j); |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 183 | devno = i * CONFIG_SYS_SATA_DEVS_PER_BUS + j; |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 184 | if ((sata_dev_desc[devno].lba > 0) && |
| 185 | (sata_dev_desc[devno].blksz > 0)) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 186 | dev_print(&sata_dev_desc[devno]); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 187 | /* initialize partition type */ |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 188 | init_part(&sata_dev_desc[devno]); |
mushtaq khan | 5651b34 | 2007-04-20 14:23:02 +0530 | [diff] [blame] | 189 | } |
| 190 | } |
| 191 | } |
| 192 | return 0; |
| 193 | } |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 194 | |
Nikita Kiryanov | b9666d6 | 2014-11-21 12:47:23 +0200 | [diff] [blame^] | 195 | int reset_sata(int dev) |
| 196 | { |
| 197 | return 0; |
| 198 | } |
| 199 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 200 | static inline u8 sata_inb(unsigned long ioaddr) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 201 | { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 202 | return inb(ioaddr); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 203 | } |
| 204 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 205 | static inline void sata_outb(unsigned char val, unsigned long ioaddr) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 206 | { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 207 | outb(val, ioaddr); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 208 | } |
| 209 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 210 | static void output_data(struct sata_ioports *ioaddr, ulong * sect_buf, |
| 211 | int words) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 212 | { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 213 | outsw(ioaddr->data_addr, sect_buf, words << 1); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 214 | } |
| 215 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 216 | static int input_data(struct sata_ioports *ioaddr, ulong * sect_buf, int words) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 217 | { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 218 | insw(ioaddr->data_addr, sect_buf, words << 1); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 219 | return 0; |
| 220 | } |
| 221 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 222 | static void sata_cpy(unsigned char *dst, unsigned char *src, unsigned int len) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 223 | { |
| 224 | unsigned char *end, *last; |
| 225 | |
| 226 | last = dst; |
| 227 | end = src + len - 1; |
| 228 | |
| 229 | /* reserve space for '\0' */ |
| 230 | if (len < 2) |
| 231 | goto OUT; |
| 232 | |
| 233 | /* skip leading white space */ |
| 234 | while ((*src) && (src < end) && (*src == ' ')) |
| 235 | ++src; |
| 236 | |
| 237 | /* copy string, omitting trailing white space */ |
| 238 | while ((*src) && (src < end)) { |
| 239 | *dst++ = *src; |
| 240 | if (*src++ != ' ') |
| 241 | last = dst; |
| 242 | } |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 243 | OUT: |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 244 | *last = '\0'; |
| 245 | } |
| 246 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 247 | int sata_bus_softreset(int num) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 248 | { |
| 249 | u8 dev = 0, status = 0, i; |
| 250 | |
| 251 | port[num].dev_mask = 0; |
| 252 | |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 253 | for (i = 0; i < CONFIG_SYS_SATA_DEVS_PER_BUS; i++) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 254 | if (!(sata_devchk(&port[num].ioaddr, i))) { |
| 255 | debug("dev_chk failed for dev#%d\n", i); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 256 | } else { |
| 257 | port[num].dev_mask |= (1 << i); |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 258 | debug("dev_chk passed for dev#%d\n", i); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 259 | } |
| 260 | } |
| 261 | |
| 262 | if (!(port[num].dev_mask)) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 263 | printf("no devices on port%d\n", num); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 264 | return 1; |
| 265 | } |
| 266 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 267 | dev_select(&port[num].ioaddr, dev); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 268 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 269 | port[num].ctl_reg = 0x08; /* Default value of control reg */ |
| 270 | sata_outb(port[num].ctl_reg, port[num].ioaddr.ctl_addr); |
| 271 | udelay(10); |
| 272 | sata_outb(port[num].ctl_reg | ATA_SRST, port[num].ioaddr.ctl_addr); |
| 273 | udelay(10); |
| 274 | sata_outb(port[num].ctl_reg, port[num].ioaddr.ctl_addr); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 275 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 276 | /* |
| 277 | * spec mandates ">= 2ms" before checking status. |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 278 | * We wait 150ms, because that was the magic delay used for |
| 279 | * ATAPI devices in Hale Landis's ATADRVR, for the period of time |
| 280 | * between when the ATA command register is written, and then |
| 281 | * status is checked. Because waiting for "a while" before |
| 282 | * checking status is fine, post SRST, we perform this magic |
| 283 | * delay here as well. |
| 284 | */ |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 285 | mdelay(150); |
| 286 | status = sata_busy_wait(&port[num].ioaddr, ATA_BUSY, 300); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 287 | while ((status & ATA_BUSY)) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 288 | mdelay(100); |
| 289 | status = sata_busy_wait(&port[num].ioaddr, ATA_BUSY, 3); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 290 | } |
| 291 | |
| 292 | if (status & ATA_BUSY) |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 293 | printf("ata%u is slow to respond,plz be patient\n", num); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 294 | |
| 295 | while ((status & ATA_BUSY)) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 296 | mdelay(100); |
| 297 | status = sata_chk_status(&port[num].ioaddr); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 298 | } |
| 299 | |
| 300 | if (status & ATA_BUSY) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 301 | printf("ata%u failed to respond : bus reset failed\n", num); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 302 | return 1; |
| 303 | } |
| 304 | return 0; |
| 305 | } |
| 306 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 307 | void sata_identify(int num, int dev) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 308 | { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 309 | u8 cmd = 0, status = 0; |
| 310 | u8 devno = num * CONFIG_SYS_SATA_DEVS_PER_BUS + dev; |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 311 | u16 iobuf[ATA_SECT_SIZE]; |
| 312 | u64 n_sectors = 0; |
| 313 | u8 mask = 0; |
| 314 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 315 | memset(iobuf, 0, sizeof(iobuf)); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 316 | hd_driveid_t *iop = (hd_driveid_t *) iobuf; |
| 317 | |
| 318 | if (dev == 0) |
| 319 | mask = 0x01; |
| 320 | else |
| 321 | mask = 0x02; |
| 322 | |
| 323 | if (!(port[num].dev_mask & mask)) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 324 | printf("dev%d is not present on port#%d\n", dev, num); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 325 | return; |
| 326 | } |
| 327 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 328 | printf("port=%d dev=%d\n", num, dev); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 329 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 330 | dev_select(&port[num].ioaddr, dev); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 331 | |
| 332 | status = 0; |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 333 | cmd = ATA_CMD_IDENT; /* Device Identify Command */ |
| 334 | sata_outb(cmd, port[num].ioaddr.command_addr); |
| 335 | sata_inb(port[num].ioaddr.altstatus_addr); |
| 336 | udelay(10); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 337 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 338 | status = sata_busy_wait(&port[num].ioaddr, ATA_BUSY, 1000); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 339 | if (status & ATA_ERR) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 340 | puts("\ndevice not responding\n"); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 341 | port[num].dev_mask &= ~mask; |
| 342 | return; |
| 343 | } |
| 344 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 345 | input_data(&port[num].ioaddr, (ulong *) iobuf, ATA_SECTORWORDS); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 346 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 347 | debug("\nata%u: dev %u cfg 49:%04x 82:%04x 83:%04x 84:%04x85:%04x" |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 348 | "86:%04x" "87:%04x 88:%04x\n", num, dev, iobuf[49], |
| 349 | iobuf[82], iobuf[83], iobuf[84], iobuf[85], iobuf[86], |
| 350 | iobuf[87], iobuf[88]); |
| 351 | |
| 352 | /* we require LBA and DMA support (bits 8 & 9 of word 49) */ |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 353 | if (!ata_id_has_dma(iobuf) || !ata_id_has_lba(iobuf)) |
| 354 | debug("ata%u: no dma/lba\n", num); |
| 355 | ata_dump_id(iobuf); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 356 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 357 | if (ata_id_has_lba48(iobuf)) |
| 358 | n_sectors = ata_id_u64(iobuf, 100); |
| 359 | else |
| 360 | n_sectors = ata_id_u32(iobuf, 60); |
| 361 | debug("no. of sectors %u\n", ata_id_u64(iobuf, 100)); |
| 362 | debug("no. of sectors %u\n", ata_id_u32(iobuf, 60)); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 363 | |
| 364 | if (n_sectors == 0) { |
| 365 | port[num].dev_mask &= ~mask; |
| 366 | return; |
| 367 | } |
| 368 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 369 | sata_cpy((unsigned char *)sata_dev_desc[devno].revision, iop->fw_rev, |
| 370 | sizeof(sata_dev_desc[devno].revision)); |
| 371 | sata_cpy((unsigned char *)sata_dev_desc[devno].vendor, iop->model, |
| 372 | sizeof(sata_dev_desc[devno].vendor)); |
| 373 | sata_cpy((unsigned char *)sata_dev_desc[devno].product, iop->serial_no, |
| 374 | sizeof(sata_dev_desc[devno].product)); |
| 375 | strswab(sata_dev_desc[devno].revision); |
| 376 | strswab(sata_dev_desc[devno].vendor); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 377 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 378 | if ((iop->config & 0x0080) == 0x0080) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 379 | sata_dev_desc[devno].removable = 1; |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 380 | else |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 381 | sata_dev_desc[devno].removable = 0; |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 382 | |
| 383 | sata_dev_desc[devno].lba = iop->lba_capacity; |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 384 | debug("lba=0x%x", sata_dev_desc[devno].lba); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 385 | |
| 386 | #ifdef CONFIG_LBA48 |
| 387 | if (iop->command_set_2 & 0x0400) { |
| 388 | sata_dev_desc[devno].lba48 = 1; |
| 389 | lba = (unsigned long long) iop->lba48_capacity[0] | |
| 390 | ((unsigned long long) iop->lba48_capacity[1] << 16) | |
| 391 | ((unsigned long long) iop->lba48_capacity[2] << 32) | |
| 392 | ((unsigned long long) iop->lba48_capacity[3] << 48); |
| 393 | } else { |
| 394 | sata_dev_desc[devno].lba48 = 0; |
| 395 | } |
| 396 | #endif |
| 397 | |
| 398 | /* assuming HD */ |
| 399 | sata_dev_desc[devno].type = DEV_TYPE_HARDDISK; |
| 400 | sata_dev_desc[devno].blksz = ATA_BLOCKSIZE; |
Egbert Eich | 2eec2ab | 2013-04-09 21:11:56 +0000 | [diff] [blame] | 401 | sata_dev_desc[devno].log2blksz = LOG2(sata_dev_desc[devno].blksz); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 402 | sata_dev_desc[devno].lun = 0; /* just to fill something in... */ |
| 403 | } |
| 404 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 405 | void set_Feature_cmd(int num, int dev) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 406 | { |
| 407 | u8 mask = 0x00, status = 0; |
| 408 | |
| 409 | if (dev == 0) |
| 410 | mask = 0x01; |
| 411 | else |
| 412 | mask = 0x02; |
| 413 | |
| 414 | if (!(port[num].dev_mask & mask)) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 415 | debug("dev%d is not present on port#%d\n", dev, num); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 416 | return; |
| 417 | } |
| 418 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 419 | dev_select(&port[num].ioaddr, dev); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 420 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 421 | sata_outb(SETFEATURES_XFER, port[num].ioaddr.feature_addr); |
| 422 | sata_outb(XFER_PIO_4, port[num].ioaddr.nsect_addr); |
| 423 | sata_outb(0, port[num].ioaddr.lbal_addr); |
| 424 | sata_outb(0, port[num].ioaddr.lbam_addr); |
| 425 | sata_outb(0, port[num].ioaddr.lbah_addr); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 426 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 427 | sata_outb(ATA_DEVICE_OBS, port[num].ioaddr.device_addr); |
| 428 | sata_outb(ATA_CMD_SETF, port[num].ioaddr.command_addr); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 429 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 430 | udelay(50); |
| 431 | mdelay(150); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 432 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 433 | status = sata_busy_wait(&port[num].ioaddr, ATA_BUSY, 5000); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 434 | if ((status & (ATA_STAT_BUSY | ATA_STAT_ERR))) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 435 | printf("Error : status 0x%02x\n", status); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 436 | port[num].dev_mask &= ~mask; |
| 437 | } |
| 438 | } |
| 439 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 440 | void sata_port(struct sata_ioports *ioport) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 441 | { |
| 442 | ioport->data_addr = ioport->cmd_addr + ATA_REG_DATA; |
| 443 | ioport->error_addr = ioport->cmd_addr + ATA_REG_ERR; |
| 444 | ioport->feature_addr = ioport->cmd_addr + ATA_REG_FEATURE; |
| 445 | ioport->nsect_addr = ioport->cmd_addr + ATA_REG_NSECT; |
| 446 | ioport->lbal_addr = ioport->cmd_addr + ATA_REG_LBAL; |
| 447 | ioport->lbam_addr = ioport->cmd_addr + ATA_REG_LBAM; |
| 448 | ioport->lbah_addr = ioport->cmd_addr + ATA_REG_LBAH; |
| 449 | ioport->device_addr = ioport->cmd_addr + ATA_REG_DEVICE; |
| 450 | ioport->status_addr = ioport->cmd_addr + ATA_REG_STATUS; |
| 451 | ioport->command_addr = ioport->cmd_addr + ATA_REG_CMD; |
| 452 | } |
| 453 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 454 | int sata_devchk(struct sata_ioports *ioaddr, int dev) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 455 | { |
| 456 | u8 nsect, lbal; |
| 457 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 458 | dev_select(ioaddr, dev); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 459 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 460 | sata_outb(0x55, ioaddr->nsect_addr); |
| 461 | sata_outb(0xaa, ioaddr->lbal_addr); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 462 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 463 | sata_outb(0xaa, ioaddr->nsect_addr); |
| 464 | sata_outb(0x55, ioaddr->lbal_addr); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 465 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 466 | sata_outb(0x55, ioaddr->nsect_addr); |
| 467 | sata_outb(0xaa, ioaddr->lbal_addr); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 468 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 469 | nsect = sata_inb(ioaddr->nsect_addr); |
| 470 | lbal = sata_inb(ioaddr->lbal_addr); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 471 | |
| 472 | if ((nsect == 0x55) && (lbal == 0xaa)) |
| 473 | return 1; /* we found a device */ |
| 474 | else |
| 475 | return 0; /* nothing found */ |
| 476 | } |
| 477 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 478 | void dev_select(struct sata_ioports *ioaddr, int dev) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 479 | { |
| 480 | u8 tmp = 0; |
| 481 | |
| 482 | if (dev == 0) |
| 483 | tmp = ATA_DEVICE_OBS; |
| 484 | else |
| 485 | tmp = ATA_DEVICE_OBS | ATA_DEV1; |
| 486 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 487 | sata_outb(tmp, ioaddr->device_addr); |
| 488 | sata_inb(ioaddr->altstatus_addr); |
| 489 | udelay(5); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 490 | } |
| 491 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 492 | u8 sata_busy_wait(struct sata_ioports *ioaddr, int bits, unsigned int max) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 493 | { |
| 494 | u8 status; |
| 495 | |
| 496 | do { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 497 | udelay(1000); |
| 498 | status = sata_chk_status(ioaddr); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 499 | max--; |
| 500 | } while ((status & bits) && (max > 0)); |
| 501 | |
| 502 | return status; |
| 503 | } |
| 504 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 505 | u8 sata_chk_status(struct sata_ioports *ioaddr) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 506 | { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 507 | return sata_inb(ioaddr->status_addr); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 508 | } |
| 509 | |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 510 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 511 | ulong sata_read(int device, ulong blknr, lbaint_t blkcnt, void *buff) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 512 | { |
| 513 | ulong n = 0, *buffer = (ulong *)buff; |
| 514 | u8 dev = 0, num = 0, mask = 0, status = 0; |
| 515 | |
| 516 | #ifdef CONFIG_LBA48 |
| 517 | unsigned char lba48 = 0; |
| 518 | |
| 519 | if (blknr & 0x0000fffff0000000) { |
| 520 | if (!sata_dev_desc[devno].lba48) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 521 | printf("Drive doesn't support 48-bit addressing\n"); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 522 | return 0; |
| 523 | } |
| 524 | /* more than 28 bits used, use 48bit mode */ |
| 525 | lba48 = 1; |
| 526 | } |
| 527 | #endif |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 528 | /* Port Number */ |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 529 | num = device / CONFIG_SYS_SATA_DEVS_PER_BUS; |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 530 | /* dev on the port */ |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 531 | if (device >= CONFIG_SYS_SATA_DEVS_PER_BUS) |
| 532 | dev = device - CONFIG_SYS_SATA_DEVS_PER_BUS; |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 533 | else |
| 534 | dev = device; |
| 535 | |
| 536 | if (dev == 0) |
| 537 | mask = 0x01; |
| 538 | else |
| 539 | mask = 0x02; |
| 540 | |
| 541 | if (!(port[num].dev_mask & mask)) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 542 | printf("dev%d is not present on port#%d\n", dev, num); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 543 | return 0; |
| 544 | } |
| 545 | |
| 546 | /* Select device */ |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 547 | dev_select(&port[num].ioaddr, dev); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 548 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 549 | status = sata_busy_wait(&port[num].ioaddr, ATA_BUSY, 500); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 550 | if (status & ATA_BUSY) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 551 | printf("ata%u failed to respond\n", port[num].port_no); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 552 | return n; |
| 553 | } |
| 554 | while (blkcnt-- > 0) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 555 | status = sata_busy_wait(&port[num].ioaddr, ATA_BUSY, 500); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 556 | if (status & ATA_BUSY) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 557 | printf("ata%u failed to respond\n", 0); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 558 | return n; |
| 559 | } |
| 560 | #ifdef CONFIG_LBA48 |
| 561 | if (lba48) { |
| 562 | /* write high bits */ |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 563 | sata_outb(0, port[num].ioaddr.nsect_addr); |
| 564 | sata_outb((blknr >> 24) & 0xFF, |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 565 | port[num].ioaddr.lbal_addr); |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 566 | sata_outb((blknr >> 32) & 0xFF, |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 567 | port[num].ioaddr.lbam_addr); |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 568 | sata_outb((blknr >> 40) & 0xFF, |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 569 | port[num].ioaddr.lbah_addr); |
| 570 | } |
| 571 | #endif |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 572 | sata_outb(1, port[num].ioaddr.nsect_addr); |
| 573 | sata_outb(((blknr) >> 0) & 0xFF, |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 574 | port[num].ioaddr.lbal_addr); |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 575 | sata_outb((blknr >> 8) & 0xFF, port[num].ioaddr.lbam_addr); |
| 576 | sata_outb((blknr >> 16) & 0xFF, port[num].ioaddr.lbah_addr); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 577 | |
| 578 | #ifdef CONFIG_LBA48 |
| 579 | if (lba48) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 580 | sata_outb(ATA_LBA, port[num].ioaddr.device_addr); |
| 581 | sata_outb(ATA_CMD_READ_EXT, |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 582 | port[num].ioaddr.command_addr); |
| 583 | } else |
| 584 | #endif |
| 585 | { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 586 | sata_outb(ATA_LBA | ((blknr >> 24) & 0xF), |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 587 | port[num].ioaddr.device_addr); |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 588 | sata_outb(ATA_CMD_READ, |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 589 | port[num].ioaddr.command_addr); |
| 590 | } |
| 591 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 592 | mdelay(50); |
| 593 | /* may take up to 4 sec */ |
| 594 | status = sata_busy_wait(&port[num].ioaddr, ATA_BUSY, 4000); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 595 | |
| 596 | if ((status & (ATA_STAT_DRQ | ATA_STAT_BUSY | ATA_STAT_ERR)) |
| 597 | != ATA_STAT_DRQ) { |
| 598 | u8 err = 0; |
| 599 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 600 | printf("Error no DRQ dev %d blk %ld: sts 0x%02x\n", |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 601 | device, (ulong) blknr, status); |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 602 | err = sata_inb(port[num].ioaddr.error_addr); |
| 603 | printf("Error reg = 0x%x\n", err); |
| 604 | return n; |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 605 | } |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 606 | input_data(&port[num].ioaddr, buffer, ATA_SECTORWORDS); |
| 607 | sata_inb(port[num].ioaddr.altstatus_addr); |
| 608 | udelay(50); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 609 | |
| 610 | ++n; |
| 611 | ++blknr; |
| 612 | buffer += ATA_SECTORWORDS; |
| 613 | } |
| 614 | return n; |
| 615 | } |
| 616 | |
Tom Rini | d4a6a5b | 2012-09-29 07:52:48 -0700 | [diff] [blame] | 617 | ulong sata_write(int device, ulong blknr, lbaint_t blkcnt, const void *buff) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 618 | { |
| 619 | ulong n = 0, *buffer = (ulong *)buff; |
| 620 | unsigned char status = 0, num = 0, dev = 0, mask = 0; |
| 621 | |
| 622 | #ifdef CONFIG_LBA48 |
| 623 | unsigned char lba48 = 0; |
| 624 | |
| 625 | if (blknr & 0x0000fffff0000000) { |
| 626 | if (!sata_dev_desc[devno].lba48) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 627 | printf("Drive doesn't support 48-bit addressing\n"); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 628 | return 0; |
| 629 | } |
| 630 | /* more than 28 bits used, use 48bit mode */ |
| 631 | lba48 = 1; |
| 632 | } |
| 633 | #endif |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 634 | /* Port Number */ |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 635 | num = device / CONFIG_SYS_SATA_DEVS_PER_BUS; |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 636 | /* dev on the Port */ |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 637 | if (device >= CONFIG_SYS_SATA_DEVS_PER_BUS) |
| 638 | dev = device - CONFIG_SYS_SATA_DEVS_PER_BUS; |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 639 | else |
| 640 | dev = device; |
| 641 | |
| 642 | if (dev == 0) |
| 643 | mask = 0x01; |
| 644 | else |
| 645 | mask = 0x02; |
| 646 | |
| 647 | /* Select device */ |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 648 | dev_select(&port[num].ioaddr, dev); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 649 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 650 | status = sata_busy_wait(&port[num].ioaddr, ATA_BUSY, 500); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 651 | if (status & ATA_BUSY) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 652 | printf("ata%u failed to respond\n", port[num].port_no); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 653 | return n; |
| 654 | } |
| 655 | |
| 656 | while (blkcnt-- > 0) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 657 | status = sata_busy_wait(&port[num].ioaddr, ATA_BUSY, 500); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 658 | if (status & ATA_BUSY) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 659 | printf("ata%u failed to respond\n", |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 660 | port[num].port_no); |
| 661 | return n; |
| 662 | } |
| 663 | #ifdef CONFIG_LBA48 |
| 664 | if (lba48) { |
| 665 | /* write high bits */ |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 666 | sata_outb(0, port[num].ioaddr.nsect_addr); |
| 667 | sata_outb((blknr >> 24) & 0xFF, |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 668 | port[num].ioaddr.lbal_addr); |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 669 | sata_outb((blknr >> 32) & 0xFF, |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 670 | port[num].ioaddr.lbam_addr); |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 671 | sata_outb((blknr >> 40) & 0xFF, |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 672 | port[num].ioaddr.lbah_addr); |
| 673 | } |
| 674 | #endif |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 675 | sata_outb(1, port[num].ioaddr.nsect_addr); |
| 676 | sata_outb((blknr >> 0) & 0xFF, port[num].ioaddr.lbal_addr); |
| 677 | sata_outb((blknr >> 8) & 0xFF, port[num].ioaddr.lbam_addr); |
| 678 | sata_outb((blknr >> 16) & 0xFF, port[num].ioaddr.lbah_addr); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 679 | #ifdef CONFIG_LBA48 |
| 680 | if (lba48) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 681 | sata_outb(ATA_LBA, port[num].ioaddr.device_addr); |
| 682 | sata_outb(ATA_CMD_WRITE_EXT, |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 683 | port[num].ioaddr.command_addr); |
| 684 | } else |
| 685 | #endif |
| 686 | { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 687 | sata_outb(ATA_LBA | ((blknr >> 24) & 0xF), |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 688 | port[num].ioaddr.device_addr); |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 689 | sata_outb(ATA_CMD_WRITE, |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 690 | port[num].ioaddr.command_addr); |
| 691 | } |
| 692 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 693 | mdelay(50); |
| 694 | /* may take up to 4 sec */ |
| 695 | status = sata_busy_wait(&port[num].ioaddr, ATA_BUSY, 4000); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 696 | if ((status & (ATA_STAT_DRQ | ATA_STAT_BUSY | ATA_STAT_ERR)) |
| 697 | != ATA_STAT_DRQ) { |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 698 | printf("Error no DRQ dev %d blk %ld: sts 0x%02x\n", |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 699 | device, (ulong) blknr, status); |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 700 | return n; |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 701 | } |
| 702 | |
Tom Rini | 953f90f | 2012-09-29 07:35:12 -0700 | [diff] [blame] | 703 | output_data(&port[num].ioaddr, buffer, ATA_SECTORWORDS); |
| 704 | sata_inb(port[num].ioaddr.altstatus_addr); |
| 705 | udelay(50); |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 706 | |
| 707 | ++n; |
| 708 | ++blknr; |
| 709 | buffer += ATA_SECTORWORDS; |
| 710 | } |
| 711 | return n; |
| 712 | } |
| 713 | |
Dave Liu | a566ebd | 2008-03-26 22:50:45 +0800 | [diff] [blame] | 714 | int scan_sata(int dev) |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 715 | { |
Dave Liu | a566ebd | 2008-03-26 22:50:45 +0800 | [diff] [blame] | 716 | return 0; |
Dave Liu | 8b3eaa1 | 2008-03-26 22:47:06 +0800 | [diff] [blame] | 717 | } |