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