1
2
3
4
5
6
7
8#include <config.h>
9#include <common.h>
10#include <asm/io.h>
11#include <asm/immap_85xx.h>
12#include <asm/fsl_serdes.h>
13
14#define SRDS1_MAX_LANES 4
15
16static u32 serdes1_prtcl_map;
17
18static u8 serdes1_cfg_tbl[][SRDS1_MAX_LANES] = {
19 [0] = {NONE, NONE, NONE, NONE},
20 [1] = {PCIE1, PCIE2, CPRI2, CPRI1},
21 [2] = {PCIE1, PCIE2, CPRI2, CPRI1},
22 [3] = {PCIE1, PCIE2, CPRI2, CPRI1},
23 [4] = {PCIE1, PCIE2, CPRI2, CPRI1},
24 [5] = {PCIE1, PCIE2, CPRI2, CPRI1},
25 [6] = {PCIE1, PCIE2, SGMII_TSEC1, CPRI1},
26 [7] = {PCIE1, PCIE2, SGMII_TSEC1, CPRI1},
27 [8] = {PCIE1, PCIE2, SGMII_TSEC1, CPRI1},
28 [9] = {PCIE1, PCIE2, SGMII_TSEC1, CPRI1},
29 [10] = {PCIE1, PCIE2, SGMII_TSEC1, CPRI1},
30 [11] = {PCIE1, PCIE2, SGMII_TSEC1, SGMII_TSEC2},
31 [12] = {PCIE1, SGMII_TSEC2, CPRI2, CPRI1},
32 [13] = {PCIE1, SGMII_TSEC2, CPRI2, CPRI1},
33 [14] = {PCIE1, SGMII_TSEC2, CPRI2, CPRI1},
34 [15] = {PCIE1, SGMII_TSEC2, CPRI2, CPRI1},
35 [16] = {PCIE1, SGMII_TSEC2, CPRI2, CPRI1},
36 [17] = {PCIE1, SGMII_TSEC2, SGMII_TSEC1, CPRI1},
37 [18] = {PCIE1, SGMII_TSEC2, SGMII_TSEC1, CPRI1},
38 [19] = {PCIE1, SGMII_TSEC2, SGMII_TSEC1, CPRI1},
39 [20] = {PCIE1, SGMII_TSEC2, SGMII_TSEC1, CPRI1},
40 [21] = {PCIE1, SGMII_TSEC2, SGMII_TSEC1, CPRI1},
41 [22] = {PCIE1, PCIE2, CPRI2, CPRI1},
42 [23] = {PCIE1, PCIE2, CPRI2, CPRI1},
43 [24] = {PCIE1, PCIE2, CPRI2, CPRI1},
44 [25] = {PCIE1, PCIE2, CPRI2, CPRI1},
45 [26] = {PCIE1, PCIE2, CPRI2, CPRI1},
46 [27] = {PCIE1, PCIE2, SGMII_TSEC1, CPRI1},
47 [28] = {PCIE1, PCIE2, SGMII_TSEC1, CPRI1},
48 [29] = {PCIE1, PCIE2, SGMII_TSEC1, CPRI1},
49 [30] = {PCIE1, PCIE2, SGMII_TSEC1, CPRI1},
50 [31] = {PCIE1, PCIE2, SGMII_TSEC1, CPRI1},
51 [32] = {PCIE1, PCIE2, SGMII_TSEC1, SGMII_TSEC2},
52 [33] = {PCIE1, SGMII_TSEC2, CPRI2, CPRI1},
53 [34] = {PCIE1, SGMII_TSEC2, CPRI2, CPRI1},
54 [35] = {PCIE1, SGMII_TSEC2, CPRI2, CPRI1},
55 [36] = {PCIE1, SGMII_TSEC2, CPRI2, CPRI1},
56 [37] = {PCIE1, SGMII_TSEC2, CPRI2, CPRI1},
57 [38] = {PCIE1, SGMII_TSEC2, SGMII_TSEC1, CPRI1},
58 [39] = {PCIE1, SGMII_TSEC2, SGMII_TSEC1, CPRI1},
59 [40] = {PCIE1, SGMII_TSEC2, SGMII_TSEC1, CPRI1},
60 [41] = {PCIE1, SGMII_TSEC2, SGMII_TSEC1, CPRI1},
61 [42] = {PCIE1, SGMII_TSEC2, SGMII_TSEC1, CPRI1},
62 [43] = {SGMII_TSEC1, SGMII_TSEC2, CPRI2, CPRI1},
63 [44] = {SGMII_TSEC1, SGMII_TSEC2, CPRI2, CPRI1},
64 [45] = {SGMII_TSEC1, SGMII_TSEC2, CPRI2, CPRI1},
65 [46] = {SGMII_TSEC1, SGMII_TSEC2, CPRI2, CPRI1},
66 [47] = {SGMII_TSEC1, SGMII_TSEC2, CPRI2, CPRI1},
67};
68
69int is_serdes_configured(enum srds_prtcl prtcl)
70{
71 if (!(serdes1_prtcl_map & (1 << NONE)))
72 fsl_serdes_init();
73
74 return (1 << prtcl) & serdes1_prtcl_map;
75}
76
77void fsl_serdes_init(void)
78{
79 ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
80 u32 pordevsr = in_be32(&gur->pordevsr);
81 u32 srds_cfg = (pordevsr & MPC85xx_PORDEVSR_IO_SEL) >>
82 MPC85xx_PORDEVSR_IO_SEL_SHIFT;
83 int lane;
84
85 if (serdes1_prtcl_map & (1 << NONE))
86 return;
87
88 debug("PORDEVSR[IO_SEL_SRDS] = %x\n", srds_cfg);
89
90 if (srds_cfg >= ARRAY_SIZE(serdes1_cfg_tbl)) {
91 printf("Invalid PORDEVSR[IO_SEL_SRDS] = %d\n", srds_cfg);
92 return;
93 }
94
95 for (lane = 0; lane < SRDS1_MAX_LANES; lane++) {
96 enum srds_prtcl lane_prtcl = serdes1_cfg_tbl[srds_cfg][lane];
97 serdes1_prtcl_map |= (1 << lane_prtcl);
98 }
99
100
101 serdes1_prtcl_map |= (1 << NONE);
102}
103