1 files changed, 57 insertions, 0 deletions
diff --git a/src/soc/intel/pantherlake/p2sb.c b/src/soc/intel/pantherlake/p2sb.c
new file mode 100644
index 0000000000..52b36903d6
--- /dev/null
+++ b/src/soc/intel/pantherlake/p2sb.c
@@ -0,0 +1,57 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+
+#include <console/console.h>
+#include <device/device.h>
+#include <device/pci_def.h>
+#include <intelblocks/p2sb.h>
+#include <soc/iomap.h>
+
+void p2sb_soc_get_sb_mask(uint32_t *ep_mask, size_t count)
+{
+	uint32_t mask;
+
+	if (count != P2SB_EP_MASK_MAX_REG) {
+		printk(BIOS_ERR, "Unable to program EPMASK registers\n");
+		return;
+	}
+
+	/* Remove the host accessing right to PSF register range.
+	 * Set p2sb PCI offset EPMASK5 [29, 28, 27, 26] to disable Sideband
+	 * access for PCI Root Bridge.
+	 */
+	mask = BIT(29) | BIT(28) | BIT(27)  | BIT(26);
+
+	ep_mask[P2SB_EP_MASK_5_REG] = mask;
+
+	/*
+	 * Set p2sb PCI offset EPMASK7 [31, 30] to disable Sideband
+	 * access for Broadcast and Multicast.
+	 */
+	mask = BIT(31) | BIT(30);
+
+	ep_mask[P2SB_EP_MASK_7_REG] = mask;
+}
+
+static void p2sb2_read_resources(struct device *dev)
+{
+	/* Add the fixed MMIO resource for P2SB#2 */
+	mmio_range(dev, PCI_BASE_ADDRESS_0, IOE_P2SB_BAR, IOE_P2SB_SIZE);
+}
+
+static void p2sb_read_resources(struct device *dev)
+{
+	/* Add the fixed MMIO resource for P2SB#1 */
+	mmio_range(dev, PCI_BASE_ADDRESS_0, P2SB_BAR, P2SB_SIZE);
+}
+
+struct device_operations pcd_p2sb_2_ops = {
+	.read_resources   = p2sb2_read_resources,
+	.set_resources    = noop_set_resources,
+	.scan_bus         = scan_static_bus,
+};
+
+struct device_operations pcd_p2sb_ops = {
+	.read_resources   = p2sb_read_resources,
+	.set_resources    = noop_set_resources,
+	.scan_bus         = scan_static_bus,
+};