pcie_layerscape_fixup_common.c 4.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright 2019-2020 NXP
  4. *
  5. * PCIe DT fixup for NXP Layerscape SoCs
  6. * Author: Wasim Khan <wasim.khan@nxp.com>
  7. *
  8. */
  9. #include <common.h>
  10. #include <init.h>
  11. #include <asm/arch/clock.h>
  12. #include <asm/arch/soc.h>
  13. #include <linux/libfdt.h>
  14. #include "pcie_layerscape_fixup_common.h"
  15. void ft_pci_setup(void *blob, struct bd_info *bd)
  16. {
  17. #if defined(CONFIG_PCIE_LAYERSCAPE_GEN4)
  18. uint svr;
  19. svr = SVR_SOC_VER(get_svr());
  20. if (svr == SVR_LX2160A && IS_SVR_REV(get_svr(), 1, 0))
  21. ft_pci_setup_ls_gen4(blob, bd);
  22. else
  23. #endif /* CONFIG_PCIE_LAYERSCAPE_GEN4 */
  24. ft_pci_setup_ls(blob, bd);
  25. }
  26. #if defined(CONFIG_FSL_LAYERSCAPE)
  27. int lx2_board_fix_fdt(void *fdt)
  28. {
  29. char *reg_name, *old_str, *new_str;
  30. const char *reg_names;
  31. int names_len, old_str_len, new_str_len, remaining_str_len;
  32. struct str_map {
  33. char *old_str;
  34. char *new_str;
  35. } reg_names_map[] = {
  36. { "csr_axi_slave", "regs" },
  37. { "config_axi_slave", "config" }
  38. };
  39. int off = -1, i;
  40. const fdt32_t *prop;
  41. u32 ob_wins, ib_wins;
  42. off = fdt_node_offset_by_compatible(fdt, -1, "fsl,lx2160a-pcie");
  43. while (off != -FDT_ERR_NOTFOUND) {
  44. fdt_setprop(fdt, off, "compatible", "fsl,ls2088a-pcie",
  45. strlen("fsl,ls2088a-pcie") + 1);
  46. reg_names = fdt_getprop(fdt, off, "reg-names", &names_len);
  47. if (!reg_names)
  48. continue;
  49. reg_name = (char *)reg_names;
  50. remaining_str_len = names_len - (reg_name - reg_names);
  51. i = 0;
  52. while ((i < ARRAY_SIZE(reg_names_map)) && remaining_str_len) {
  53. old_str = reg_names_map[i].old_str;
  54. new_str = reg_names_map[i].new_str;
  55. old_str_len = strlen(old_str);
  56. new_str_len = strlen(new_str);
  57. if (memcmp(reg_name, old_str, old_str_len) == 0) {
  58. /* first only leave required bytes for new_str
  59. * and copy rest of the string after it
  60. */
  61. memcpy(reg_name + new_str_len,
  62. reg_name + old_str_len,
  63. remaining_str_len - old_str_len);
  64. /* Now copy new_str */
  65. memcpy(reg_name, new_str, new_str_len);
  66. names_len -= old_str_len;
  67. names_len += new_str_len;
  68. i++;
  69. }
  70. reg_name = memchr(reg_name, '\0', remaining_str_len);
  71. if (!reg_name)
  72. break;
  73. reg_name += 1;
  74. remaining_str_len = names_len - (reg_name - reg_names);
  75. }
  76. fdt_setprop(fdt, off, "reg-names", reg_names, names_len);
  77. fdt_delprop(fdt, off, "apio-wins");
  78. fdt_delprop(fdt, off, "ppio-wins");
  79. off = fdt_node_offset_by_compatible(fdt, off,
  80. "fsl,lx2160a-pcie");
  81. }
  82. /* Fixup PCIe EP nodes */
  83. off = -1;
  84. off = fdt_node_offset_by_compatible(fdt, off, "fsl,lx2160a-pcie-ep");
  85. while (off != -FDT_ERR_NOTFOUND) {
  86. fdt_setprop_string(fdt, off, "compatible",
  87. "fsl,lx2160ar2-pcie-ep");
  88. prop = fdt_getprop(fdt, off, "apio-wins", NULL);
  89. if (!prop) {
  90. printf("%s: Failed to fixup PCIe EP node @0x%x\n",
  91. __func__, off);
  92. off = fdt_node_offset_by_compatible(fdt, off,
  93. "fsl,lx2160a-pcie-ep");
  94. continue;
  95. }
  96. ob_wins = fdt32_to_cpu(*prop);
  97. ib_wins = (ob_wins == 256) ? 24 : 8;
  98. fdt_setprop_u32(fdt, off, "num-ib-windows", ib_wins);
  99. fdt_setprop_u32(fdt, off, "num-ob-windows", ob_wins);
  100. fdt_delprop(fdt, off, "apio-wins");
  101. off = fdt_node_offset_by_compatible(fdt, off,
  102. "fsl,lx2160a-pcie-ep");
  103. }
  104. return 0;
  105. }
  106. int pcie_board_fix_fdt(void *fdt)
  107. {
  108. uint svr;
  109. svr = SVR_SOC_VER(get_svr());
  110. if ((svr == SVR_LX2160A || svr == SVR_LX2162A ||
  111. svr == SVR_LX2120A || svr == SVR_LX2080A ||
  112. svr == SVR_LX2122A || svr == SVR_LX2082A) &&
  113. IS_SVR_REV(get_svr(), 2, 0))
  114. return lx2_board_fix_fdt(fdt);
  115. return 0;
  116. }
  117. #if defined(CONFIG_ARCH_LX2160A) || defined(CONFIG_ARCH_LX2162A)
  118. /* returns the next available streamid for pcie, -errno if failed */
  119. int pcie_next_streamid(int currentid, int idx)
  120. {
  121. if (currentid > FSL_PEX_STREAM_ID_END)
  122. return -EINVAL;
  123. return currentid | ((idx + 1) << 11);
  124. }
  125. #else
  126. /* returns the next available streamid for pcie, -errno if failed */
  127. int pcie_next_streamid(int currentid, int idx)
  128. {
  129. static int next_stream_id = FSL_PEX_STREAM_ID_START;
  130. if (next_stream_id > FSL_PEX_STREAM_ID_END)
  131. return -EINVAL;
  132. return next_stream_id++;
  133. }
  134. #endif
  135. #endif /* CONFIG_FSL_LAYERSCAPE */