PCI/MSI: Provide a new set of mask and unmask functions
The existing mask/unmask functions are convoluted and generate suboptimal assembly code. Provide a new set of functions which will be used in later patches to replace the exisiting ones. Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Tested-by: Marc Zyngier <maz@kernel.org> Reviewed-by: Marc Zyngier <maz@kernel.org> Link: https://lore.kernel.org/r/875ywetozb.ffs@tglx
This commit is contained in:
		
							parent
							
								
									7327cefebb
								
							
						
					
					
						commit
						fcacdfbef5
					
				| @ -211,6 +211,78 @@ static inline __attribute_const__ u32 msi_multi_mask(struct msi_desc *desc) | ||||
| 	return (1 << (1 << desc->msi_attrib.multi_cap)) - 1; | ||||
| } | ||||
| 
 | ||||
| static noinline void pci_msi_update_mask(struct msi_desc *desc, u32 clear, u32 set) | ||||
| { | ||||
| 	raw_spinlock_t *lock = &desc->dev->msi_lock; | ||||
| 	unsigned long flags; | ||||
| 
 | ||||
| 	raw_spin_lock_irqsave(lock, flags); | ||||
| 	desc->msi_mask &= ~clear; | ||||
| 	desc->msi_mask |= set; | ||||
| 	pci_write_config_dword(msi_desc_to_pci_dev(desc), desc->mask_pos, | ||||
| 			       desc->msi_mask); | ||||
| 	raw_spin_unlock_irqrestore(lock, flags); | ||||
| } | ||||
| 
 | ||||
| static inline void pci_msi_mask(struct msi_desc *desc, u32 mask) | ||||
| { | ||||
| 	pci_msi_update_mask(desc, 0, mask); | ||||
| } | ||||
| 
 | ||||
| static inline void pci_msi_unmask(struct msi_desc *desc, u32 mask) | ||||
| { | ||||
| 	pci_msi_update_mask(desc, mask, 0); | ||||
| } | ||||
| 
 | ||||
| /*
 | ||||
|  * This internal function does not flush PCI writes to the device.  All | ||||
|  * users must ensure that they read from the device before either assuming | ||||
|  * that the device state is up to date, or returning out of this file. | ||||
|  * It does not affect the msi_desc::msix_ctrl cache either. Use with care! | ||||
|  */ | ||||
| static void pci_msix_write_vector_ctrl(struct msi_desc *desc, u32 ctrl) | ||||
| { | ||||
| 	void __iomem *desc_addr = pci_msix_desc_addr(desc); | ||||
| 
 | ||||
| 	writel(ctrl, desc_addr + PCI_MSIX_ENTRY_VECTOR_CTRL); | ||||
| } | ||||
| 
 | ||||
| static inline void pci_msix_mask(struct msi_desc *desc) | ||||
| { | ||||
| 	desc->msix_ctrl |= PCI_MSIX_ENTRY_CTRL_MASKBIT; | ||||
| 	pci_msix_write_vector_ctrl(desc, desc->msix_ctrl); | ||||
| 	/* Flush write to device */ | ||||
| 	readl(desc->mask_base); | ||||
| } | ||||
| 
 | ||||
| static inline void pci_msix_unmask(struct msi_desc *desc) | ||||
| { | ||||
| 	desc->msix_ctrl &= ~PCI_MSIX_ENTRY_CTRL_MASKBIT; | ||||
| 	pci_msix_write_vector_ctrl(desc, desc->msix_ctrl); | ||||
| } | ||||
| 
 | ||||
| static void __pci_msi_mask_desc(struct msi_desc *desc, u32 mask) | ||||
| { | ||||
| 	if (pci_msi_ignore_mask || desc->msi_attrib.is_virtual) | ||||
| 		return; | ||||
| 
 | ||||
| 	if (desc->msi_attrib.is_msix) | ||||
| 		pci_msix_mask(desc); | ||||
| 	else if (desc->msi_attrib.maskbit) | ||||
| 		pci_msi_mask(desc, mask); | ||||
| } | ||||
| 
 | ||||
| static void __pci_msi_unmask_desc(struct msi_desc *desc, u32 mask) | ||||
| { | ||||
| 	if (pci_msi_ignore_mask || desc->msi_attrib.is_virtual) | ||||
| 		return; | ||||
| 
 | ||||
| 	if (desc->msi_attrib.is_msix) | ||||
| 		pci_msix_unmask(desc); | ||||
| 	else if (desc->msi_attrib.maskbit) | ||||
| 		pci_msi_unmask(desc, mask); | ||||
| } | ||||
| 
 | ||||
| /**
 | ||||
|  * pci_msi_mask_irq - Generic IRQ chip callback to mask PCI/MSI interrupts | ||||
|  * @data:	pointer to irqdata associated to that interrupt | ||||
|  | ||||
		Loading…
	
		Reference in New Issue
	
	Block a user