1 /* Gaisler AMBA Plug&Play bus scanning. Functions
2 * ending on _nomem is inteded to be used only during
3 * initialization, only registers are used (no ram).
6 * Daniel Hellstrom, Gaisler Research, daniel@gaisler.com
8 * SPDX-License-Identifier: GPL-2.0+
15 #if defined(CONFIG_CMD_AMBAPP)
16 extern void ambapp_print_apb(apbctrl_pp_dev * apb,
17 ambapp_ahbdev * apbmst, int index);
18 extern void ambapp_print_ahb(ahbctrl_pp_dev * ahb, int index);
19 extern int ambapp_apb_print;
20 extern int ambapp_ahb_print;
23 static int ambapp_apb_scan(unsigned int vendor, /* Plug&Play Vendor ID */
24 unsigned int driver, /* Plug&Play Device ID */
25 ambapp_apbdev * dev, /* Result(s) is placed here */
26 int index, /* Index of device to start copying Plug&Play
29 int max_cnt /* Maximal count that dev can hold, if dev
30 * is NULL function will stop scanning after
31 * max_cnt devices are found.
36 unsigned int apbmst_base;
43 /* Get AMBA APB Master */
44 if (ambapp_ahbslv_first(VENDOR_GAISLER, GAISLER_APBMST, &apbmst) != 1) {
48 /* Get APB CTRL Plug&Play info area */
49 apbmst_base = apbmst.address[0] & LEON3_IO_AREA;
50 apb = (apbctrl_pp_dev *) (apbmst_base | LEON3_CONF_AREA);
52 for (i = 0; i < LEON3_APB_SLAVES; i++) {
53 #if defined(CONFIG_CMD_AMBAPP)
54 if (ambapp_apb_print && amba_vendor(apb->conf)
55 && amba_device(apb->conf)) {
56 ambapp_print_apb(apb, &apbmst, i);
59 if ((amba_vendor(apb->conf) == vendor) &&
60 (amba_device(apb->conf) == driver) && ((index < 0)
62 /* Convert Plug&Play info into a more readable format */
65 dev->irq = amba_irq(apb->conf);
66 dev->ver = amba_ver(apb->conf);
70 bar & 0xfff00000) >> 12))) & (((apb->
77 /* found max devices? */
81 /* Get next Plug&Play entry */
87 unsigned int ambapp_apb_next_nomem(register unsigned int vendor, /* Plug&Play Vendor ID */
88 register unsigned int driver, /* Plug&Play Device ID */
92 register ahbctrl_pp_dev *apbmst;
93 register apbctrl_pp_dev *apb;
94 register unsigned int apbmst_base;
96 /* APBMST is a AHB Slave */
97 apbmst = ambapp_ahb_next_nomem(VENDOR_GAISLER, GAISLER_APBMST, 1, 0);
101 apbmst_base = amba_membar_start(apbmst->bars[0]);
102 if (amba_membar_type(apbmst->bars[0]) == AMBA_TYPE_AHBIO)
103 apbmst_base = AMBA_TYPE_AHBIO_ADDR(apbmst_base);
104 apbmst_base &= LEON3_IO_AREA;
106 /* Find the vendor/driver device on the first APB bus */
107 apb = (apbctrl_pp_dev *) (apbmst_base | LEON3_CONF_AREA);
109 for (i = 0; i < LEON3_APB_SLAVES; i++) {
110 if ((amba_vendor(apb->conf) == vendor) &&
111 (amba_device(apb->conf) == driver) && ((index < 0)
112 || (index-- == 0))) {
113 /* Convert Plug&Play info info a more readable format */
114 return (apbmst_base | (((apb->bar & 0xfff00000) >> 12)))
115 & (((apb->bar & 0x0000fff0) << 4) | 0xfff00000);
117 /* Get next Plug&Play entry */
123 /****************************** APB SLAVES ******************************/
125 int ambapp_apb_count(unsigned int vendor, unsigned int driver)
127 return ambapp_apb_scan(vendor, driver, NULL, 0, LEON3_APB_SLAVES);
130 int ambapp_apb_first(unsigned int vendor,
131 unsigned int driver, ambapp_apbdev * dev)
133 return ambapp_apb_scan(vendor, driver, dev, 0, 1);
136 int ambapp_apb_next(unsigned int vendor,
137 unsigned int driver, ambapp_apbdev * dev, int index)
139 return ambapp_apb_scan(vendor, driver, dev, index, 1);
142 int ambapp_apbs_first(unsigned int vendor,
143 unsigned int driver, ambapp_apbdev * dev, int max_cnt)
145 return ambapp_apb_scan(vendor, driver, dev, 0, max_cnt);
153 /* Scan AMBA Plug&Play bus for AMBA AHB Masters or AHB Slaves
154 * for a certain matching Vendor and Device ID.
156 * Return number of devices found.
160 static int ambapp_ahb_scan(unsigned int vendor, /* Plug&Play Vendor ID */
161 unsigned int driver, /* Plug&Play Device ID */
162 ambapp_ahbdev * dev, /* Result(s) is placed here */
163 int index, /* Index of device to start copying Plug&Play
166 int max_cnt, /* Maximal count that dev can hold, if dev
167 * is NULL function will stop scanning after
168 * max_cnt devices are found.
170 int type /* Selectes what type of devices to scan.
176 int i, j, cnt = 0, max_pp_devs;
178 ahbctrl_info *info = (ahbctrl_info *) (LEON3_IO_AREA | LEON3_CONF_AREA);
185 max_pp_devs = LEON3_AHB_MASTERS;
188 max_pp_devs = LEON3_AHB_SLAVES;
192 for (i = 0; i < max_pp_devs; i++) {
193 #if defined(CONFIG_CMD_AMBAPP)
194 if (ambapp_ahb_print && amba_vendor(ahb->conf) &&
195 amba_device(ahb->conf)) {
196 ambapp_print_ahb(ahb, i);
199 if ((amba_vendor(ahb->conf) == vendor) &&
200 (amba_device(ahb->conf) == driver) &&
201 ((index < 0) || (index-- == 0))) {
202 /* Convert Plug&Play info info a more readable format */
205 dev->irq = amba_irq(ahb->conf);
206 dev->ver = amba_ver(ahb->conf);
207 dev->userdef[0] = ahb->userdef[0];
208 dev->userdef[1] = ahb->userdef[1];
209 dev->userdef[2] = ahb->userdef[2];
210 for (j = 0; j < 4; j++) {
211 addr = amba_membar_start(ahb->bars[j]);
212 if (amba_membar_type(ahb->bars[j]) ==
215 AMBA_TYPE_AHBIO_ADDR(addr);
216 dev->address[j] = addr;
220 /* found max devices? */
224 /* Get next Plug&Play entry */
230 unsigned int ambapp_ahb_get_info(ahbctrl_pp_dev * ahb, int info)
232 register unsigned int ret;
244 /* Get Address from PnP Info */
245 ret = amba_membar_start(ahb->bars[info]);
246 if (amba_membar_type(ahb->bars[info]) == AMBA_TYPE_AHBIO)
247 ret = AMBA_TYPE_AHBIO_ADDR(ret);
254 ahbctrl_pp_dev *ambapp_ahb_next_nomem(register unsigned int vendor, /* Plug&Play Vendor ID */
255 register unsigned int driver, /* Plug&Play Device ID */
256 register unsigned int opts, /* 1=slave, 0=master */
259 register ahbctrl_pp_dev *ahb;
260 register ahbctrl_info *info =
261 (ahbctrl_info *) (LEON3_IO_AREA | LEON3_CONF_AREA);
263 register int max_pp_devs;
266 max_pp_devs = LEON3_AHB_MASTERS;
269 max_pp_devs = LEON3_AHB_SLAVES;
273 for (i = 0; i < max_pp_devs; i++) {
274 if ((amba_vendor(ahb->conf) == vendor) &&
275 (amba_device(ahb->conf) == driver) &&
276 ((index < 0) || (index-- == 0))) {
277 /* Convert Plug&Play info info a more readable format */
280 /* Get next Plug&Play entry */
286 /****************************** AHB MASTERS ******************************/
287 int ambapp_ahbmst_count(unsigned int vendor, unsigned int driver)
289 /* Get number of devices of this vendor&device ID */
290 return ambapp_ahb_scan(vendor, driver, NULL, 0, LEON3_AHB_MASTERS,
294 int ambapp_ahbmst_first(unsigned int vendor, unsigned int driver,
297 /* find first device of this */
298 return ambapp_ahb_scan(vendor, driver, dev, 0, 1, AHB_SCAN_MASTER);
301 int ambapp_ahbmst_next(unsigned int vendor,
302 unsigned int driver, ambapp_ahbdev * dev, int index)
304 /* find first device of this */
305 return ambapp_ahb_scan(vendor, driver, dev, index, 1, AHB_SCAN_MASTER);
308 int ambapp_ahbmsts_first(unsigned int vendor,
309 unsigned int driver, ambapp_ahbdev * dev, int max_cnt)
311 /* find first device of this */
312 return ambapp_ahb_scan(vendor, driver, dev, 0, max_cnt,
316 /****************************** AHB SLAVES ******************************/
317 int ambapp_ahbslv_count(unsigned int vendor, unsigned int driver)
319 /* Get number of devices of this vendor&device ID */
320 return ambapp_ahb_scan(vendor, driver, NULL, 0, LEON3_AHB_SLAVES,
324 int ambapp_ahbslv_first(unsigned int vendor, unsigned int driver,
327 /* find first device of this */
328 return ambapp_ahb_scan(vendor, driver, dev, 0, 1, AHB_SCAN_SLAVE);
331 int ambapp_ahbslv_next(unsigned int vendor,
332 unsigned int driver, ambapp_ahbdev * dev, int index)
334 /* find first device of this */
335 return ambapp_ahb_scan(vendor, driver, dev, index, 1, AHB_SCAN_SLAVE);
338 int ambapp_ahbslvs_first(unsigned int vendor,
339 unsigned int driver, ambapp_ahbdev * dev, int max_cnt)
341 /* find first device of this */
342 return ambapp_ahb_scan(vendor, driver, dev, 0, max_cnt, AHB_SCAN_SLAVE);