ahci: preserve PORTS_IMPL over host resets
PATCH 1/2 ahci: preserve PORTS_IMPL over host resets
Instead of writing 0xf blindly, preserve the content of write-once PORTS_IMPL register over host resets.
This patch is taken from Jeff Garzik's AHCI init update patch.
--- drivers/ata/ahci.c | 11 +++++++++-- 1 files changed, 9 insertions(+), 2 deletions(-)
drivers/ata/ahci.c +9 -2
@@ -563,11 +563,12 @@ static int ahci_deinit_port(void __iomemstatic int ahci_reset_controller (void __iomem *mmio,struct pci_dev *pdev) { -u32 cap_save, tmp; +u32 cap_save, impl_save, tmp; cap_save =readl (mmio +HOST_CAP ); cap_save &= ( (1 <<28 ) | (1 <<17 ) ); cap_save |= (1 <<27 ); + impl_save =readl (mmio +HOST_PORTS_IMPL );/* global controller reset */ tmp =readl (mmio +HOST_CTL );
@@ -588,10 +589,16 @@ static int ahci_reset_controller(void __return -EIO ; } +/* turn on AHCI mode */ writel (HOST_AHCI_EN , mmio +HOST_CTL ); (void )readl (mmio +HOST_CTL );/* flush */ + +/* These write-once registers are normally cleared on reset. +* Restore BIOS values... which we HOPE were present before +* reset. +*/ writel (cap_save, mmio +HOST_CAP ); -writel (0xf , mmio +HOST_PORTS_IMPL ); +writel (impl_save, mmio +HOST_PORTS_IMPL ); (void )readl (mmio +HOST_PORTS_IMPL );/* flush */ if (pdev->vendor ==PCI_VENDOR_ID_INTEL ) {
Signature · 1 line
1.4.2.1
PATCH 2/2 ahci: honor PORTS_IMPL on ICH8s
Some ICH8s use non-linear port mapping. ahci driver didn't use to honor PORTS_IMPL and this made ports after hole nonfunctional. This patch implements port mapping table and use it to handle non-linear port mapping.
As it's unknown whether other AHCIs implement PORTS_IMPL register properly, new board id board_ahci_pi is added and selectively applied to ICH8s. All other AHCIs continue to use linear mapping regardless of PORTS_IMPL value.
---
Jeff, this version adds pp->hw_idx to access port index and honors PORTS_IMPL only on ICH8s. Tested on ICH7 and ICH8.
Thanks.
drivers/ata/ahci.c | 142 ++++++++++++++++++++++++++++++++++------------------ 1 files changed, 93 insertions(+), 49 deletions(-)
drivers/ata/ahci.c +93 -49
@@ -53,6 +53,7 @@ #define DRV_VERSION "2.0"enum {AHCI_PCI_BAR =5 , +AHCI_MAX_PORTS =32 ,AHCI_MAX_SG =168 ,/* hardware max is 64K */ AHCI_DMA_BOUNDARY =0xffffffff ,AHCI_USE_CLUSTERING =0 ,
@@ -77,7 +78,8 @@ enum {RX_FIS_UNK =0x60 ,/* offset of Unknown FIS data */ board_ahci =0 , - board_ahci_vt8251 =1 , + board_ahci_pi =1 , + board_ahci_vt8251 =2 ,/* global controller registers */ HOST_CAP = 0x00, /* host capabilities */
@@ -166,6 +168,7 @@ enum {AHCI_FLAG_MSI = (1 <<0 ),/* ap->flags bits */ +AHCI_FLAG_HONOR_PI = (1 <<23 ),/* honor PORTS_IMPL */ AHCI_FLAG_RESET_NEEDS_CLO = (1 <<24 ), AHCI_FLAG_NO_NCQ = (1 << 25), };
@@ -189,9 +192,12 @@ struct ahci_host_priv {unsigned long flags;u32 cap;/* cache of HOST_CAP register */ u32 port_map;/* cache of HOST_PORTS_IMPL reg */ +u8 port_tbl[AHCI_MAX_PORTS ]; };struct ahci_port_priv { +int hw_idx; +void __iomem *mmio;struct ahci_cmd_hdr *cmd_slot;dma_addr_t cmd_slot_dma;void *cmd_tbl;
@@ -284,6 +290,16 @@ static const struct ata_port_info ahci_p .udma_mask = 0x7f, /* udma0-6 ; FIXME */ .port_ops = &ahci_ops, }, +/* board_ahci_pi */ + { + .sht = &ahci_sht, + .flags = ATA_FLAG_SATA | ATA_FLAG_NO_LEGACY | + ATA_FLAG_MMIO | ATA_FLAG_PIO_DMA | + ATA_FLAG_SKIP_D2H_BSY | AHCI_FLAG_HONOR_PI, + .pio_mask = 0x1f, /* pio0-4 */ + .udma_mask = 0x7f, /* udma0-6 ; FIXME */ + .port_ops = &ahci_ops, + },/* board_ahci_vt8251 */ { .sht = &ahci_sht,
@@ -309,11 +325,11 @@ static const struct pci_device_id ahci_p { PCI_VDEVICE(INTEL, 0x2682), board_ahci }, /* ESB2 */ { PCI_VDEVICE(INTEL, 0x2683), board_ahci }, /* ESB2 */ { PCI_VDEVICE(INTEL, 0x27c6), board_ahci }, /* ICH7-M DH */ - { PCI_VDEVICE(INTEL, 0x2821), board_ahci }, /* ICH8 */ - { PCI_VDEVICE(INTEL, 0x2822), board_ahci }, /* ICH8 */ - { PCI_VDEVICE(INTEL, 0x2824), board_ahci }, /* ICH8 */ - { PCI_VDEVICE(INTEL, 0x2829), board_ahci }, /* ICH8M */ - { PCI_VDEVICE(INTEL, 0x282a), board_ahci }, /* ICH8M */ + { PCI_VDEVICE(INTEL, 0x2821), board_ahci_pi }, /* ICH8 */ + { PCI_VDEVICE(INTEL, 0x2822), board_ahci_pi }, /* ICH8 */ + { PCI_VDEVICE(INTEL, 0x2824), board_ahci_pi }, /* ICH8 */ + { PCI_VDEVICE(INTEL, 0x2829), board_ahci_pi }, /* ICH8M */ + { PCI_VDEVICE(INTEL, 0x282a), board_ahci_pi }, /* ICH8M *//* JMicron */ { PCI_VDEVICE(JMICRON, 0x2360), board_ahci }, /* JMicron JMB360 */
@@ -614,22 +630,18 @@ static int ahci_reset_controller(void __ }static void ahci_init_controller (void __iomem *mmio,struct pci_dev *pdev, -int n_ports,u32 cap) +int n_ports,struct ahci_host_priv *hpriv) {int i, rc;u32 tmp;for (i =0 ; i < n_ports; i++) { -void __iomem *port_mmio =ahci_port_base (mmio, i); +int hw_idx = hpriv->port_tbl[i]; +void __iomem *port_mmio =ahci_port_base (mmio, hw_idx);const char *emsg =NULL ; -#if 0 /* BIOSen initialize this incorrectly */ -if (!(hpriv->port_map & (1 << i))) -continue ; -#endif -/* make sure port is not active */ - rc =ahci_deinit_port (port_mmio, cap, &emsg); + rc =ahci_deinit_port (port_mmio, hpriv->cap, &emsg);if (rc)dev_printk (KERN_WARNING , &pdev->dev,"%s (%d)\n" , emsg, rc);
@@ -657,7 +669,8 @@ #endifstatic unsigned int ahci_dev_classify (struct ata_port *ap) { -void __iomem *port_mmio = (void __iomem *) ap->ioaddr.cmd_addr; +struct ahci_port_priv *pp = ap->private_data; +void __iomem *port_mmio = pp->mmio;struct ata_taskfile tf;u32 tmp;
@@ -685,8 +698,9 @@ static void ahci_fill_cmd_slot(struct ahstatic int ahci_clo (struct ata_port *ap) { -void __iomem *port_mmio = (void __iomem *) ap->ioaddr.cmd_addr;struct ahci_host_priv *hpriv = ap->host->private_data; +struct ahci_port_priv *pp = ap->private_data; +void __iomem *port_mmio = pp->mmio;u32 tmp;if (!(hpriv->cap &HOST_CAP_CLO ))
@@ -718,8 +732,7 @@ static int ahci_prereset(struct ata_portstatic int ahci_softreset (struct ata_port *ap,unsigned int *class) {struct ahci_port_priv *pp = ap->private_data; -void __iomem *mmio = ap->host->mmio_base; -void __iomem *port_mmio =ahci_port_base (mmio, ap->port_no); +void __iomem *port_mmio = pp->mmio;const u32 cmd_fis_len =5 ;/* five dwords */ const char *reason =NULL ;struct ata_taskfile tf;
@@ -826,9 +839,8 @@ static int ahci_hardreset(struct ata_por {struct ahci_port_priv *pp = ap->private_data;u8 *d2h_fis = pp->rx_fis +RX_FIS_D2H_REG ; +void __iomem *port_mmio = pp->mmio;struct ata_taskfile tf; -void __iomem *mmio = ap->host->mmio_base; -void __iomem *port_mmio =ahci_port_base (mmio, ap->port_no);int rc;DPRINTK ("ENTER\n" );
@@ -855,7 +867,8 @@ static int ahci_hardreset(struct ata_porstatic void ahci_postreset (struct ata_port *ap,unsigned int *class) { -void __iomem *port_mmio = (void __iomem *) ap->ioaddr.cmd_addr; +struct ahci_port_priv *pp = ap->private_data; +void __iomem *port_mmio = pp->mmio;u32 new_tmp, tmp;ata_std_postreset (ap, class);
@@ -1016,9 +1029,9 @@ static void ahci_error_intr(struct ata_pstatic void ahci_host_intr (struct ata_port *ap) { -void __iomem *mmio = ap->host->mmio_base; -void __iomem *port_mmio =ahci_port_base (mmio, ap->port_no); +struct ahci_port_priv *pp = ap->private_data;struct ata_eh_info *ehi = &ap->eh_info; +void __iomem *port_mmio = pp->mmio;u32 status, qc_active;int rc;
@@ -1088,12 +1101,12 @@ static irqreturn_t ahci_interrupt(int irspin_lock (&host->lock);for (i =0 ; i < host->n_ports; i++) { -struct ata_port *ap; +struct ata_port *ap = host->ports[i]; +struct ahci_port_priv *pp = ap->private_data; -if (!(irq_stat & (1 << i))) +if (!(irq_stat & (1 << pp->hw_idx)))continue ; - ap = host->ports[i];if (ap) {ahci_host_intr (ap);VPRINTK ("port %u\n" , i);
@@ -1104,7 +1117,7 @@ static irqreturn_t ahci_interrupt(int ir "interrupt on disabled port %u\n", i); } - irq_ack |= (1 << i); + irq_ack |= (1 << pp->hw_idx); }if (irq_ack) {
@@ -1122,7 +1135,8 @@ static irqreturn_t ahci_interrupt(int irstatic unsigned int ahci_qc_issue (struct ata_queued_cmd *qc) {struct ata_port *ap = qc->ap; -void __iomem *port_mmio = (void __iomem *) ap->ioaddr.cmd_addr; +struct ahci_port_priv *pp = ap->private_data; +void __iomem *port_mmio = pp->mmio;if (qc->tf.protocol ==ATA_PROT_NCQ )writel (1 << qc->tag, port_mmio +PORT_SCR_ACT );
@@ -1134,8 +1148,8 @@ static unsigned int ahci_qc_issue(structstatic void ahci_freeze (struct ata_port *ap) { -void __iomem *mmio = ap->host->mmio_base; -void __iomem *port_mmio =ahci_port_base (mmio, ap->port_no); +struct ahci_port_priv *pp = ap->private_data; +void __iomem *port_mmio = pp->mmio;/* turn IRQ off */ writel (0 , port_mmio +PORT_IRQ_MASK );
@@ -1143,14 +1157,15 @@ static void ahci_freeze(struct ata_portstatic void ahci_thaw (struct ata_port *ap) { +struct ahci_port_priv *pp = ap->private_data;void __iomem *mmio = ap->host->mmio_base; -void __iomem *port_mmio =ahci_port_base (mmio, ap->port_no); +void __iomem *port_mmio = pp->mmio;u32 tmp;/* clear IRQ */ tmp =readl (port_mmio +PORT_IRQ_STAT );writel (tmp, port_mmio +PORT_IRQ_STAT ); -writel (1 << ap->id, mmio +HOST_IRQ_STAT ); +writel (1 << pp->hw_idx, mmio +HOST_IRQ_STAT );/* turn IRQ back on */ writel (DEF_PORT_IRQ , port_mmio +PORT_IRQ_MASK );
@@ -1158,8 +1173,8 @@ static void ahci_thaw(struct ata_port *astatic void ahci_error_handler (struct ata_port *ap) { -void __iomem *mmio = ap->host->mmio_base; -void __iomem *port_mmio =ahci_port_base (mmio, ap->port_no); +struct ahci_port_priv *pp = ap->private_data; +void __iomem *port_mmio = pp->mmio;if (!(ap->pflags &ATA_PFLAG_FROZEN )) {/* restart engine */
@@ -1175,8 +1190,8 @@ static void ahci_error_handler(struct atstatic void ahci_post_internal_cmd (struct ata_queued_cmd *qc) {struct ata_port *ap = qc->ap; -void __iomem *mmio = ap->host->mmio_base; -void __iomem *port_mmio =ahci_port_base (mmio, ap->port_no); +struct ahci_port_priv *pp = ap->private_data; +void __iomem *port_mmio = pp->mmio;if (qc->flags &ATA_QCFLAG_FAILED ) qc->err_mask |=AC_ERR_OTHER ;
@@ -1192,8 +1207,7 @@ static int ahci_port_suspend(struct ata_ {struct ahci_host_priv *hpriv = ap->host->private_data;struct ahci_port_priv *pp = ap->private_data; -void __iomem *mmio = ap->host->mmio_base; -void __iomem *port_mmio =ahci_port_base (mmio, ap->port_no); +void __iomem *port_mmio = pp->mmio;const char *emsg =NULL ;int rc;
@@ -1209,10 +1223,9 @@ static int ahci_port_suspend(struct ata_static int ahci_port_resume (struct ata_port *ap) { -struct ahci_port_priv *pp = ap->private_data;struct ahci_host_priv *hpriv = ap->host->private_data; -void __iomem *mmio = ap->host->mmio_base; -void __iomem *port_mmio =ahci_port_base (mmio, ap->port_no); +struct ahci_port_priv *pp = ap->private_data; +void __iomem *port_mmio = pp->mmio;ahci_init_port (port_mmio, hpriv->cap, pp->cmd_slot_dma, pp->rx_fis_dma);
@@ -1253,7 +1266,7 @@ static int ahci_pci_device_resume(structif (rc)return rc; -ahci_init_controller (mmio, pdev, host->n_ports, hpriv->cap); +ahci_init_controller (mmio, pdev, host->n_ports, hpriv); }ata_host_resume (host);
@@ -1266,8 +1279,9 @@ static int ahci_port_start(struct ata_postruct device *dev = ap->host->dev;struct ahci_host_priv *hpriv = ap->host->private_data;struct ahci_port_priv *pp; +int port_hw_idx = hpriv->port_tbl[ap->port_no];void __iomem *mmio = ap->host->mmio_base; -void __iomem *port_mmio =ahci_port_base (mmio, ap->port_no); +void __iomem *port_mmio =ahci_port_base (mmio, port_hw_idx);void *mem;dma_addr_t mem_dma;int rc;
@@ -1283,6 +1297,9 @@ static int ahci_port_start(struct ata_poreturn rc; } + pp->hw_idx = port_hw_idx; + pp->mmio = port_mmio; + mem =dma_alloc_coherent (dev,AHCI_PORT_PRIV_DMA_SZ , &mem_dma,GFP_KERNEL );if (!mem) {ata_pad_free (ap, dev);
@@ -1330,8 +1347,7 @@ static void ahci_port_stop(struct ata_postruct device *dev = ap->host->dev;struct ahci_host_priv *hpriv = ap->host->private_data;struct ahci_port_priv *pp = ap->private_data; -void __iomem *mmio = ap->host->mmio_base; -void __iomem *port_mmio =ahci_port_base (mmio, ap->port_no); +void __iomem *port_mmio = pp->mmio;const char *emsg =NULL ;int rc;
@@ -1365,7 +1381,7 @@ static int ahci_host_init(struct ata_prostruct ahci_host_priv *hpriv = probe_ent->private_data;struct pci_dev *pdev =to_pci_dev (probe_ent->dev);void __iomem *mmio = probe_ent->mmio_base; -unsigned int i, using_dac; +unsigned int i, n_ports, using_dac;int rc; rc =ahci_reset_controller (mmio, pdev);
@@ -1374,7 +1390,34 @@ static int ahci_host_init(struct ata_pro hpriv->cap =readl (mmio +HOST_CAP ); hpriv->port_map =readl (mmio +HOST_PORTS_IMPL ); - probe_ent->n_ports = (hpriv->cap &0x1f ) +1 ; + +/* determine number of ports and port table */ + n_ports =0 ; + +if (probe_ent->port_flags &AHCI_FLAG_HONOR_PI ) { +for (i =0 ; i <AHCI_MAX_PORTS ; i++) +if (hpriv->port_map & (1 << i)) + hpriv->port_tbl[n_ports++] = i; + + i = (hpriv->cap &0x1f ) +1 ; +if (n_ports > i) { +dev_printk (KERN_WARNING , &pdev->dev, +"n_ports in PI (%d) > CAP.NP (%d), " +"using %d\n" , n_ports, i, i); + n_ports = i; + } + }else { + n_ports = (hpriv->cap &0x1f ) +1 ; +for (i =0 ; i < n_ports; i++) + hpriv->port_tbl[i] = i; + } + +if (n_ports ==0 ) { +dev_printk (KERN_ERR , &pdev->dev,"0 port implemented\n" ); +return -EINVAL ; + } + + probe_ent->n_ports = n_ports;VPRINTK ("cap 0x%x port_map 0x%x n_ports %d\n" , hpriv->cap, hpriv->port_map, probe_ent->n_ports);
@@ -1407,9 +1450,10 @@ static int ahci_host_init(struct ata_pro }for (i =0 ; i < probe_ent->n_ports; i++) -ahci_setup_port (&probe_ent->port[i], (unsigned long ) mmio, i); +ahci_setup_port (&probe_ent->port[i], (unsigned long ) mmio, + hpriv->port_tbl[i]); -ahci_init_controller (mmio, pdev, probe_ent->n_ports, hpriv->cap); +ahci_init_controller (mmio, pdev, probe_ent->n_ports, hpriv);pci_set_master (pdev);
Signature · 1 line
1.4.2.1
Re: [PATCH 2/2] [PATCH] ahci: honor PORTS_IMPL on ICH8s
Quoted 5 lines · Tejun Heo
Some ICH8s use non-linear port mapping. ahci driver didn't use to honor
PORTS_IMPLand this made ports after hole nonfunctional. This patch implements port mapping table and use it to handle non-linear port mapping.
Quoted 7 lines
As it's unknown whether other AHCIs implement
PORTS_IMPLregister properly, new board idboard_ahci_piis added and selectively applied to ICH8s. All other AHCIs continue to use linear mapping regardless ofPORTS_IMPLvalue.Signed-off-by Tejun Heo <[email protected]>Cc Robin H. Johnson <[email protected]>
Works 100% here, thanks Tejun.
Signature · 3 lines
Robin Hugh Johnson E-Mail : [email protected] GnuPG FP : 11AC BA4F 4778 E3F6 E4ED F38E B27B 944E 3488 4E85
Re: [PATCH 2/2] [PATCH] ahci: honor PORTS_IMPL on ICH8s
In reply to Tejun HeoQuoted 5 lines · Tejun Heo
Some ICH8s use non-linear port mapping. ahci driver didn't use to honor
PORTS_IMPLand this made ports after hole nonfunctional. This patch implements port mapping table and use it to handle non-linear port mapping.
Quoted 7 lines
As it's unknown whether other AHCIs implement
PORTS_IMPLregister properly, new board idboard_ahci_piis added and selectively applied to ICH8s. All other AHCIs continue to use linear mapping regardless ofPORTS_IMPLvalue.Signed-off-by Tejun Heo <[email protected]>Cc Robin H. Johnson <[email protected]>
I still disagree with the port mapping table. I want to preserve the direct index properties, and would rather see code fixed up such that assumptions where n_ports implies all lower ports are fixed.
Jeff
Re: [PATCH 2/2] [PATCH] ahci: honor PORTS_IMPL on ICH8s
Quoted 11 lines · Jeff Garzik
Quoted 10 lines · Tejun Heo
Some ICH8s use non-linear port mapping. ahci driver didn't use to honor
PORTS_IMPLand this made ports after hole nonfunctional. This patch implements port mapping table and use it to handle non-linear port mapping.As it's unknown whether other AHCIs implement
PORTS_IMPLregister properly, new board idboard_ahci_piis added and selectively applied to ICH8s. All other AHCIs continue to use linear mapping regardless ofPORTS_IMPLvalue.
Quoted 4 lines
Quoted 2 lines
Signed-off-by Tejun Heo <[email protected]>Cc Robin H. Johnson <[email protected]>I still disagree with the port mapping table. I want to preserve the direct index properties, and would rather see code fixed up such that assumptions where
n_portsimplies all lower ports are fixed.
I understand your concern but if you think about it, if you have non-linear port mapping and wanna keep direct index property, something's gotta give. There are three places to deal with the mismatch - in LLD, libata or userland.
* LLD: this is what the current patch does and my favorite. It's isolated, not too complex and easy to spot when something goes wrong.
* libata: we can implement non-linear mapping facility in core layer but I'm doubtful it's worth the effort and complexity. Not many LLDs use non-linear mapping and ones that do are likely to have peculiar properties.
* userland: this is how we currently handle busy legacy ports. Mark them dummy and let the userland see that some ports aren't implemented.
This makes sense for legacy ports because they have fixed resources
and port numbers are bound to those resources. However, for ahci's case, I think it will cause confusion as the port numbers don't have any specific meaning and the BIOS and other OSes show them as contiguous ports.
So, my place of choice is in LLD. What do you think?
Thanks.
Signature · 1 line
tejun
Quoted 7 lines · Tejun Heo
Instead of writing
0xfblindly, preserve the content of write-oncePORTS_IMPLregister over host resets.This patch is taken from Jeff Garzik's AHCI init update patch.
Signed-off-by Tejun Heo <[email protected]>Cc Jeff Garzik <[email protected]>
One reason why I didn't go ahead and apply this is for uninitalized-by-BIOS cases that are the reason I originally hardcoded a 0xf value into the register.
This patch is OK, iff we also include a test to see if impl_save==0 prior to global reset. If that is the case, we should hardcode 0xf or (1<<n_ports)-1
Jeff
Quoted 4 lines · Jeff Garzik
Quoted 3 lines · Tejun Heo
Instead of writing
0xfblindly, preserve the content of write-oncePORTS_IMPLregister over host resets.
Quoted 8 lines
Quoted 4 lines
This patch is taken from Jeff Garzik's AHCI init update patch.
Signed-off-by Tejun Heo <[email protected]>Cc Jeff Garzik <[email protected]>One reason why I didn't go ahead and apply this is for uninitalized-by-BIOS cases that are the reason I originally hardcoded a
0xfvalue into the register.This patch is OK, iff we also include a test to see if impl_save==0 prior to global reset. If that is the case, we should hardcode
0xfor (1<<n_ports)-1
Will do.
Signature · 1 line
tejun