p1010_serdes.c 2.2 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright 2011 Freescale Semiconductor, Inc.
  4. * Author: Prabhakar Kushwaha <prabhakar@freescale.com>
  5. */
  6. #include <config.h>
  7. #include <common.h>
  8. #include <asm/io.h>
  9. #include <asm/immap_85xx.h>
  10. #include <asm/fsl_serdes.h>
  11. #define SRDS1_MAX_LANES 4
  12. #define SRDS2_MAX_LANES 2
  13. static u32 serdes1_prtcl_map, serdes2_prtcl_map;
  14. static const u8 serdes1_cfg_tbl[][SRDS1_MAX_LANES] = {
  15. [0x00] = {NONE, NONE, NONE, NONE},
  16. [0x01] = {PCIE1, PCIE2, SGMII_TSEC2, SGMII_TSEC3},
  17. [0x02] = {PCIE1, SGMII_TSEC1, SGMII_TSEC2, SGMII_TSEC3},
  18. [0x03] = {NONE, SGMII_TSEC1, SGMII_TSEC2, SGMII_TSEC3},
  19. };
  20. static const u8 serdes2_cfg_tbl[][SRDS2_MAX_LANES] = {
  21. [0x00] = {NONE, NONE},
  22. [0x01] = {SATA1, SATA2},
  23. [0x02] = {SATA1, SATA2},
  24. [0x03] = {PCIE1, PCIE2},
  25. };
  26. int is_serdes_configured(enum srds_prtcl device)
  27. {
  28. int ret;
  29. if (!(serdes1_prtcl_map & (1 << NONE)))
  30. fsl_serdes_init();
  31. ret = (1 << device) & serdes1_prtcl_map;
  32. if (ret)
  33. return ret;
  34. if (!(serdes2_prtcl_map & (1 << NONE)))
  35. fsl_serdes_init();
  36. return (1 << device) & serdes2_prtcl_map;
  37. }
  38. void fsl_serdes_init(void)
  39. {
  40. ccsr_gur_t *gur = (void *)CONFIG_SYS_MPC85xx_GUTS_ADDR;
  41. u32 pordevsr = in_be32(&gur->pordevsr);
  42. u32 srds_cfg = (pordevsr & MPC85xx_PORDEVSR_IO_SEL) >>
  43. MPC85xx_PORDEVSR_IO_SEL_SHIFT;
  44. int lane;
  45. if (serdes1_prtcl_map & (1 << NONE) &&
  46. serdes2_prtcl_map & (1 << NONE))
  47. return;
  48. debug("PORDEVSR[IO_SEL_SRDS] = %x\n", srds_cfg);
  49. if (srds_cfg >= ARRAY_SIZE(serdes1_cfg_tbl)) {
  50. printf("Invalid PORDEVSR[IO_SEL_SRDS] = %d\n", srds_cfg);
  51. return;
  52. }
  53. for (lane = 0; lane < SRDS1_MAX_LANES; lane++) {
  54. enum srds_prtcl lane_prtcl = serdes1_cfg_tbl[srds_cfg][lane];
  55. serdes1_prtcl_map |= (1 << lane_prtcl);
  56. }
  57. /* Set the first bit to indicate serdes has been initialized */
  58. serdes1_prtcl_map |= (1 << NONE);
  59. if (srds_cfg >= ARRAY_SIZE(serdes2_cfg_tbl)) {
  60. printf("Invalid PORDEVSR[IO_SEL_SRDS] = %d\n", srds_cfg);
  61. return;
  62. }
  63. for (lane = 0; lane < SRDS2_MAX_LANES; lane++) {
  64. enum srds_prtcl lane_prtcl = serdes2_cfg_tbl[srds_cfg][lane];
  65. serdes2_prtcl_map |= (1 << lane_prtcl);
  66. }
  67. /* Set the first bit to indicate serdes has been initialized */
  68. serdes2_prtcl_map |= (1 << NONE);
  69. }