|
|
|
@ -78,13 +78,15 @@ static int waiting_for_cmd_completed(volatile u8 *offset, |
|
|
|
|
|
|
|
|
|
static int ahci_host_init(struct ahci_probe_ent *probe_ent) |
|
|
|
|
{ |
|
|
|
|
#ifndef CONFIG_SCSI_AHCI_PLAT |
|
|
|
|
pci_dev_t pdev = probe_ent->dev; |
|
|
|
|
u16 tmp16; |
|
|
|
|
unsigned short vendor; |
|
|
|
|
#endif |
|
|
|
|
volatile u8 *mmio = (volatile u8 *)probe_ent->mmio_base; |
|
|
|
|
u32 tmp, cap_save; |
|
|
|
|
u16 tmp16; |
|
|
|
|
int i, j; |
|
|
|
|
volatile u8 *port_mmio; |
|
|
|
|
unsigned short vendor; |
|
|
|
|
|
|
|
|
|
cap_save = readl(mmio + HOST_CAP); |
|
|
|
|
cap_save &= ((1 << 28) | (1 << 17)); |
|
|
|
@ -110,6 +112,7 @@ static int ahci_host_init(struct ahci_probe_ent *probe_ent) |
|
|
|
|
writel(cap_save, mmio + HOST_CAP); |
|
|
|
|
writel_with_flush(0xf, mmio + HOST_PORTS_IMPL); |
|
|
|
|
|
|
|
|
|
#ifndef CONFIG_SCSI_AHCI_PLAT |
|
|
|
|
pci_read_config_word(pdev, PCI_VENDOR_ID, &vendor); |
|
|
|
|
|
|
|
|
|
if (vendor == PCI_VENDOR_ID_INTEL) { |
|
|
|
@ -118,7 +121,7 @@ static int ahci_host_init(struct ahci_probe_ent *probe_ent) |
|
|
|
|
tmp16 |= 0xf; |
|
|
|
|
pci_write_config_word(pdev, 0x92, tmp16); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
#endif |
|
|
|
|
probe_ent->cap = readl(mmio + HOST_CAP); |
|
|
|
|
probe_ent->port_map = readl(mmio + HOST_PORTS_IMPL); |
|
|
|
|
probe_ent->n_ports = (probe_ent->cap & 0x1f) + 1; |
|
|
|
@ -183,22 +186,24 @@ static int ahci_host_init(struct ahci_probe_ent *probe_ent) |
|
|
|
|
writel(tmp | HOST_IRQ_EN, mmio + HOST_CTL); |
|
|
|
|
tmp = readl(mmio + HOST_CTL); |
|
|
|
|
debug("HOST_CTL 0x%x\n", tmp); |
|
|
|
|
|
|
|
|
|
#ifndef CONFIG_SCSI_AHCI_PLAT |
|
|
|
|
pci_read_config_word(pdev, PCI_COMMAND, &tmp16); |
|
|
|
|
tmp |= PCI_COMMAND_MASTER; |
|
|
|
|
pci_write_config_word(pdev, PCI_COMMAND, tmp16); |
|
|
|
|
|
|
|
|
|
#endif |
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static void ahci_print_info(struct ahci_probe_ent *probe_ent) |
|
|
|
|
{ |
|
|
|
|
#ifndef CONFIG_SCSI_AHCI_PLAT |
|
|
|
|
pci_dev_t pdev = probe_ent->dev; |
|
|
|
|
u16 cc; |
|
|
|
|
#endif |
|
|
|
|
volatile u8 *mmio = (volatile u8 *)probe_ent->mmio_base; |
|
|
|
|
u32 vers, cap, impl, speed; |
|
|
|
|
const char *speed_s; |
|
|
|
|
u16 cc; |
|
|
|
|
const char *scc_s; |
|
|
|
|
|
|
|
|
|
vers = readl(mmio + HOST_VERSION); |
|
|
|
@ -213,6 +218,9 @@ static void ahci_print_info(struct ahci_probe_ent *probe_ent) |
|
|
|
|
else |
|
|
|
|
speed_s = "?"; |
|
|
|
|
|
|
|
|
|
#ifdef CONFIG_SCSI_AHCI_PLAT |
|
|
|
|
scc_s = "SATA"; |
|
|
|
|
#else |
|
|
|
|
pci_read_config_word(pdev, 0x0a, &cc); |
|
|
|
|
if (cc == 0x0101) |
|
|
|
|
scc_s = "IDE"; |
|
|
|
@ -222,7 +230,7 @@ static void ahci_print_info(struct ahci_probe_ent *probe_ent) |
|
|
|
|
scc_s = "RAID"; |
|
|
|
|
else |
|
|
|
|
scc_s = "unknown"; |
|
|
|
|
|
|
|
|
|
#endif |
|
|
|
|
printf("AHCI %02x%02x.%02x%02x " |
|
|
|
|
"%u slots %u ports %s Gbps 0x%x impl %s mode\n", |
|
|
|
|
(vers >> 24) & 0xff, |
|
|
|
@ -249,6 +257,7 @@ static void ahci_print_info(struct ahci_probe_ent *probe_ent) |
|
|
|
|
cap & (1 << 13) ? "part " : ""); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
#ifndef CONFIG_SCSI_AHCI_PLAT |
|
|
|
|
static int ahci_init_one(pci_dev_t pdev) |
|
|
|
|
{ |
|
|
|
|
u16 vendor; |
|
|
|
@ -291,7 +300,7 @@ static int ahci_init_one(pci_dev_t pdev) |
|
|
|
|
err_out: |
|
|
|
|
return rc; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
#define MAX_DATA_BYTE_COUNT (4*1024*1024) |
|
|
|
|
|
|
|
|
@ -667,7 +676,9 @@ void scsi_low_level_init(int busdevfunc) |
|
|
|
|
int i; |
|
|
|
|
u32 linkmap; |
|
|
|
|
|
|
|
|
|
#ifndef CONFIG_SCSI_AHCI_PLAT |
|
|
|
|
ahci_init_one(busdevfunc); |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
linkmap = probe_ent->link_port_map; |
|
|
|
|
|
|
|
|
@ -682,6 +693,49 @@ void scsi_low_level_init(int busdevfunc) |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
#ifdef CONFIG_SCSI_AHCI_PLAT |
|
|
|
|
int ahci_init(u32 base) |
|
|
|
|
{ |
|
|
|
|
int i, rc = 0; |
|
|
|
|
u32 linkmap; |
|
|
|
|
|
|
|
|
|
memset(ataid, 0, sizeof(ataid)); |
|
|
|
|
|
|
|
|
|
probe_ent = malloc(sizeof(struct ahci_probe_ent)); |
|
|
|
|
memset(probe_ent, 0, sizeof(struct ahci_probe_ent)); |
|
|
|
|
|
|
|
|
|
probe_ent->host_flags = ATA_FLAG_SATA |
|
|
|
|
| ATA_FLAG_NO_LEGACY |
|
|
|
|
| ATA_FLAG_MMIO |
|
|
|
|
| ATA_FLAG_PIO_DMA |
|
|
|
|
| ATA_FLAG_NO_ATAPI; |
|
|
|
|
probe_ent->pio_mask = 0x1f; |
|
|
|
|
probe_ent->udma_mask = 0x7f; /*Fixme,assume to support UDMA6 */ |
|
|
|
|
|
|
|
|
|
probe_ent->mmio_base = base; |
|
|
|
|
|
|
|
|
|
/* initialize adapter */ |
|
|
|
|
rc = ahci_host_init(probe_ent); |
|
|
|
|
if (rc) |
|
|
|
|
goto err_out; |
|
|
|
|
|
|
|
|
|
ahci_print_info(probe_ent); |
|
|
|
|
|
|
|
|
|
linkmap = probe_ent->link_port_map; |
|
|
|
|
|
|
|
|
|
for (i = 0; i < CONFIG_SYS_SCSI_MAX_SCSI_ID; i++) { |
|
|
|
|
if (((linkmap >> i) & 0x01)) { |
|
|
|
|
if (ahci_port_start((u8) i)) { |
|
|
|
|
printf("Can not start port %d\n", i); |
|
|
|
|
continue; |
|
|
|
|
} |
|
|
|
|
ahci_set_feature((u8) i); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
err_out: |
|
|
|
|
return rc; |
|
|
|
|
} |
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
|
void scsi_bus_reset(void) |
|
|
|
|
{ |
|
|
|
|