1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Copyright (c) 2014 Google, Inc
4  * Written by Simon Glass <sjg@chromium.org>
5  */
6 
7 #include <common.h>
8 #include <dm.h>
9 #include <fdtdec.h>
10 #include <log.h>
11 #include <linux/libfdt.h>
12 #include <pci.h>
13 #include <dm/lists.h>
14 
15 struct sandbox_pci_emul_priv {
16 	int dev_count;
17 };
18 
sandbox_pci_get_emul(const struct udevice * bus,pci_dev_t find_devfn,struct udevice ** containerp,struct udevice ** emulp)19 int sandbox_pci_get_emul(const struct udevice *bus, pci_dev_t find_devfn,
20 			 struct udevice **containerp, struct udevice **emulp)
21 {
22 	struct pci_emul_uc_priv *upriv;
23 	struct udevice *dev;
24 	int ret;
25 
26 	*containerp = NULL;
27 	ret = pci_bus_find_devfn(bus, PCI_MASK_BUS(find_devfn), &dev);
28 	if (ret) {
29 		debug("%s: Could not find emulator for dev %x\n", __func__,
30 		      find_devfn);
31 		return ret;
32 	}
33 	*containerp = dev;
34 
35 	ret = uclass_get_device_by_phandle(UCLASS_PCI_EMUL, dev, "sandbox,emul",
36 					   emulp);
37 	if (!ret) {
38 		upriv = dev_get_uclass_priv(*emulp);
39 
40 		upriv->client = dev;
41 	} else if (device_get_uclass_id(dev) != UCLASS_PCI_GENERIC) {
42 		/*
43 		 * See commit 4345998ae9df,
44 		 * "pci: sandbox: Support dynamically binding device driver"
45 		 */
46 		*emulp = dev;
47 	}
48 
49 	return 0;
50 }
51 
sandbox_pci_get_client(struct udevice * emul,struct udevice ** devp)52 int sandbox_pci_get_client(struct udevice *emul, struct udevice **devp)
53 {
54 	struct pci_emul_uc_priv *upriv = dev_get_uclass_priv(emul);
55 
56 	if (!upriv->client)
57 		return -ENOENT;
58 	*devp = upriv->client;
59 
60 	return 0;
61 }
62 
sandbox_pci_read_bar(u32 barval,int type,uint size)63 uint sandbox_pci_read_bar(u32 barval, int type, uint size)
64 {
65 	u32 result;
66 
67 	result = barval;
68 	if (result == 0xffffffff) {
69 		if (type == PCI_BASE_ADDRESS_SPACE_IO) {
70 			result = (~(size - 1) &
71 				PCI_BASE_ADDRESS_IO_MASK) |
72 				PCI_BASE_ADDRESS_SPACE_IO;
73 		} else {
74 			result = (~(size - 1) &
75 				PCI_BASE_ADDRESS_MEM_MASK) |
76 				PCI_BASE_ADDRESS_MEM_TYPE_32;
77 		}
78 	}
79 
80 	return result;
81 }
82 
sandbox_pci_emul_post_probe(struct udevice * dev)83 static int sandbox_pci_emul_post_probe(struct udevice *dev)
84 {
85 	struct sandbox_pci_emul_priv *priv = uclass_get_priv(dev->uclass);
86 
87 	priv->dev_count++;
88 	sandbox_set_enable_pci_map(true);
89 
90 	return 0;
91 }
92 
sandbox_pci_emul_pre_remove(struct udevice * dev)93 static int sandbox_pci_emul_pre_remove(struct udevice *dev)
94 {
95 	struct sandbox_pci_emul_priv *priv = uclass_get_priv(dev->uclass);
96 
97 	priv->dev_count--;
98 	sandbox_set_enable_pci_map(priv->dev_count > 0);
99 
100 	return 0;
101 }
102 
103 UCLASS_DRIVER(pci_emul) = {
104 	.id		= UCLASS_PCI_EMUL,
105 	.name		= "pci_emul",
106 	.post_probe	= sandbox_pci_emul_post_probe,
107 	.pre_remove	= sandbox_pci_emul_pre_remove,
108 	.priv_auto	= sizeof(struct sandbox_pci_emul_priv),
109 	.per_device_auto	= sizeof(struct pci_emul_uc_priv),
110 };
111 
112 /*
113  * This uclass is a child of the pci bus. Its plat is not defined here so
114  * is defined by its parent, UCLASS_PCI, which uses struct pci_child_plat.
115  * See per_child_plat_auto	in UCLASS_DRIVER(pci).
116  */
117 UCLASS_DRIVER(pci_emul_parent) = {
118 	.id		= UCLASS_PCI_EMUL_PARENT,
119 	.name		= "pci_emul_parent",
120 	.post_bind	= dm_scan_fdt_dev,
121 };
122 
123 static const struct udevice_id pci_emul_parent_ids[] = {
124 	{ .compatible = "sandbox,pci-emul-parent" },
125 	{ }
126 };
127 
128 U_BOOT_DRIVER(pci_emul_parent_drv) = {
129 	.name		= "pci_emul_parent_drv",
130 	.id		= UCLASS_PCI_EMUL_PARENT,
131 	.of_match	= pci_emul_parent_ids,
132 };
133