// SPDX-License-Identifier: GPL-2.0+ /* * Copyright 2010 Freescale Semiconductor, Inc. */ #include #include #include #include #include #include #define SRDS1_MAX_LANES 8 #define SRDS2_MAX_LANES 4 static u32 serdes1_prtcl_map, serdes2_prtcl_map; static u8 serdes1_cfg_tbl[][SRDS1_MAX_LANES] = { [0x2] = {PCIE1, PCIE1, PCIE1, PCIE1, NONE, NONE, NONE, NONE}, [0x3] = {PCIE1, PCIE1, PCIE1, PCIE1, NONE, NONE, NONE, NONE}, [0x4] = {PCIE1, PCIE1, PCIE1, PCIE1, PCIE2, PCIE2, PCIE2, PCIE2}, [0x5] = {PCIE1, PCIE1, PCIE1, PCIE1, PCIE2, PCIE2, PCIE2, PCIE2}, [0x6] = {PCIE1, PCIE1, PCIE1, PCIE1, PCIE2, PCIE2, PCIE2, PCIE2}, [0x7] = {PCIE1, PCIE1, PCIE1, PCIE1, PCIE2, PCIE2, PCIE2, PCIE2}, }; static u8 serdes2_cfg_tbl[][SRDS2_MAX_LANES] = { [0x1] = {NONE, NONE, SGMII_TSEC1, SGMII_TSEC3}, [0x3] = {NONE, NONE, SGMII_TSEC1, SGMII_TSEC3}, [0x5] = {NONE, NONE, SGMII_TSEC1, SGMII_TSEC3}, [0x6] = {PCIE3, NONE, NONE, NONE}, [0x7] = {PCIE3, NONE, SGMII_TSEC1, SGMII_TSEC3}, }; int is_serdes_configured(enum srds_prtcl device) { int ret; if (!(serdes1_prtcl_map & (1 << NONE))) fsl_serdes_init(); ret = (1 << device) & serdes1_prtcl_map; if (ret) return ret; if (!(serdes2_prtcl_map & (1 << NONE))) fsl_serdes_init(); return (1 << device) & serdes2_prtcl_map; } void fsl_serdes_init(void) { ccsr_gur_t *gur = (void *)CFG_SYS_MPC85xx_GUTS_ADDR; u32 pordevsr = in_be32(&gur->pordevsr); u32 srds_cfg = (pordevsr & MPC85xx_PORDEVSR_IO_SEL) >> MPC85xx_PORDEVSR_IO_SEL_SHIFT; int lane; if (serdes1_prtcl_map & (1 << NONE) && serdes2_prtcl_map & (1 << NONE)) return; debug("PORDEVSR[IO_SEL_SRDS] = %x\n", srds_cfg); if (srds_cfg >= ARRAY_SIZE(serdes1_cfg_tbl)) { printf("Invalid PORDEVSR[IO_SEL_SRDS] = %d\n", srds_cfg); return; } for (lane = 0; lane < SRDS1_MAX_LANES; lane++) { enum srds_prtcl lane_prtcl = serdes1_cfg_tbl[srds_cfg][lane]; serdes1_prtcl_map |= (1 << lane_prtcl); } /* Set the first bit to indicate serdes has been initialized */ serdes1_prtcl_map |= (1 << NONE); if (srds_cfg >= ARRAY_SIZE(serdes2_cfg_tbl)) { printf("Invalid PORDEVSR[IO_SEL_SRDS] = %d\n", srds_cfg); return; } for (lane = 0; lane < SRDS2_MAX_LANES; lane++) { enum srds_prtcl lane_prtcl = serdes2_cfg_tbl[srds_cfg][lane]; serdes2_prtcl_map |= (1 << lane_prtcl); } if (pordevsr & MPC85xx_PORDEVSR_SGMII1_DIS) serdes2_prtcl_map &= ~(1 << SGMII_TSEC1); if (pordevsr & MPC85xx_PORDEVSR_SGMII3_DIS) serdes2_prtcl_map &= ~(1 << SGMII_TSEC3); /* Set the first bit to indicate serdes has been initialized */ serdes2_prtcl_map |= (1 << NONE); }