1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * Copyright 2017 NXP 4 */ 5 6 #include <common.h> 7 #include <asm/arch/fsl_serdes.h> 8 9 struct serdes_config { 10 u8 ip_protocol; 11 u8 lanes[SRDS_MAX_LANES]; 12 u8 rcw_lanes[SRDS_MAX_LANES]; 13 }; 14 15 static struct serdes_config serdes1_cfg_tbl[] = { 16 /* SerDes 1 */ 17 {0x12, {SGMII3, SGMII7, SGMII1, SGMII2 }, {3, 3, 3, 3 } }, 18 {0x15, {SGMII3, SGMII7, XFI1, XFI2 }, {3, 3, 1, 1 } }, 19 {0x16, {SGMII3, SGMII7, SGMII1, XFI2 }, {3, 3, 3, 1 } }, 20 {0x17, {SGMII3, SGMII7, SGMII1, SGMII2 }, {3, 3, 3, 2 } }, 21 {0x18, {SGMII3, SGMII7, SGMII1, SGMII2 }, {3, 3, 2, 2 } }, 22 {0x19, {SGMII3, QSGMII_B, XFI1, XFI2}, {3, 4, 1, 1 } }, 23 {0x1A, {SGMII3, QSGMII_B, SGMII1, XFI2 }, {3, 4, 3, 1 } }, 24 {0x1B, {SGMII3, QSGMII_B, SGMII1, SGMII2 }, {3, 4, 3, 2 } }, 25 {0x1C, {SGMII3, QSGMII_B, SGMII1, SGMII2 }, {3, 4, 2, 2 } }, 26 {0x1D, {QSGMII_A, QSGMII_B, XFI1, XFI2 }, {4, 4, 1, 1 } }, 27 {0x1E, {QSGMII_A, QSGMII_B, SGMII1, XFI2 }, {4, 4, 3, 1 } }, 28 {0x1F, {QSGMII_A, QSGMII_B, SGMII1, SGMII2 }, {4, 4, 3, 2 } }, 29 {0x20, {QSGMII_A, QSGMII_B, SGMII1, SGMII2 }, {4, 4, 2, 2 } }, 30 {0x35, {SGMII3, QSGMII_B, SGMII1, SGMII2 }, {3, 4, 3, 3 } }, 31 {0x36, {QSGMII_A, QSGMII_B, SGMII1, SGMII2 }, {4, 4, 3, 3 } }, 32 {0x3A, {SGMII3, PCIE1, SGMII1, SGMII2 }, {3, 5, 3, 3 } }, 33 {} 34 }; 35 static struct serdes_config serdes2_cfg_tbl[] = { 36 /* SerDes 2 */ 37 {0x0C, {PCIE1, PCIE1, PCIE1, PCIE1 }, {8, 8, 8, 8 } }, 38 {0x0D, {PCIE1, PCIE2, PCIE3, SATA1 }, {5, 5, 5, 9 } }, 39 {0x0E, {PCIE1, PCIE1, PCIE2, SATA1 }, {7, 7, 6, 9 } }, 40 {0x13, {PCIE1, PCIE1, PCIE3, PCIE3 }, {7, 7, 7, 7 } }, 41 {0x14, {PCIE1, PCIE2, PCIE3, PCIE3 }, {5, 5, 7, 7 } }, 42 {0x3C, {NONE, PCIE2, NONE, PCIE3 }, {0, 5, 0, 6 } }, 43 {} 44 }; 45 46 static struct serdes_config *serdes_cfg_tbl[] = { 47 serdes1_cfg_tbl, 48 serdes2_cfg_tbl, 49 }; 50 51 int serdes_get_number(int serdes, int cfg) 52 { 53 struct serdes_config *ptr; 54 int i, j, index, lnk; 55 int is_found, max_lane = SRDS_MAX_LANES; 56 57 if (serdes >= ARRAY_SIZE(serdes_cfg_tbl)) 58 return 0; 59 60 ptr = serdes_cfg_tbl[serdes]; 61 62 while (ptr->ip_protocol) { 63 is_found = 1; 64 for (i = 0, j = max_lane - 1; i < max_lane; i++, j--) { 65 lnk = cfg & (0xf << 4 * i); 66 lnk = lnk >> (4 * i); 67 68 index = (serdes == FSL_SRDS_1) ? j : i; 69 70 if (ptr->rcw_lanes[index] == lnk && is_found) 71 is_found = 1; 72 else 73 is_found = 0; 74 } 75 76 if (is_found) 77 return ptr->ip_protocol; 78 ptr++; 79 } 80 81 return 0; 82 } 83 84 enum srds_prtcl serdes_get_prtcl(int serdes, int cfg, int lane) 85 { 86 struct serdes_config *ptr; 87 88 if (serdes >= ARRAY_SIZE(serdes_cfg_tbl)) 89 return 0; 90 91 ptr = serdes_cfg_tbl[serdes]; 92 while (ptr->ip_protocol) { 93 if (ptr->ip_protocol == cfg) 94 return ptr->lanes[lane]; 95 ptr++; 96 } 97 98 return 0; 99 } 100 101 int is_serdes_prtcl_valid(int serdes, u32 prtcl) 102 { 103 int i; 104 struct serdes_config *ptr; 105 106 if (serdes >= ARRAY_SIZE(serdes_cfg_tbl)) 107 return 0; 108 109 ptr = serdes_cfg_tbl[serdes]; 110 while (ptr->ip_protocol) { 111 if (ptr->ip_protocol == prtcl) 112 break; 113 ptr++; 114 } 115 116 if (!ptr->ip_protocol) 117 return 0; 118 119 for (i = 0; i < SRDS_MAX_LANES; i++) { 120 if (ptr->lanes[i] != NONE) 121 return 1; 122 } 123 124 return 0; 125 } 126