1
2
3
4
5
6
7#include <common.h>
8#include <msc01.h>
9#include <pci.h>
10#include <pci_msc01.h>
11#include <asm/io.h>
12
13#define PCI_ACCESS_READ 0
14#define PCI_ACCESS_WRITE 1
15
16struct msc01_pci_controller {
17 struct pci_controller hose;
18 void *base;
19};
20
21static inline struct msc01_pci_controller *
22hose_to_msc01(struct pci_controller *hose)
23{
24 return container_of(hose, struct msc01_pci_controller, hose);
25}
26
27static int msc01_config_access(struct msc01_pci_controller *msc01,
28 unsigned char access_type, pci_dev_t bdf,
29 int where, u32 *data)
30{
31 const u32 aborts = MSC01_PCI_INTSTAT_MA_MSK | MSC01_PCI_INTSTAT_TA_MSK;
32 void *intstat = msc01->base + MSC01_PCI_INTSTAT_OFS;
33 void *cfgdata = msc01->base + MSC01_PCI_CFGDATA_OFS;
34 unsigned int bus = PCI_BUS(bdf);
35 unsigned int dev = PCI_DEV(bdf);
36 unsigned int devfn = PCI_DEV(bdf) << 3 | PCI_FUNC(bdf);
37
38
39 __raw_writel(aborts, intstat);
40
41
42 __raw_writel((bus << MSC01_PCI_CFGADDR_BNUM_SHF) |
43 (dev << MSC01_PCI_CFGADDR_DNUM_SHF) |
44 (devfn << MSC01_PCI_CFGADDR_FNUM_SHF) |
45 ((where / 4) << MSC01_PCI_CFGADDR_RNUM_SHF),
46 msc01->base + MSC01_PCI_CFGADDR_OFS);
47
48
49 if (access_type == PCI_ACCESS_WRITE)
50 __raw_writel(*data, cfgdata);
51 else
52 *data = __raw_readl(cfgdata);
53
54
55 if (__raw_readl(intstat) & aborts) {
56
57 __raw_writel(aborts, intstat);
58 return -1;
59 }
60
61 return 0;
62}
63
64static int msc01_read_config_dword(struct pci_controller *hose, pci_dev_t dev,
65 int where, u32 *value)
66{
67 struct msc01_pci_controller *msc01 = hose_to_msc01(hose);
68
69 *value = 0xffffffff;
70 return msc01_config_access(msc01, PCI_ACCESS_READ, dev, where, value);
71}
72
73static int msc01_write_config_dword(struct pci_controller *hose, pci_dev_t dev,
74 int where, u32 value)
75{
76 struct msc01_pci_controller *gt = hose_to_msc01(hose);
77 u32 data = value;
78
79 return msc01_config_access(gt, PCI_ACCESS_WRITE, dev, where, &data);
80}
81
82void msc01_pci_init(void *base, unsigned long sys_bus, unsigned long sys_phys,
83 unsigned long sys_size, unsigned long mem_bus,
84 unsigned long mem_phys, unsigned long mem_size,
85 unsigned long io_bus, unsigned long io_phys,
86 unsigned long io_size)
87{
88 static struct msc01_pci_controller global_msc01;
89 struct msc01_pci_controller *msc01;
90 struct pci_controller *hose;
91
92 msc01 = &global_msc01;
93 msc01->base = base;
94
95 hose = &msc01->hose;
96
97 hose->first_busno = 0;
98 hose->last_busno = 0;
99
100
101 pci_set_region(&hose->regions[0], sys_bus, sys_phys, sys_size,
102 PCI_REGION_MEM | PCI_REGION_SYS_MEMORY);
103
104
105 pci_set_region(&hose->regions[1], mem_bus, mem_phys, mem_size,
106 PCI_REGION_MEM);
107
108
109 pci_set_region(&hose->regions[2], io_bus, io_phys, io_size,
110 PCI_REGION_IO);
111
112 hose->region_count = 3;
113
114 pci_set_ops(hose,
115 pci_hose_read_config_byte_via_dword,
116 pci_hose_read_config_word_via_dword,
117 msc01_read_config_dword,
118 pci_hose_write_config_byte_via_dword,
119 pci_hose_write_config_word_via_dword,
120 msc01_write_config_dword);
121
122 pci_register_hose(hose);
123 hose->last_busno = pci_hose_scan(hose);
124}
125