Yuantian Tang | 4aefa16 | 2019-04-10 16:43:33 +0800 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
| 2 | /* |
| 3 | * Copyright 2019 NXP |
| 4 | */ |
| 5 | |
| 6 | #include <common.h> |
| 7 | #include <asm/arch/fsl_serdes.h> |
| 8 | |
| 9 | struct serdes_config { |
| 10 | u32 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 | {0xCC5B, {PCIE1, QSGMII_B, PCIE2, PCIE2} }, |
| 18 | {0xEB99, {SGMII1, SGMII1, PCIE2, SATA1} }, |
| 19 | {0xCC99, {SGMII1, SGMII1, PCIE2, PCIE2} }, |
| 20 | {0xBB99, {SGMII1, SGMII1, PCIE2, PCIE1} }, |
| 21 | {0x9999, {SGMII1, SGMII2, SGMII3, SGMII4} }, |
| 22 | {0xEBCC, {PCIE1, PCIE1, PCIE2, SATA1} }, |
| 23 | {0xCCCC, {PCIE1, PCIE1, PCIE2, PCIE2} }, |
| 24 | {0xDDDD, {PCIE1, PCIE1, PCIE1, PCIE1} }, |
| 25 | {} |
| 26 | }; |
| 27 | |
| 28 | static struct serdes_config *serdes_cfg_tbl[] = { |
| 29 | serdes1_cfg_tbl, |
| 30 | }; |
| 31 | |
| 32 | enum srds_prtcl serdes_get_prtcl(int serdes, int cfg, int lane) |
| 33 | { |
| 34 | struct serdes_config *ptr; |
| 35 | |
| 36 | if (serdes >= ARRAY_SIZE(serdes_cfg_tbl)) |
| 37 | return 0; |
| 38 | |
| 39 | ptr = serdes_cfg_tbl[serdes]; |
| 40 | while (ptr->protocol) { |
| 41 | if (ptr->protocol == cfg) |
| 42 | return ptr->lanes[lane]; |
| 43 | ptr++; |
| 44 | } |
| 45 | |
| 46 | return 0; |
| 47 | } |
| 48 | |
| 49 | int is_serdes_prtcl_valid(int serdes, u32 prtcl) |
| 50 | { |
| 51 | int i; |
| 52 | struct serdes_config *ptr; |
| 53 | |
| 54 | if (serdes >= ARRAY_SIZE(serdes_cfg_tbl)) |
| 55 | return 0; |
| 56 | |
| 57 | ptr = serdes_cfg_tbl[serdes]; |
| 58 | while (ptr->protocol) { |
| 59 | if (ptr->protocol == prtcl) |
| 60 | break; |
| 61 | ptr++; |
| 62 | } |
| 63 | |
| 64 | if (!ptr->protocol) |
| 65 | return 0; |
| 66 | |
| 67 | for (i = 0; i < SRDS_MAX_LANES; i++) { |
| 68 | if (ptr->lanes[i] != NONE) |
| 69 | return 1; |
| 70 | } |
| 71 | |
| 72 | return 0; |
| 73 | } |