1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
2b7f2bbffSPrabhakar Kushwaha /*
3b7f2bbffSPrabhakar Kushwaha * Copyright 2016 Freescale Semiconductor, Inc.
4b7f2bbffSPrabhakar Kushwaha */
5b7f2bbffSPrabhakar Kushwaha
6b7f2bbffSPrabhakar Kushwaha #include <common.h>
7b7f2bbffSPrabhakar Kushwaha #include <asm/arch/fsl_serdes.h>
8b7f2bbffSPrabhakar Kushwaha #include <asm/arch/immap_lsch2.h>
9b7f2bbffSPrabhakar Kushwaha
10b7f2bbffSPrabhakar Kushwaha struct serdes_config {
11b7f2bbffSPrabhakar Kushwaha u32 protocol;
12b7f2bbffSPrabhakar Kushwaha u8 lanes[SRDS_MAX_LANES];
13b7f2bbffSPrabhakar Kushwaha };
14b7f2bbffSPrabhakar Kushwaha
15b7f2bbffSPrabhakar Kushwaha static struct serdes_config serdes1_cfg_tbl[] = {
16b7f2bbffSPrabhakar Kushwaha {0x2208, {SGMII_2500_FM1_DTSEC1, SGMII_2500_FM1_DTSEC2, NONE, SATA1} },
17b7f2bbffSPrabhakar Kushwaha {0x0008, {NONE, NONE, NONE, SATA1} },
18b7f2bbffSPrabhakar Kushwaha {0x3508, {SGMII_FM1_DTSEC1, PCIE1, NONE, SATA1} },
19b7f2bbffSPrabhakar Kushwaha {0x3305, {SGMII_FM1_DTSEC1, SGMII_FM1_DTSEC2, NONE, PCIE1} },
20b7f2bbffSPrabhakar Kushwaha {0x2205, {SGMII_2500_FM1_DTSEC1, SGMII_2500_FM1_DTSEC2, NONE, PCIE1} },
21b7f2bbffSPrabhakar Kushwaha {0x2305, {SGMII_2500_FM1_DTSEC1, SGMII_FM1_DTSEC2, NONE, PCIE1} },
22b7f2bbffSPrabhakar Kushwaha {0x9508, {TX_CLK, PCIE1, NONE, SATA1} },
23b7f2bbffSPrabhakar Kushwaha {0x3905, {SGMII_FM1_DTSEC1, TX_CLK, NONE, PCIE1} },
24b7f2bbffSPrabhakar Kushwaha {0x9305, {TX_CLK, SGMII_FM1_DTSEC2, NONE, PCIE1} },
25b7f2bbffSPrabhakar Kushwaha {}
26b7f2bbffSPrabhakar Kushwaha };
27b7f2bbffSPrabhakar Kushwaha
28b7f2bbffSPrabhakar Kushwaha static struct serdes_config *serdes_cfg_tbl[] = {
29b7f2bbffSPrabhakar Kushwaha serdes1_cfg_tbl,
30b7f2bbffSPrabhakar Kushwaha };
31b7f2bbffSPrabhakar Kushwaha
serdes_get_prtcl(int serdes,int cfg,int lane)32b7f2bbffSPrabhakar Kushwaha enum srds_prtcl serdes_get_prtcl(int serdes, int cfg, int lane)
33b7f2bbffSPrabhakar Kushwaha {
34b7f2bbffSPrabhakar Kushwaha struct serdes_config *ptr;
35b7f2bbffSPrabhakar Kushwaha
36b7f2bbffSPrabhakar Kushwaha if (serdes >= ARRAY_SIZE(serdes_cfg_tbl))
37b7f2bbffSPrabhakar Kushwaha return 0;
38b7f2bbffSPrabhakar Kushwaha
39b7f2bbffSPrabhakar Kushwaha ptr = serdes_cfg_tbl[serdes];
40b7f2bbffSPrabhakar Kushwaha while (ptr->protocol) {
41b7f2bbffSPrabhakar Kushwaha if (ptr->protocol == cfg)
42b7f2bbffSPrabhakar Kushwaha return ptr->lanes[lane];
43b7f2bbffSPrabhakar Kushwaha ptr++;
44b7f2bbffSPrabhakar Kushwaha }
45b7f2bbffSPrabhakar Kushwaha
46b7f2bbffSPrabhakar Kushwaha return 0;
47b7f2bbffSPrabhakar Kushwaha }
48b7f2bbffSPrabhakar Kushwaha
is_serdes_prtcl_valid(int serdes,u32 prtcl)49b7f2bbffSPrabhakar Kushwaha int is_serdes_prtcl_valid(int serdes, u32 prtcl)
50b7f2bbffSPrabhakar Kushwaha {
51b7f2bbffSPrabhakar Kushwaha int i;
52b7f2bbffSPrabhakar Kushwaha struct serdes_config *ptr;
53b7f2bbffSPrabhakar Kushwaha
54b7f2bbffSPrabhakar Kushwaha if (serdes >= ARRAY_SIZE(serdes_cfg_tbl))
55b7f2bbffSPrabhakar Kushwaha return 0;
56b7f2bbffSPrabhakar Kushwaha
57b7f2bbffSPrabhakar Kushwaha ptr = serdes_cfg_tbl[serdes];
58b7f2bbffSPrabhakar Kushwaha while (ptr->protocol) {
59b7f2bbffSPrabhakar Kushwaha if (ptr->protocol == prtcl)
60b7f2bbffSPrabhakar Kushwaha break;
61b7f2bbffSPrabhakar Kushwaha ptr++;
62b7f2bbffSPrabhakar Kushwaha }
63b7f2bbffSPrabhakar Kushwaha
64b7f2bbffSPrabhakar Kushwaha if (!ptr->protocol)
65b7f2bbffSPrabhakar Kushwaha return 0;
66b7f2bbffSPrabhakar Kushwaha
67b7f2bbffSPrabhakar Kushwaha for (i = 0; i < SRDS_MAX_LANES; i++) {
68b7f2bbffSPrabhakar Kushwaha if (ptr->lanes[i] != NONE)
69b7f2bbffSPrabhakar Kushwaha return 1;
70b7f2bbffSPrabhakar Kushwaha }
71b7f2bbffSPrabhakar Kushwaha
72b7f2bbffSPrabhakar Kushwaha return 0;
73b7f2bbffSPrabhakar Kushwaha }
74