Kconfig: Add CONFIG_SATA to enable SATA

[oweals/u-boot.git] / arch / powerpc / cpu / mpc85xx / p2041_serdes.c

diff --git a/arch/powerpc/cpu/mpc85xx/p2041_serdes.c b/arch/powerpc/cpu/mpc85xx/p2041_serdes.c
index 83bc82feed8000c40547c45635469c65c6157256..f278549cbf65d0d1f84af30f1326048c80f2f7e2 100644 (file)
--- a/arch/powerpc/cpu/mpc85xx/p2041_serdes.c
+++ b/arch/powerpc/cpu/mpc85xx/p2041_serdes.c
@@ -1,23 +1,7 @@
 /*
  * Copyright 2010-2011 Freescale Semiconductor, Inc.
  *
- * See file CREDITS for list of people who contributed to this
- * project.
- *
- * This program is free software; you can redistribute it and/or
- * modify it under the terms of the GNU General Public License as
- * published by the Free Software Foundation; either version 2 of
- * the License, or (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
- * MA 02111-1307 USA
+ * SPDX-License-Identifier:    GPL-2.0+
  */
 
 #include <common.h>
@@ -37,8 +21,8 @@ static u8 serdes_cfg_tbl[][SRDS_MAX_LANES] = {
                PCIE2, PCIE2, PCIE2, NONE, NONE, NONE, NONE, SATA1,
                SATA2, NONE, NONE, NONE, NONE, },
        [0x9] = {NONE, NONE, SGMII_FM1_DTSEC1, SGMII_FM1_DTSEC2, PCIE2,
-               PCIE2, PCIE2, PCIE2, NONE, NONE, NONE, NONE,
-               NONE, NONE, NONE, NONE, NONE, NONE, },
+               PCIE2, PCIE2, PCIE2, NONE, NONE, XAUI_FM1, XAUI_FM1,
+               XAUI_FM1, XAUI_FM1, NONE, NONE, NONE, NONE, },
        [0xa] = {NONE, NONE, SGMII_FM1_DTSEC1, SGMII_FM1_DTSEC2, PCIE2,
                PCIE2, PCIE2, PCIE2, NONE, NONE, PCIE3, PCIE3, PCIE3,
                PCIE3, NONE, NONE, NONE, NONE, },
@@ -53,8 +37,8 @@ static u8 serdes_cfg_tbl[][SRDS_MAX_LANES] = {
                SGMII_FM1_DTSEC4, NONE, NONE, NONE, NONE, SATA1, SATA2, NONE,
                NONE, NONE, NONE, },
        [0x17] = {NONE, NONE, PCIE1, PCIE3, PCIE2, PCIE2, SGMII_FM1_DTSEC3,
-               SGMII_FM1_DTSEC4, NONE, NONE, NONE, NONE, NONE,
-               NONE, NONE, NONE, NONE, NONE, },
+               SGMII_FM1_DTSEC4, NONE, NONE, XAUI_FM1, XAUI_FM1, XAUI_FM1,
+               XAUI_FM1, NONE, NONE, NONE, NONE, },
        [0x19] = {NONE, NONE, SGMII_FM1_DTSEC1, SGMII_FM1_DTSEC2, PCIE2,
                PCIE2, SGMII_FM1_DTSEC3, SGMII_FM1_DTSEC4, NONE, NONE,
                NONE, NONE, SATA1, SATA2, NONE, NONE, NONE, NONE, },
@@ -68,17 +52,33 @@ static u8 serdes_cfg_tbl[][SRDS_MAX_LANES] = {
 
 enum srds_prtcl serdes_get_prtcl(int cfg, int lane)
 {
+       enum srds_prtcl prtcl;
+       u32 svr = get_svr();
+       u32 ver = SVR_SOC_VER(svr);
+
        if (!serdes_lane_enabled(lane))
                return NONE;
 
-       return serdes_cfg_tbl[cfg][lane];
+       prtcl = serdes_cfg_tbl[cfg][lane];
+
+       /* P2040[e] does not support XAUI */
+       if (ver == SVR_P2040 && prtcl == XAUI_FM1)
+               prtcl = NONE;
+
+       return prtcl;
 }
 
 int is_serdes_prtcl_valid(u32 prtcl)
 {
        int i;
+       u32 svr = get_svr();
+       u32 ver = SVR_SOC_VER(svr);
+
+       if (prtcl >= ARRAY_SIZE(serdes_cfg_tbl))
+               return 0;
 
-       if (prtcl > ARRAY_SIZE(serdes_cfg_tbl))
+       /* P2040[e] does not support XAUI */
+       if (ver == SVR_P2040 && prtcl == XAUI_FM1)
                return 0;
 
        for (i = 0; i < SRDS_MAX_LANES; i++) {