1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
26d9b82d0SAshish Kumar /*
36d9b82d0SAshish Kumar * Copyright 2017 NXP
46d9b82d0SAshish Kumar */
56d9b82d0SAshish Kumar
66d9b82d0SAshish Kumar #include <common.h>
76d9b82d0SAshish Kumar #include <asm/arch/fsl_serdes.h>
86d9b82d0SAshish Kumar
96d9b82d0SAshish Kumar struct serdes_config {
106d9b82d0SAshish Kumar u8 ip_protocol;
116d9b82d0SAshish Kumar u8 lanes[SRDS_MAX_LANES];
126d9b82d0SAshish Kumar u8 rcw_lanes[SRDS_MAX_LANES];
136d9b82d0SAshish Kumar };
146d9b82d0SAshish Kumar
156d9b82d0SAshish Kumar static struct serdes_config serdes1_cfg_tbl[] = {
166d9b82d0SAshish Kumar /* SerDes 1 */
176d9b82d0SAshish Kumar {0x12, {SGMII3, SGMII7, SGMII1, SGMII2 }, {3, 3, 3, 3 } },
186d9b82d0SAshish Kumar {0x15, {SGMII3, SGMII7, XFI1, XFI2 }, {3, 3, 1, 1 } },
196d9b82d0SAshish Kumar {0x16, {SGMII3, SGMII7, SGMII1, XFI2 }, {3, 3, 3, 1 } },
206d9b82d0SAshish Kumar {0x17, {SGMII3, SGMII7, SGMII1, SGMII2 }, {3, 3, 3, 2 } },
216d9b82d0SAshish Kumar {0x18, {SGMII3, SGMII7, SGMII1, SGMII2 }, {3, 3, 2, 2 } },
226d9b82d0SAshish Kumar {0x19, {SGMII3, QSGMII_B, XFI1, XFI2}, {3, 4, 1, 1 } },
236d9b82d0SAshish Kumar {0x1A, {SGMII3, QSGMII_B, SGMII1, XFI2 }, {3, 4, 3, 1 } },
246d9b82d0SAshish Kumar {0x1B, {SGMII3, QSGMII_B, SGMII1, SGMII2 }, {3, 4, 3, 2 } },
256d9b82d0SAshish Kumar {0x1C, {SGMII3, QSGMII_B, SGMII1, SGMII2 }, {3, 4, 2, 2 } },
266d9b82d0SAshish Kumar {0x1D, {QSGMII_A, QSGMII_B, XFI1, XFI2 }, {4, 4, 1, 1 } },
276d9b82d0SAshish Kumar {0x1E, {QSGMII_A, QSGMII_B, SGMII1, XFI2 }, {4, 4, 3, 1 } },
286d9b82d0SAshish Kumar {0x1F, {QSGMII_A, QSGMII_B, SGMII1, SGMII2 }, {4, 4, 3, 2 } },
296d9b82d0SAshish Kumar {0x20, {QSGMII_A, QSGMII_B, SGMII1, SGMII2 }, {4, 4, 2, 2 } },
306d9b82d0SAshish Kumar {0x35, {SGMII3, QSGMII_B, SGMII1, SGMII2 }, {3, 4, 3, 3 } },
316d9b82d0SAshish Kumar {0x36, {QSGMII_A, QSGMII_B, SGMII1, SGMII2 }, {4, 4, 3, 3 } },
326d9b82d0SAshish Kumar {0x3A, {SGMII3, PCIE1, SGMII1, SGMII2 }, {3, 5, 3, 3 } },
336d9b82d0SAshish Kumar {}
346d9b82d0SAshish Kumar };
356d9b82d0SAshish Kumar static struct serdes_config serdes2_cfg_tbl[] = {
366d9b82d0SAshish Kumar /* SerDes 2 */
376d9b82d0SAshish Kumar {0x0C, {PCIE1, PCIE1, PCIE1, PCIE1 }, {8, 8, 8, 8 } },
386d9b82d0SAshish Kumar {0x0D, {PCIE1, PCIE2, PCIE3, SATA1 }, {5, 5, 5, 9 } },
396d9b82d0SAshish Kumar {0x0E, {PCIE1, PCIE1, PCIE2, SATA1 }, {7, 7, 6, 9 } },
406d9b82d0SAshish Kumar {0x13, {PCIE1, PCIE1, PCIE3, PCIE3 }, {7, 7, 7, 7 } },
416d9b82d0SAshish Kumar {0x14, {PCIE1, PCIE2, PCIE3, PCIE3 }, {5, 5, 7, 7 } },
426d9b82d0SAshish Kumar {0x3C, {NONE, PCIE2, NONE, PCIE3 }, {0, 5, 0, 6 } },
436d9b82d0SAshish Kumar {}
446d9b82d0SAshish Kumar };
456d9b82d0SAshish Kumar
466d9b82d0SAshish Kumar static struct serdes_config *serdes_cfg_tbl[] = {
476d9b82d0SAshish Kumar serdes1_cfg_tbl,
486d9b82d0SAshish Kumar serdes2_cfg_tbl,
496d9b82d0SAshish Kumar };
506d9b82d0SAshish Kumar
serdes_get_number(int serdes,int cfg)516d9b82d0SAshish Kumar int serdes_get_number(int serdes, int cfg)
526d9b82d0SAshish Kumar {
536d9b82d0SAshish Kumar struct serdes_config *ptr;
546d9b82d0SAshish Kumar int i, j, index, lnk;
556d9b82d0SAshish Kumar int is_found, max_lane = SRDS_MAX_LANES;
566d9b82d0SAshish Kumar
576d9b82d0SAshish Kumar if (serdes >= ARRAY_SIZE(serdes_cfg_tbl))
586d9b82d0SAshish Kumar return 0;
596d9b82d0SAshish Kumar
606d9b82d0SAshish Kumar ptr = serdes_cfg_tbl[serdes];
616d9b82d0SAshish Kumar
626d9b82d0SAshish Kumar while (ptr->ip_protocol) {
636d9b82d0SAshish Kumar is_found = 1;
646d9b82d0SAshish Kumar for (i = 0, j = max_lane - 1; i < max_lane; i++, j--) {
656d9b82d0SAshish Kumar lnk = cfg & (0xf << 4 * i);
666d9b82d0SAshish Kumar lnk = lnk >> (4 * i);
676d9b82d0SAshish Kumar
686d9b82d0SAshish Kumar index = (serdes == FSL_SRDS_1) ? j : i;
696d9b82d0SAshish Kumar
706d9b82d0SAshish Kumar if (ptr->rcw_lanes[index] == lnk && is_found)
716d9b82d0SAshish Kumar is_found = 1;
726d9b82d0SAshish Kumar else
736d9b82d0SAshish Kumar is_found = 0;
746d9b82d0SAshish Kumar }
756d9b82d0SAshish Kumar
766d9b82d0SAshish Kumar if (is_found)
776d9b82d0SAshish Kumar return ptr->ip_protocol;
786d9b82d0SAshish Kumar ptr++;
796d9b82d0SAshish Kumar }
806d9b82d0SAshish Kumar
816d9b82d0SAshish Kumar return 0;
826d9b82d0SAshish Kumar }
836d9b82d0SAshish Kumar
serdes_get_prtcl(int serdes,int cfg,int lane)846d9b82d0SAshish Kumar enum srds_prtcl serdes_get_prtcl(int serdes, int cfg, int lane)
856d9b82d0SAshish Kumar {
866d9b82d0SAshish Kumar struct serdes_config *ptr;
876d9b82d0SAshish Kumar
886d9b82d0SAshish Kumar if (serdes >= ARRAY_SIZE(serdes_cfg_tbl))
896d9b82d0SAshish Kumar return 0;
906d9b82d0SAshish Kumar
916d9b82d0SAshish Kumar ptr = serdes_cfg_tbl[serdes];
926d9b82d0SAshish Kumar while (ptr->ip_protocol) {
936d9b82d0SAshish Kumar if (ptr->ip_protocol == cfg)
946d9b82d0SAshish Kumar return ptr->lanes[lane];
956d9b82d0SAshish Kumar ptr++;
966d9b82d0SAshish Kumar }
976d9b82d0SAshish Kumar
986d9b82d0SAshish Kumar return 0;
996d9b82d0SAshish Kumar }
1006d9b82d0SAshish Kumar
is_serdes_prtcl_valid(int serdes,u32 prtcl)1016d9b82d0SAshish Kumar int is_serdes_prtcl_valid(int serdes, u32 prtcl)
1026d9b82d0SAshish Kumar {
1036d9b82d0SAshish Kumar int i;
1046d9b82d0SAshish Kumar struct serdes_config *ptr;
1056d9b82d0SAshish Kumar
1066d9b82d0SAshish Kumar if (serdes >= ARRAY_SIZE(serdes_cfg_tbl))
1076d9b82d0SAshish Kumar return 0;
1086d9b82d0SAshish Kumar
1096d9b82d0SAshish Kumar ptr = serdes_cfg_tbl[serdes];
1106d9b82d0SAshish Kumar while (ptr->ip_protocol) {
1116d9b82d0SAshish Kumar if (ptr->ip_protocol == prtcl)
1126d9b82d0SAshish Kumar break;
1136d9b82d0SAshish Kumar ptr++;
1146d9b82d0SAshish Kumar }
1156d9b82d0SAshish Kumar
1166d9b82d0SAshish Kumar if (!ptr->ip_protocol)
1176d9b82d0SAshish Kumar return 0;
1186d9b82d0SAshish Kumar
1196d9b82d0SAshish Kumar for (i = 0; i < SRDS_MAX_LANES; i++) {
1206d9b82d0SAshish Kumar if (ptr->lanes[i] != NONE)
1216d9b82d0SAshish Kumar return 1;
1226d9b82d0SAshish Kumar }
1236d9b82d0SAshish Kumar
1246d9b82d0SAshish Kumar return 0;
1256d9b82d0SAshish Kumar }
126