diff --git a/src/include/device/pci_ops.h b/src/include/device/pci_ops.h index 680deb9d35..cdf02d6a56 100644 --- a/src/include/device/pci_ops.h +++ b/src/include/device/pci_ops.h @@ -80,78 +80,6 @@ void pci_write_config32(const struct device *dev, u16 reg, u32 val) #endif -#if ENV_PCI_SIMPLE_DEVICE -static __always_inline -void pci_and_config8(pci_devfn_t dev, u16 reg, u8 andmask) -#else -static __always_inline -void pci_and_config8(const struct device *dev, u16 reg, u8 andmask) -#endif -{ - u8 value = pci_read_config8(dev, reg); - pci_write_config8(dev, reg, value & andmask); -} - -#if ENV_PCI_SIMPLE_DEVICE -static __always_inline -void pci_and_config16(pci_devfn_t dev, u16 reg, u16 andmask) -#else -static __always_inline -void pci_and_config16(const struct device *dev, u16 reg, u16 andmask) -#endif -{ - u16 value = pci_read_config16(dev, reg); - pci_write_config16(dev, reg, value & andmask); -} - -#if ENV_PCI_SIMPLE_DEVICE -static __always_inline -void pci_and_config32(pci_devfn_t dev, u16 reg, u32 andmask) -#else -static __always_inline -void pci_and_config32(const struct device *dev, u16 reg, u32 andmask) -#endif -{ - u32 value = pci_read_config32(dev, reg); - pci_write_config32(dev, reg, value & andmask); -} - -#if ENV_PCI_SIMPLE_DEVICE -static __always_inline -void pci_or_config8(pci_devfn_t dev, u16 reg, u8 ormask) -#else -static __always_inline -void pci_or_config8(const struct device *dev, u16 reg, u8 ormask) -#endif -{ - u8 value = pci_read_config8(dev, reg); - pci_write_config8(dev, reg, value | ormask); -} - -#if ENV_PCI_SIMPLE_DEVICE -static __always_inline -void pci_or_config16(pci_devfn_t dev, u16 reg, u16 ormask) -#else -static __always_inline -void pci_or_config16(const struct device *dev, u16 reg, u16 ormask) -#endif -{ - u16 value = pci_read_config16(dev, reg); - pci_write_config16(dev, reg, value | ormask); -} - -#if ENV_PCI_SIMPLE_DEVICE -static __always_inline -void pci_or_config32(pci_devfn_t dev, u16 reg, u32 ormask) -#else -static __always_inline -void pci_or_config32(const struct device *dev, u16 reg, u32 ormask) -#endif -{ - u32 value = pci_read_config32(dev, reg); - pci_write_config32(dev, reg, value | ormask); -} - #if ENV_PCI_SIMPLE_DEVICE static __always_inline void pci_update_config8(pci_devfn_t dev, u16 reg, u8 mask, u8 or) @@ -200,6 +128,72 @@ void pci_update_config32(const struct device *dev, u16 reg, u32 mask, u32 or) pci_write_config32(dev, reg, reg32); } +#if ENV_PCI_SIMPLE_DEVICE +static __always_inline +void pci_and_config8(pci_devfn_t dev, u16 reg, u8 andmask) +#else +static __always_inline +void pci_and_config8(const struct device *dev, u16 reg, u8 andmask) +#endif +{ + pci_update_config8(dev, reg, andmask, 0); +} + +#if ENV_PCI_SIMPLE_DEVICE +static __always_inline +void pci_and_config16(pci_devfn_t dev, u16 reg, u16 andmask) +#else +static __always_inline +void pci_and_config16(const struct device *dev, u16 reg, u16 andmask) +#endif +{ + pci_update_config16(dev, reg, andmask, 0); +} + +#if ENV_PCI_SIMPLE_DEVICE +static __always_inline +void pci_and_config32(pci_devfn_t dev, u16 reg, u32 andmask) +#else +static __always_inline +void pci_and_config32(const struct device *dev, u16 reg, u32 andmask) +#endif +{ + pci_update_config32(dev, reg, andmask, 0); +} + +#if ENV_PCI_SIMPLE_DEVICE +static __always_inline +void pci_or_config8(pci_devfn_t dev, u16 reg, u8 ormask) +#else +static __always_inline +void pci_or_config8(const struct device *dev, u16 reg, u8 ormask) +#endif +{ + pci_update_config8(dev, reg, 0xff, ormask); +} + +#if ENV_PCI_SIMPLE_DEVICE +static __always_inline +void pci_or_config16(pci_devfn_t dev, u16 reg, u16 ormask) +#else +static __always_inline +void pci_or_config16(const struct device *dev, u16 reg, u16 ormask) +#endif +{ + pci_update_config16(dev, reg, 0xffff, ormask); +} + +#if ENV_PCI_SIMPLE_DEVICE +static __always_inline +void pci_or_config32(pci_devfn_t dev, u16 reg, u32 ormask) +#else +static __always_inline +void pci_or_config32(const struct device *dev, u16 reg, u32 ormask) +#endif +{ + pci_update_config32(dev, reg, 0xffffffff, ormask); +} + u16 pci_s_find_next_capability(pci_devfn_t dev, u16 cap, u16 last); u16 pci_s_find_capability(pci_devfn_t dev, u16 cap);