bcma: pci: implement interrupts control

Signed-off-by: Rafał Miłecki <zajec5@gmail.com> Signed-off-by: John W. Linville <linville@tuxdriver.com>

bcma: pci: implement interrupts control
Signed-off-by: Rafał Miłecki <zajec5@gmail.com> Signed-off-by: John W. Linville <linville@tuxdriver.com>
Rafał Miłecki · John W. Linville
1 parent 33e6ef4e82
Showing 1 changed file with 23 additions and 0 deletions Side-by-side Diff
drivers/bcma/driver_pci.c
@@ -161,4 +161,27 @@
 {
 	bcma_pcicore_serdes_workaround(pc);
 }
+
+int bcma_core_pci_irq_ctl(struct bcma_drv_pci *pc, struct bcma_device *core,
+			  bool enable)
+{
+	struct pci_dev *pdev = pc->core->bus->host_pci;
+	u32 coremask, tmp;
+	int err;
+
+	err = pci_read_config_dword(pdev, BCMA_PCI_IRQMASK, &tmp);
+	if (err)
+		goto out;
+
+	coremask = BIT(core->core_index) << 8;
+	if (enable)
+		tmp |= coremask;
+	else
+		tmp &= ~coremask;
+
+	err = pci_write_config_dword(pdev, BCMA_PCI_IRQMASK, tmp);
+
+out:
+	return err;
+}
...	...	@@ -161,4 +161,27 @@
161	161	{
162	162	bcma_pcicore_serdes_workaround(pc);
163	163	}
	164	+
	165	+int bcma_core_pci_irq_ctl(struct bcma_drv_pci pc, struct bcma_device core,
	166	+ bool enable)
	167	+{
	168	+ struct pci_dev *pdev = pc->core->bus->host_pci;
	169	+ u32 coremask, tmp;
	170	+ int err;
	171	+
	172	+ err = pci_read_config_dword(pdev, BCMA_PCI_IRQMASK, &tmp);
	173	+ if (err)
	174	+ goto out;
	175	+
	176	+ coremask = BIT(core->core_index) << 8;
	177	+ if (enable)
	178	+ tmp \|= coremask;
	179	+ else
	180	+ tmp &= ~coremask;
	181	+
	182	+ err = pci_write_config_dword(pdev, BCMA_PCI_IRQMASK, tmp);
	183	+
	184	+out:
	185	+ return err;
	186	+}