pcie_layerscape_fixup_common.c 3.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124
  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 <asm/arch/clock.h>
  11. #include <asm/arch/soc.h>
  12. #include "pcie_layerscape_fixup_common.h"
  13. void ft_pci_setup(void *blob, bd_t *bd)
  14. {
  15. #if defined(CONFIG_PCIE_LAYERSCAPE_GEN4)
  16. uint svr;
  17. svr = SVR_SOC_VER(get_svr());
  18. if (svr == SVR_LX2160A && IS_SVR_REV(get_svr(), 1, 0))
  19. ft_pci_setup_ls_gen4(blob, bd);
  20. else
  21. #endif /* CONFIG_PCIE_LAYERSCAPE_GEN4 */
  22. ft_pci_setup_ls(blob, bd);
  23. }
  24. #if defined(CONFIG_FSL_LAYERSCAPE)
  25. int lx2_board_fix_fdt(void *fdt)
  26. {
  27. char *reg_name, *old_str, *new_str;
  28. const char *reg_names;
  29. int names_len, old_str_len, new_str_len, remaining_str_len;
  30. struct str_map {
  31. char *old_str;
  32. char *new_str;
  33. } reg_names_map[] = {
  34. { "csr_axi_slave", "regs" },
  35. { "config_axi_slave", "config" }
  36. };
  37. int off = -1, i;
  38. off = fdt_node_offset_by_compatible(fdt, -1, "fsl,lx2160a-pcie");
  39. while (off != -FDT_ERR_NOTFOUND) {
  40. fdt_setprop(fdt, off, "compatible", "fsl,ls2088a-pcie",
  41. strlen("fsl,ls2088a-pcie") + 1);
  42. reg_names = fdt_getprop(fdt, off, "reg-names", &names_len);
  43. if (!reg_names)
  44. continue;
  45. reg_name = (char *)reg_names;
  46. remaining_str_len = names_len - (reg_name - reg_names);
  47. i = 0;
  48. while ((i < ARRAY_SIZE(reg_names_map)) && remaining_str_len) {
  49. old_str = reg_names_map[i].old_str;
  50. new_str = reg_names_map[i].new_str;
  51. old_str_len = strlen(old_str);
  52. new_str_len = strlen(new_str);
  53. if (memcmp(reg_name, old_str, old_str_len) == 0) {
  54. /* first only leave required bytes for new_str
  55. * and copy rest of the string after it
  56. */
  57. memcpy(reg_name + new_str_len,
  58. reg_name + old_str_len,
  59. remaining_str_len - old_str_len);
  60. /* Now copy new_str */
  61. memcpy(reg_name, new_str, new_str_len);
  62. names_len -= old_str_len;
  63. names_len += new_str_len;
  64. i++;
  65. }
  66. reg_name = memchr(reg_name, '\0', remaining_str_len);
  67. if (!reg_name)
  68. break;
  69. reg_name += 1;
  70. remaining_str_len = names_len - (reg_name - reg_names);
  71. }
  72. fdt_setprop(fdt, off, "reg-names", reg_names, names_len);
  73. fdt_delprop(fdt, off, "apio-wins");
  74. fdt_delprop(fdt, off, "ppio-wins");
  75. off = fdt_node_offset_by_compatible(fdt, off,
  76. "fsl,lx2160a-pcie");
  77. }
  78. return 0;
  79. }
  80. int pcie_board_fix_fdt(void *fdt)
  81. {
  82. uint svr;
  83. svr = SVR_SOC_VER(get_svr());
  84. if (svr == SVR_LX2160A && IS_SVR_REV(get_svr(), 2, 0))
  85. return lx2_board_fix_fdt(fdt);
  86. return 0;
  87. }
  88. #ifdef CONFIG_ARCH_LX2160A
  89. /* returns the next available streamid for pcie, -errno if failed */
  90. int pcie_next_streamid(int currentid, int idx)
  91. {
  92. if (currentid > FSL_PEX_STREAM_ID_END)
  93. return -EINVAL;
  94. return currentid | ((idx + 1) << 11);
  95. }
  96. #else
  97. /* returns the next available streamid for pcie, -errno if failed */
  98. int pcie_next_streamid(int currentid, int idx)
  99. {
  100. static int next_stream_id = FSL_PEX_STREAM_ID_START;
  101. if (next_stream_id > FSL_PEX_STREAM_ID_END)
  102. return -EINVAL;
  103. return next_stream_id++;
  104. }
  105. #endif
  106. #endif /* CONFIG_FSL_LAYERSCAPE */