ambapp.c 9.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343
  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).
  4. *
  5. * (C) Copyright 2007
  6. * Daniel Hellstrom, Gaisler Research, daniel@gaisler.com
  7. *
  8. * SPDX-License-Identifier: GPL-2.0+
  9. */
  10. #include <common.h>
  11. #include <command.h>
  12. #include <ambapp.h>
  13. #if defined(CONFIG_CMD_AMBAPP)
  14. extern void ambapp_print_apb(apbctrl_pp_dev * apb,
  15. ambapp_ahbdev * apbmst, int index);
  16. extern void ambapp_print_ahb(ahbctrl_pp_dev * ahb, int index);
  17. extern int ambapp_apb_print;
  18. extern int ambapp_ahb_print;
  19. #endif
  20. static int ambapp_apb_scan(unsigned int vendor, /* Plug&Play Vendor ID */
  21. unsigned int driver, /* Plug&Play Device ID */
  22. ambapp_apbdev * dev, /* Result(s) is placed here */
  23. int index, /* Index of device to start copying Plug&Play
  24. * info into dev
  25. */
  26. int max_cnt /* Maximal count that dev can hold, if dev
  27. * is NULL function will stop scanning after
  28. * max_cnt devices are found.
  29. */
  30. )
  31. {
  32. int i, cnt = 0;
  33. unsigned int apbmst_base;
  34. ambapp_ahbdev apbmst;
  35. apbctrl_pp_dev *apb;
  36. if (max_cnt == 0)
  37. return 0;
  38. /* Get AMBA APB Master */
  39. if (ambapp_ahbslv_first(VENDOR_GAISLER, GAISLER_APBMST, &apbmst) != 1) {
  40. return 0;
  41. }
  42. /* Get APB CTRL Plug&Play info area */
  43. apbmst_base = apbmst.address[0] & LEON3_IO_AREA;
  44. apb = (apbctrl_pp_dev *) (apbmst_base | LEON3_CONF_AREA);
  45. for (i = 0; i < LEON3_APB_SLAVES; i++) {
  46. #if defined(CONFIG_CMD_AMBAPP)
  47. if (ambapp_apb_print && amba_vendor(apb->conf)
  48. && amba_device(apb->conf)) {
  49. ambapp_print_apb(apb, &apbmst, i);
  50. }
  51. #endif
  52. if ((amba_vendor(apb->conf) == vendor) &&
  53. (amba_device(apb->conf) == driver) && ((index < 0)
  54. || (index-- == 0))) {
  55. /* Convert Plug&Play info into a more readable format */
  56. cnt++;
  57. if (dev) {
  58. dev->irq = amba_irq(apb->conf);
  59. dev->ver = amba_ver(apb->conf);
  60. dev->address =
  61. (apbmst_base |
  62. (((apb->
  63. bar & 0xfff00000) >> 12))) & (((apb->
  64. bar &
  65. 0x0000fff0)
  66. << 4) |
  67. 0xfff00000);
  68. dev++;
  69. }
  70. /* found max devices? */
  71. if (cnt >= max_cnt)
  72. return cnt;
  73. }
  74. /* Get next Plug&Play entry */
  75. apb++;
  76. }
  77. return cnt;
  78. }
  79. unsigned int ambapp_apb_next_nomem(register unsigned int vendor, /* Plug&Play Vendor ID */
  80. register unsigned int driver, /* Plug&Play Device ID */
  81. register int index)
  82. {
  83. register int i;
  84. register ahbctrl_pp_dev *apbmst;
  85. register apbctrl_pp_dev *apb;
  86. register unsigned int apbmst_base;
  87. /* APBMST is a AHB Slave */
  88. apbmst = ambapp_ahb_next_nomem(VENDOR_GAISLER, GAISLER_APBMST, 1, 0);
  89. if (!apbmst)
  90. return 0;
  91. apbmst_base = amba_membar_start(apbmst->bars[0]);
  92. if (amba_membar_type(apbmst->bars[0]) == AMBA_TYPE_AHBIO)
  93. apbmst_base = AMBA_TYPE_AHBIO_ADDR(apbmst_base);
  94. apbmst_base &= LEON3_IO_AREA;
  95. /* Find the vendor/driver device on the first APB bus */
  96. apb = (apbctrl_pp_dev *) (apbmst_base | LEON3_CONF_AREA);
  97. for (i = 0; i < LEON3_APB_SLAVES; i++) {
  98. if ((amba_vendor(apb->conf) == vendor) &&
  99. (amba_device(apb->conf) == driver) && ((index < 0)
  100. || (index-- == 0))) {
  101. /* Convert Plug&Play info info a more readable format */
  102. return (apbmst_base | (((apb->bar & 0xfff00000) >> 12)))
  103. & (((apb->bar & 0x0000fff0) << 4) | 0xfff00000);
  104. }
  105. /* Get next Plug&Play entry */
  106. apb++;
  107. }
  108. return 0;
  109. }
  110. /****************************** APB SLAVES ******************************/
  111. int ambapp_apb_count(unsigned int vendor, unsigned int driver)
  112. {
  113. return ambapp_apb_scan(vendor, driver, NULL, 0, LEON3_APB_SLAVES);
  114. }
  115. int ambapp_apb_first(unsigned int vendor,
  116. unsigned int driver, ambapp_apbdev * dev)
  117. {
  118. return ambapp_apb_scan(vendor, driver, dev, 0, 1);
  119. }
  120. int ambapp_apb_next(unsigned int vendor,
  121. unsigned int driver, ambapp_apbdev * dev, int index)
  122. {
  123. return ambapp_apb_scan(vendor, driver, dev, index, 1);
  124. }
  125. int ambapp_apbs_first(unsigned int vendor,
  126. unsigned int driver, ambapp_apbdev * dev, int max_cnt)
  127. {
  128. return ambapp_apb_scan(vendor, driver, dev, 0, max_cnt);
  129. }
  130. enum {
  131. AHB_SCAN_MASTER = 0,
  132. AHB_SCAN_SLAVE = 1
  133. };
  134. /* Scan AMBA Plug&Play bus for AMBA AHB Masters or AHB Slaves
  135. * for a certain matching Vendor and Device ID.
  136. *
  137. * Return number of devices found.
  138. *
  139. * Compact edition...
  140. */
  141. static int ambapp_ahb_scan(unsigned int vendor, /* Plug&Play Vendor ID */
  142. unsigned int driver, /* Plug&Play Device ID */
  143. ambapp_ahbdev * dev, /* Result(s) is placed here */
  144. int index, /* Index of device to start copying Plug&Play
  145. * info into dev
  146. */
  147. int max_cnt, /* Maximal count that dev can hold, if dev
  148. * is NULL function will stop scanning after
  149. * max_cnt devices are found.
  150. */
  151. int type /* Selectes what type of devices to scan.
  152. * 0=AHB Masters
  153. * 1=AHB Slaves
  154. */
  155. )
  156. {
  157. int i, j, cnt = 0, max_pp_devs;
  158. unsigned int addr;
  159. ahbctrl_info *info = (ahbctrl_info *) (LEON3_IO_AREA | LEON3_CONF_AREA);
  160. ahbctrl_pp_dev *ahb;
  161. if (max_cnt == 0)
  162. return 0;
  163. if (type == 0) {
  164. max_pp_devs = LEON3_AHB_MASTERS;
  165. ahb = info->masters;
  166. } else {
  167. max_pp_devs = LEON3_AHB_SLAVES;
  168. ahb = info->slaves;
  169. }
  170. for (i = 0; i < max_pp_devs; i++) {
  171. #if defined(CONFIG_CMD_AMBAPP)
  172. if (ambapp_ahb_print && amba_vendor(ahb->conf) &&
  173. amba_device(ahb->conf)) {
  174. ambapp_print_ahb(ahb, i);
  175. }
  176. #endif
  177. if ((amba_vendor(ahb->conf) == vendor) &&
  178. (amba_device(ahb->conf) == driver) &&
  179. ((index < 0) || (index-- == 0))) {
  180. /* Convert Plug&Play info info a more readable format */
  181. cnt++;
  182. if (dev) {
  183. dev->irq = amba_irq(ahb->conf);
  184. dev->ver = amba_ver(ahb->conf);
  185. dev->userdef[0] = ahb->userdef[0];
  186. dev->userdef[1] = ahb->userdef[1];
  187. dev->userdef[2] = ahb->userdef[2];
  188. for (j = 0; j < 4; j++) {
  189. addr = amba_membar_start(ahb->bars[j]);
  190. if (amba_membar_type(ahb->bars[j]) ==
  191. AMBA_TYPE_AHBIO)
  192. addr =
  193. AMBA_TYPE_AHBIO_ADDR(addr);
  194. dev->address[j] = addr;
  195. }
  196. dev++;
  197. }
  198. /* found max devices? */
  199. if (cnt >= max_cnt)
  200. return cnt;
  201. }
  202. /* Get next Plug&Play entry */
  203. ahb++;
  204. }
  205. return cnt;
  206. }
  207. unsigned int ambapp_ahb_get_info(ahbctrl_pp_dev * ahb, int info)
  208. {
  209. register unsigned int ret;
  210. if (!ahb)
  211. return 0;
  212. switch (info) {
  213. default:
  214. info = 0;
  215. case 0:
  216. case 1:
  217. case 2:
  218. case 3:
  219. /* Get Address from PnP Info */
  220. ret = amba_membar_start(ahb->bars[info]);
  221. if (amba_membar_type(ahb->bars[info]) == AMBA_TYPE_AHBIO)
  222. ret = AMBA_TYPE_AHBIO_ADDR(ret);
  223. return ret;
  224. }
  225. return 0;
  226. }
  227. ahbctrl_pp_dev *ambapp_ahb_next_nomem(register unsigned int vendor, /* Plug&Play Vendor ID */
  228. register unsigned int driver, /* Plug&Play Device ID */
  229. register unsigned int opts, /* 1=slave, 0=master */
  230. register int index)
  231. {
  232. register ahbctrl_pp_dev *ahb;
  233. register ahbctrl_info *info =
  234. (ahbctrl_info *) (LEON3_IO_AREA | LEON3_CONF_AREA);
  235. register int i;
  236. register int max_pp_devs;
  237. if (opts == 0) {
  238. max_pp_devs = LEON3_AHB_MASTERS;
  239. ahb = info->masters;
  240. } else {
  241. max_pp_devs = LEON3_AHB_SLAVES;
  242. ahb = info->slaves;
  243. }
  244. for (i = 0; i < max_pp_devs; i++) {
  245. if ((amba_vendor(ahb->conf) == vendor) &&
  246. (amba_device(ahb->conf) == driver) &&
  247. ((index < 0) || (index-- == 0))) {
  248. /* Convert Plug&Play info info a more readable format */
  249. return ahb;
  250. }
  251. /* Get next Plug&Play entry */
  252. ahb++;
  253. }
  254. return 0;
  255. }
  256. /****************************** AHB MASTERS ******************************/
  257. int ambapp_ahbmst_count(unsigned int vendor, unsigned int driver)
  258. {
  259. /* Get number of devices of this vendor&device ID */
  260. return ambapp_ahb_scan(vendor, driver, NULL, 0, LEON3_AHB_MASTERS,
  261. AHB_SCAN_MASTER);
  262. }
  263. int ambapp_ahbmst_first(unsigned int vendor, unsigned int driver,
  264. ambapp_ahbdev * dev)
  265. {
  266. /* find first device of this */
  267. return ambapp_ahb_scan(vendor, driver, dev, 0, 1, AHB_SCAN_MASTER);
  268. }
  269. int ambapp_ahbmst_next(unsigned int vendor,
  270. unsigned int driver, ambapp_ahbdev * dev, int index)
  271. {
  272. /* find first device of this */
  273. return ambapp_ahb_scan(vendor, driver, dev, index, 1, AHB_SCAN_MASTER);
  274. }
  275. int ambapp_ahbmsts_first(unsigned int vendor,
  276. unsigned int driver, ambapp_ahbdev * dev, int max_cnt)
  277. {
  278. /* find first device of this */
  279. return ambapp_ahb_scan(vendor, driver, dev, 0, max_cnt,
  280. AHB_SCAN_MASTER);
  281. }
  282. /****************************** AHB SLAVES ******************************/
  283. int ambapp_ahbslv_count(unsigned int vendor, unsigned int driver)
  284. {
  285. /* Get number of devices of this vendor&device ID */
  286. return ambapp_ahb_scan(vendor, driver, NULL, 0, LEON3_AHB_SLAVES,
  287. AHB_SCAN_SLAVE);
  288. }
  289. int ambapp_ahbslv_first(unsigned int vendor, unsigned int driver,
  290. ambapp_ahbdev * dev)
  291. {
  292. /* find first device of this */
  293. return ambapp_ahb_scan(vendor, driver, dev, 0, 1, AHB_SCAN_SLAVE);
  294. }
  295. int ambapp_ahbslv_next(unsigned int vendor,
  296. unsigned int driver, ambapp_ahbdev * dev, int index)
  297. {
  298. /* find first device of this */
  299. return ambapp_ahb_scan(vendor, driver, dev, index, 1, AHB_SCAN_SLAVE);
  300. }
  301. int ambapp_ahbslvs_first(unsigned int vendor,
  302. unsigned int driver, ambapp_ahbdev * dev, int max_cnt)
  303. {
  304. /* find first device of this */
  305. return ambapp_ahb_scan(vendor, driver, dev, 0, max_cnt, AHB_SCAN_SLAVE);
  306. }