Commit c354e811 authored by Bjorn Helgaas's avatar Bjorn Helgaas

Merge branch 'pci/host-designware' into next

* pci/host-designware:
  PCI: designware: Use typical "for" loop idiom
  PCI: designware: Remove redundant call to pci_write_config_word()
  PCI: designware: Fix crash in dw_msi_teardown_irq()
parents 330ebfe3 0b8cfb6a
...@@ -209,6 +209,23 @@ static int find_valid_pos0(struct pcie_port *pp, int msgvec, int pos, int *pos0) ...@@ -209,6 +209,23 @@ static int find_valid_pos0(struct pcie_port *pp, int msgvec, int pos, int *pos0)
return 0; return 0;
} }
static void clear_irq_range(struct pcie_port *pp, unsigned int irq_base,
unsigned int nvec, unsigned int pos)
{
unsigned int i, res, bit, val;
for (i = 0; i < nvec; i++) {
irq_set_msi_desc_off(irq_base, i, NULL);
clear_bit(pos + i, pp->msi_irq_in_use);
/* Disable corresponding interrupt on MSI interrupt controller */
res = ((pos + i) / 32) * 12;
bit = (pos + i) % 32;
dw_pcie_rd_own_conf(pp, PCIE_MSI_INTR0_ENABLE + res, 4, &val);
val &= ~(1 << bit);
dw_pcie_wr_own_conf(pp, PCIE_MSI_INTR0_ENABLE + res, 4, val);
}
}
static int assign_irq(int no_irqs, struct msi_desc *desc, int *pos) static int assign_irq(int no_irqs, struct msi_desc *desc, int *pos)
{ {
int res, bit, irq, pos0, pos1, i; int res, bit, irq, pos0, pos1, i;
...@@ -242,18 +259,25 @@ static int assign_irq(int no_irqs, struct msi_desc *desc, int *pos) ...@@ -242,18 +259,25 @@ static int assign_irq(int no_irqs, struct msi_desc *desc, int *pos)
if (!irq) if (!irq)
goto no_valid_irq; goto no_valid_irq;
i = 0; /*
while (i < no_irqs) { * irq_create_mapping (called from dw_pcie_host_init) pre-allocates
* descs so there is no need to allocate descs here. We can therefore
* assume that if irq_find_mapping above returns non-zero, then the
* descs are also successfully allocated.
*/
for (i = 0; i < no_irqs; i++) {
if (irq_set_msi_desc_off(irq, i, desc) != 0) {
clear_irq_range(pp, irq, i, pos0);
goto no_valid_irq;
}
set_bit(pos0 + i, pp->msi_irq_in_use); set_bit(pos0 + i, pp->msi_irq_in_use);
irq_alloc_descs((irq + i), (irq + i), 1, 0);
irq_set_msi_desc(irq + i, desc);
/*Enable corresponding interrupt in MSI interrupt controller */ /*Enable corresponding interrupt in MSI interrupt controller */
res = ((pos0 + i) / 32) * 12; res = ((pos0 + i) / 32) * 12;
bit = (pos0 + i) % 32; bit = (pos0 + i) % 32;
dw_pcie_rd_own_conf(pp, PCIE_MSI_INTR0_ENABLE + res, 4, &val); dw_pcie_rd_own_conf(pp, PCIE_MSI_INTR0_ENABLE + res, 4, &val);
val |= 1 << bit; val |= 1 << bit;
dw_pcie_wr_own_conf(pp, PCIE_MSI_INTR0_ENABLE + res, 4, val); dw_pcie_wr_own_conf(pp, PCIE_MSI_INTR0_ENABLE + res, 4, val);
i++;
} }
*pos = pos0; *pos = pos0;
...@@ -266,7 +290,7 @@ static int assign_irq(int no_irqs, struct msi_desc *desc, int *pos) ...@@ -266,7 +290,7 @@ static int assign_irq(int no_irqs, struct msi_desc *desc, int *pos)
static void clear_irq(unsigned int irq) static void clear_irq(unsigned int irq)
{ {
int res, bit, val, pos; unsigned int pos, nvec;
struct irq_desc *desc; struct irq_desc *desc;
struct msi_desc *msi; struct msi_desc *msi;
struct pcie_port *pp; struct pcie_port *pp;
...@@ -281,18 +305,15 @@ static void clear_irq(unsigned int irq) ...@@ -281,18 +305,15 @@ static void clear_irq(unsigned int irq)
return; return;
} }
/* undo what was done in assign_irq */
pos = data->hwirq; pos = data->hwirq;
nvec = 1 << msi->msi_attrib.multiple;
irq_free_desc(irq); clear_irq_range(pp, irq, nvec, pos);
clear_bit(pos, pp->msi_irq_in_use); /* all irqs cleared; reset attributes */
msi->irq = 0;
/* Disable corresponding interrupt on MSI interrupt controller */ msi->msi_attrib.multiple = 0;
res = (pos / 32) * 12;
bit = pos % 32;
dw_pcie_rd_own_conf(pp, PCIE_MSI_INTR0_ENABLE + res, 4, &val);
val &= ~(1 << bit);
dw_pcie_wr_own_conf(pp, PCIE_MSI_INTR0_ENABLE + res, 4, val);
} }
static int dw_msi_setup_irq(struct msi_chip *chip, struct pci_dev *pdev, static int dw_msi_setup_irq(struct msi_chip *chip, struct pci_dev *pdev,
...@@ -320,10 +341,10 @@ static int dw_msi_setup_irq(struct msi_chip *chip, struct pci_dev *pdev, ...@@ -320,10 +341,10 @@ static int dw_msi_setup_irq(struct msi_chip *chip, struct pci_dev *pdev,
if (irq < 0) if (irq < 0)
return irq; return irq;
msg_ctr &= ~PCI_MSI_FLAGS_QSIZE; /*
msg_ctr |= msgvec << 4; * write_msi_msg() will update PCI_MSI_FLAGS so there is
pci_write_config_word(pdev, desc->msi_attrib.pos + PCI_MSI_FLAGS, * no need to explicitly call pci_write_config_word().
msg_ctr); */
desc->msi_attrib.multiple = msgvec; desc->msi_attrib.multiple = msgvec;
msg.address_lo = virt_to_phys((void *)pp->msi_data); msg.address_lo = virt_to_phys((void *)pp->msi_data);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment