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