qe: fixup the snum for MPC8569 Rev2.0

Since 1.0 and 2.0 use different snum table,
we fixup the snum value according to SPRN_SVR.

Signed-off-by: Liu Yu <yu.liu@freescale.com>
Signed-off-by: Kumar Gala <galak@kernel.crashing.org>

diff --git a/cpu/mpc85xx/fdt.c b/cpu/mpc85xx/fdt.c
index af0e78e07f7e53af304ec36274721089cced2ac9..1d11ab470f85c1141bfe743fe0985e7500cf0a79 100644 (file)
--- a/cpu/mpc85xx/fdt.c
+++ b/cpu/mpc85xx/fdt.c
@@ -331,6 +331,23 @@ static void ft_fixup_dpaa_clks(void *blob)
 #define ft_fixup_dpaa_clks(x)
 #endif
 
+#ifdef CONFIG_QE
+static void ft_fixup_qe_snum(void *blob)
+{
+       unsigned int svr;
+
+       svr = mfspr(SPRN_SVR);
+       if (SVR_SOC_VER(svr) == SVR_8569_E) {
+               if(IS_SVR_REV(svr, 1, 0))
+                       do_fixup_by_compat_u32(blob, "fsl,qe",
+                               "fsl,qe-num-snums", 46, 1);
+               else
+                       do_fixup_by_compat_u32(blob, "fsl,qe",
+                               "fsl,qe-num-snums", 76, 1);
+       }
+}
+#endif
+
 void ft_cpu_setup(void *blob, bd_t *bd)
 {
        int off;
@@ -367,6 +384,7 @@ void ft_cpu_setup(void *blob, bd_t *bd)
                "bus-frequency", gd->lbc_clk, 1);
 #ifdef CONFIG_QE
        ft_qe_setup(blob);
+       ft_fixup_qe_snum(blob);
 #endif
 
 #ifdef CONFIG_SYS_NS16550