liodn.c 9.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright 2008-2011 Freescale Semiconductor, Inc.
  4. */
  5. #include <common.h>
  6. #include <log.h>
  7. #include <linux/libfdt.h>
  8. #include <fdt_support.h>
  9. #include <asm/immap_85xx.h>
  10. #include <asm/io.h>
  11. #include <asm/processor.h>
  12. #include <asm/fsl_portals.h>
  13. #include <asm/fsl_liodn.h>
  14. int get_dpaa_liodn(enum fsl_dpaa_dev dpaa_dev, u32 *liodns, int liodn_offset)
  15. {
  16. liodns[0] = liodn_bases[dpaa_dev].id[0] + liodn_offset;
  17. if (liodn_bases[dpaa_dev].num_ids == 2)
  18. liodns[1] = liodn_bases[dpaa_dev].id[1] + liodn_offset;
  19. return liodn_bases[dpaa_dev].num_ids;
  20. }
  21. #ifdef CONFIG_SYS_SRIO
  22. static void set_srio_liodn(struct srio_liodn_id_table *tbl, int size)
  23. {
  24. int i;
  25. for (i = 0; i < size; i++) {
  26. unsigned long reg_off = tbl[i].reg_offset[0];
  27. out_be32((u32 *)reg_off, tbl[i].id[0]);
  28. if (tbl[i].num_ids == 2) {
  29. reg_off = tbl[i].reg_offset[1];
  30. out_be32((u32 *)reg_off, tbl[i].id[1]);
  31. }
  32. }
  33. }
  34. #endif
  35. static void set_liodn(struct liodn_id_table *tbl, int size)
  36. {
  37. int i;
  38. for (i = 0; i < size; i++) {
  39. u32 liodn;
  40. if (tbl[i].num_ids == 2) {
  41. liodn = (tbl[i].id[0] << 16) | tbl[i].id[1];
  42. } else {
  43. liodn = tbl[i].id[0];
  44. }
  45. out_be32((volatile u32 *)(tbl[i].reg_offset), liodn);
  46. }
  47. }
  48. #ifdef CONFIG_SYS_DPAA_FMAN
  49. static void set_fman_liodn(struct fman_liodn_id_table *tbl, int size)
  50. {
  51. int i;
  52. for (i = 0; i < size; i++) {
  53. u32 liodn;
  54. if (tbl[i].num_ids == 2)
  55. liodn = (tbl[i].id[0] << 16) | tbl[i].id[1];
  56. else
  57. liodn = tbl[i].id[0];
  58. out_be32((volatile u32 *)(tbl[i].reg_offset), liodn);
  59. }
  60. }
  61. #endif
  62. static void setup_sec_liodn_base(void)
  63. {
  64. ccsr_sec_t *sec = (void *)CONFIG_SYS_FSL_SEC_ADDR;
  65. u32 base;
  66. if (!IS_E_PROCESSOR(get_svr()))
  67. return;
  68. /* QILCR[QSLOM] */
  69. sec_out32(&sec->qilcr_ms, 0x3ff<<16);
  70. base = (liodn_bases[FSL_HW_PORTAL_SEC].id[0] << 16) |
  71. liodn_bases[FSL_HW_PORTAL_SEC].id[1];
  72. sec_out32(&sec->qilcr_ls, base);
  73. }
  74. #ifdef CONFIG_SYS_DPAA_FMAN
  75. static void setup_fman_liodn_base(enum fsl_dpaa_dev dev,
  76. struct fman_liodn_id_table *tbl, int size)
  77. {
  78. int i;
  79. ccsr_fman_t *fm;
  80. u32 base;
  81. switch(dev) {
  82. case FSL_HW_PORTAL_FMAN1:
  83. fm = (void *)CONFIG_SYS_FSL_FM1_ADDR;
  84. break;
  85. #if (CONFIG_SYS_NUM_FMAN == 2)
  86. case FSL_HW_PORTAL_FMAN2:
  87. fm = (void *)CONFIG_SYS_FSL_FM2_ADDR;
  88. break;
  89. #endif
  90. default:
  91. printf("Error: Invalid device type to %s\n", __FUNCTION__);
  92. return ;
  93. }
  94. base = (liodn_bases[dev].id[0] << 16) | liodn_bases[dev].id[0];
  95. /* setup all bases the same */
  96. for (i = 0; i < 32; i++) {
  97. out_be32(&fm->fm_dma.fmdmplr[i], base);
  98. }
  99. /* update tbl to ... */
  100. for (i = 0; i < size; i++)
  101. tbl[i].id[0] += liodn_bases[dev].id[0];
  102. }
  103. #endif
  104. static void setup_pme_liodn_base(void)
  105. {
  106. #ifdef CONFIG_SYS_DPAA_PME
  107. ccsr_pme_t *pme = (void *)CONFIG_SYS_FSL_CORENET_PME_ADDR;
  108. u32 base = (liodn_bases[FSL_HW_PORTAL_PME].id[0] << 16) |
  109. liodn_bases[FSL_HW_PORTAL_PME].id[1];
  110. out_be32(&pme->liodnbr, base);
  111. #endif
  112. }
  113. #ifdef CONFIG_SYS_FSL_RAID_ENGINE
  114. static void setup_raide_liodn_base(void)
  115. {
  116. struct ccsr_raide *raide = (void *)CONFIG_SYS_FSL_RAID_ENGINE_ADDR;
  117. /* setup raid engine liodn base for data/desc ; both set to 47 */
  118. u32 base = (liodn_bases[FSL_HW_PORTAL_RAID_ENGINE].id[0] << 16) |
  119. liodn_bases[FSL_HW_PORTAL_RAID_ENGINE].id[0];
  120. out_be32(&raide->liodnbr, base);
  121. }
  122. #endif
  123. #ifdef CONFIG_SYS_DPAA_RMAN
  124. static void set_rman_liodn(struct liodn_id_table *tbl, int size)
  125. {
  126. int i;
  127. struct ccsr_rman *rman = (void *)CONFIG_SYS_FSL_CORENET_RMAN_ADDR;
  128. for (i = 0; i < size; i++) {
  129. /* write the RMan block number */
  130. out_be32(&rman->mmitar, i);
  131. /* write the liodn offset corresponding to the block */
  132. out_be32((u32 *)(tbl[i].reg_offset), tbl[i].id[0]);
  133. }
  134. }
  135. static void setup_rman_liodn_base(struct liodn_id_table *tbl, int size)
  136. {
  137. int i;
  138. struct ccsr_rman *rman = (void *)CONFIG_SYS_FSL_CORENET_RMAN_ADDR;
  139. u32 base = liodn_bases[FSL_HW_PORTAL_RMAN].id[0];
  140. out_be32(&rman->mmliodnbr, base);
  141. /* update liodn offset */
  142. for (i = 0; i < size; i++)
  143. tbl[i].id[0] += base;
  144. }
  145. #endif
  146. void set_liodns(void)
  147. {
  148. /* setup general liodn offsets */
  149. set_liodn(liodn_tbl, liodn_tbl_sz);
  150. #ifdef CONFIG_SYS_SRIO
  151. /* setup SRIO port liodns */
  152. set_srio_liodn(srio_liodn_tbl, srio_liodn_tbl_sz);
  153. #endif
  154. /* setup SEC block liodn bases & offsets if we have one */
  155. if (IS_E_PROCESSOR(get_svr())) {
  156. set_liodn(sec_liodn_tbl, sec_liodn_tbl_sz);
  157. setup_sec_liodn_base();
  158. }
  159. /* setup FMAN block(s) liodn bases & offsets if we have one */
  160. #ifdef CONFIG_SYS_DPAA_FMAN
  161. set_fman_liodn(fman1_liodn_tbl, fman1_liodn_tbl_sz);
  162. setup_fman_liodn_base(FSL_HW_PORTAL_FMAN1, fman1_liodn_tbl,
  163. fman1_liodn_tbl_sz);
  164. #if (CONFIG_SYS_NUM_FMAN == 2)
  165. set_fman_liodn(fman2_liodn_tbl, fman2_liodn_tbl_sz);
  166. setup_fman_liodn_base(FSL_HW_PORTAL_FMAN2, fman2_liodn_tbl,
  167. fman2_liodn_tbl_sz);
  168. #endif
  169. #endif
  170. /* setup PME liodn base */
  171. setup_pme_liodn_base();
  172. #ifdef CONFIG_SYS_FSL_RAID_ENGINE
  173. /* raid engine ccr addr code for liodn */
  174. set_liodn(raide_liodn_tbl, raide_liodn_tbl_sz);
  175. setup_raide_liodn_base();
  176. #endif
  177. #ifdef CONFIG_SYS_DPAA_RMAN
  178. /* setup RMan liodn offsets */
  179. set_rman_liodn(rman_liodn_tbl, rman_liodn_tbl_sz);
  180. /* setup RMan liodn base */
  181. setup_rman_liodn_base(rman_liodn_tbl, rman_liodn_tbl_sz);
  182. #endif
  183. }
  184. #ifdef CONFIG_SYS_SRIO
  185. static void fdt_fixup_srio_liodn(void *blob, struct srio_liodn_id_table *tbl)
  186. {
  187. int i, srio_off;
  188. /* search for srio node, if doesn't exist just return - nothing todo */
  189. srio_off = fdt_node_offset_by_compatible(blob, -1, "fsl,srio");
  190. if (srio_off < 0)
  191. return ;
  192. for (i = 0; i < srio_liodn_tbl_sz; i++) {
  193. int off, portid = tbl[i].portid;
  194. off = fdt_node_offset_by_prop_value(blob, srio_off,
  195. "cell-index", &portid, 4);
  196. if (off >= 0) {
  197. off = fdt_setprop(blob, off, "fsl,liodn",
  198. &tbl[i].id[0],
  199. sizeof(u32) * tbl[i].num_ids);
  200. if (off > 0)
  201. printf("WARNING unable to set fsl,liodn for "
  202. "fsl,srio port %d: %s\n",
  203. portid, fdt_strerror(off));
  204. } else {
  205. debug("WARNING: couldn't set fsl,liodn for srio: %s.\n",
  206. fdt_strerror(off));
  207. }
  208. }
  209. }
  210. #endif
  211. #define CONFIG_SYS_MAX_PCI_EPS 8
  212. static void fdt_fixup_pci_liodn_offsets(void *fdt, const char *compat,
  213. int ep_liodn_start)
  214. {
  215. int off, pci_idx = 0, pci_cnt = 0, i, rc;
  216. const uint32_t *base_liodn;
  217. uint32_t liodn_offs[CONFIG_SYS_MAX_PCI_EPS + 1] = { 0 };
  218. /*
  219. * Count the number of pci nodes.
  220. * It's needed later when the interleaved liodn offsets are generated.
  221. */
  222. off = fdt_node_offset_by_compatible(fdt, -1, compat);
  223. while (off != -FDT_ERR_NOTFOUND) {
  224. pci_cnt++;
  225. off = fdt_node_offset_by_compatible(fdt, off, compat);
  226. }
  227. for (off = fdt_node_offset_by_compatible(fdt, -1, compat);
  228. off != -FDT_ERR_NOTFOUND;
  229. off = fdt_node_offset_by_compatible(fdt, off, compat)) {
  230. base_liodn = fdt_getprop(fdt, off, "fsl,liodn", &rc);
  231. if (!base_liodn) {
  232. char path[64];
  233. if (fdt_get_path(fdt, off, path, sizeof(path)) < 0)
  234. strcpy(path, "(unknown)");
  235. printf("WARNING Could not get liodn of node %s: %s\n",
  236. path, fdt_strerror(rc));
  237. continue;
  238. }
  239. for (i = 0; i < CONFIG_SYS_MAX_PCI_EPS; i++)
  240. liodn_offs[i + 1] = ep_liodn_start +
  241. i * pci_cnt + pci_idx - *base_liodn;
  242. rc = fdt_setprop(fdt, off, "fsl,liodn-offset-list",
  243. liodn_offs, sizeof(liodn_offs));
  244. if (rc) {
  245. char path[64];
  246. if (fdt_get_path(fdt, off, path, sizeof(path)) < 0)
  247. strcpy(path, "(unknown)");
  248. printf("WARNING Unable to set fsl,liodn-offset-list for "
  249. "node %s: %s\n", path, fdt_strerror(rc));
  250. continue;
  251. }
  252. pci_idx++;
  253. }
  254. }
  255. static void fdt_fixup_liodn_tbl(void *blob, struct liodn_id_table *tbl, int sz)
  256. {
  257. int i;
  258. for (i = 0; i < sz; i++) {
  259. int off;
  260. if (tbl[i].compat == NULL)
  261. continue;
  262. off = fdt_node_offset_by_compat_reg(blob,
  263. tbl[i].compat, tbl[i].compat_offset);
  264. if (off >= 0) {
  265. off = fdt_setprop(blob, off, "fsl,liodn",
  266. &tbl[i].id[0],
  267. sizeof(u32) * tbl[i].num_ids);
  268. if (off > 0)
  269. printf("WARNING unable to set fsl,liodn for "
  270. "%s: %s\n",
  271. tbl[i].compat, fdt_strerror(off));
  272. } else {
  273. debug("WARNING: could not set fsl,liodn for %s: %s.\n",
  274. tbl[i].compat, fdt_strerror(off));
  275. }
  276. }
  277. }
  278. #ifdef CONFIG_SYS_DPAA_FMAN
  279. static void fdt_fixup_liodn_tbl_fman(void *blob,
  280. struct fman_liodn_id_table *tbl,
  281. int sz)
  282. {
  283. int i;
  284. for (i = 0; i < sz; i++) {
  285. int off;
  286. if (tbl[i].compat == NULL)
  287. continue;
  288. /* Try the new compatible first.
  289. * If the node is missing, try the old.
  290. */
  291. off = fdt_node_offset_by_compat_reg(blob,
  292. tbl[i].compat[0], tbl[i].compat_offset);
  293. if (off < 0)
  294. off = fdt_node_offset_by_compat_reg(blob,
  295. tbl[i].compat[1], tbl[i].compat_offset);
  296. if (off >= 0) {
  297. off = fdt_setprop(blob, off, "fsl,liodn",
  298. &tbl[i].id[0],
  299. sizeof(u32) * tbl[i].num_ids);
  300. if (off > 0)
  301. printf("WARNING unable to set fsl,liodn for FMan Port: %s\n",
  302. fdt_strerror(off));
  303. } else {
  304. debug("WARNING: could not set fsl,liodn for FMan Portport: %s.\n",
  305. fdt_strerror(off));
  306. }
  307. }
  308. }
  309. #endif
  310. void fdt_fixup_liodn(void *blob)
  311. {
  312. #ifdef CONFIG_SYS_SRIO
  313. fdt_fixup_srio_liodn(blob, srio_liodn_tbl);
  314. #endif
  315. fdt_fixup_liodn_tbl(blob, liodn_tbl, liodn_tbl_sz);
  316. #ifdef CONFIG_SYS_DPAA_FMAN
  317. fdt_fixup_liodn_tbl_fman(blob, fman1_liodn_tbl, fman1_liodn_tbl_sz);
  318. #if (CONFIG_SYS_NUM_FMAN == 2)
  319. fdt_fixup_liodn_tbl_fman(blob, fman2_liodn_tbl, fman2_liodn_tbl_sz);
  320. #endif
  321. #endif
  322. fdt_fixup_liodn_tbl(blob, sec_liodn_tbl, sec_liodn_tbl_sz);
  323. #ifdef CONFIG_SYS_FSL_RAID_ENGINE
  324. fdt_fixup_liodn_tbl(blob, raide_liodn_tbl, raide_liodn_tbl_sz);
  325. #endif
  326. #ifdef CONFIG_SYS_DPAA_RMAN
  327. fdt_fixup_liodn_tbl(blob, rman_liodn_tbl, rman_liodn_tbl_sz);
  328. #endif
  329. ccsr_pcix_t *pcix = (ccsr_pcix_t *)CONFIG_SYS_PCIE1_ADDR;
  330. int pci_ver = pcix->ipver1 & 0xffff, liodn_base = 0;
  331. if (pci_ver >= 0x0204) {
  332. if (pci_ver >= 0x0300)
  333. liodn_base = 1024;
  334. else
  335. liodn_base = 256;
  336. }
  337. if (liodn_base) {
  338. char compat[32];
  339. sprintf(compat, "fsl,qoriq-pcie-v%d.%d",
  340. (pci_ver & 0xff00) >> 8, pci_ver & 0xff);
  341. fdt_fixup_pci_liodn_offsets(blob, compat, liodn_base);
  342. fdt_fixup_pci_liodn_offsets(blob, "fsl,qoriq-pcie", liodn_base);
  343. }
  344. }