arm: socfpga: Enable all FPGA config support for Arria 10
[platform/kernel/u-boot.git] / arch / arm / mach-uniphier / dram / umc-ld20.c
index 1fdd119..500c1c1 100644 (file)
@@ -1,24 +1,24 @@
 /*
- * Copyright (C) 2016 Socionext Inc.
+ * Copyright (C) 2016-2017 Socionext Inc.
  *
- * based on commit a3c28918e86ad57127cf07bf8b32950cab20c03c of Diag
+ * based on commit 5ffd75ecd4929f22361ef65a35f0331d2fbc0f35 of Diag
  *
  * SPDX-License-Identifier:    GPL-2.0+
  */
 
 #include <common.h>
 #include <linux/bitops.h>
-#include <linux/err.h>
+#include <linux/compat.h>
+#include <linux/errno.h>
 #include <linux/io.h>
 #include <linux/sizes.h>
 #include <asm/processor.h>
 
 #include "../init.h"
-#include "ddrphy-ld20-regs.h"
+#include "ddruqphy-regs.h"
 #include "umc64-regs.h"
 
 #define DRAM_CH_NR     3
-#define CONFIG_DDR_FREQ                1866
 
 enum dram_freq {
        DRAM_FREQ_1866M,
@@ -34,418 +34,306 @@ enum dram_size {
 enum dram_board {              /* board type */
        DRAM_BOARD_LD20_REF,    /* LD20 reference */
        DRAM_BOARD_LD20_GLOBAL, /* LD20 TV */
+       DRAM_BOARD_LD20_C1,     /* LD20 TV C1 */
        DRAM_BOARD_LD21_REF,    /* LD21 reference */
        DRAM_BOARD_LD21_GLOBAL, /* LD21 TV */
        DRAM_BOARD_NR,
 };
 
-#define MSK_PHY_LANE_SEL               0x000000FF
-#define MSK_BIT_SEL                    0x00000F00
-#define MSK_DLL_MAS_DLY                        0xFF000000
-#define MSK_MAS_DLY                    0x7F000000
-#define MSK_DLLS_TRIM_CLK              0x000000FF
-
-#define PHY_DLL_MAS_DLY_WIDTH          8
-#define PHY_SLV_DLY_WIDTH              6
-
-static void ddrphy_maskwritel(u32 data, u32 mask, void *addr)
-{
-       u32 value;
-
-       value = (readl(addr) & ~mask) | (data & mask);
-       writel(value, addr);
-}
-
-static u32 ddrphy_maskreadl(u32 mask, void *addr)
-{
-       return readl(addr) & mask;
-}
-
-/* set phy_lane_sel.phy_lane_sel */
-static void ddrphy_set_phy_lane_sel(int val, void __iomem *phy_base)
-{
-       ddrphy_maskwritel(val, MSK_PHY_LANE_SEL, phy_base + PHY_LANE_SEL);
-}
-
-/* set phy_lane_sel.bit_sel */
-static void ddrphy_set_bit_sel(int bit, void __iomem *phy_base)
-{
-       ddrphy_maskwritel(bit << 8, MSK_BIT_SEL, phy_base + PHY_LANE_SEL);
-}
-
-/* Calculating step for PUB-byte */
-static int ddrphy_hpstep(int delay, void __iomem *phy_base)
-{
-       int mdl, freq;
-
-       freq = CONFIG_DDR_FREQ; /* FIXME */
-       mdl = ddrphy_maskreadl(MSK_DLL_MAS_DLY, phy_base + PHY_DLL_ADRCTRL) >> 24;
-
-       return DIV_ROUND_CLOSEST(freq * delay * mdl, 2 * 1000000);
-}
-
-static void ddrphy_set_dll_trim_clk(int delay_ckoffset,  void __iomem *phy_base)
-{
-       u8 ck_step;     /* ckoffset_step for clock */
-       u32 ck_step_all;
-
-       /* CK-Offset */
-       if (delay_ckoffset >= 0) {
-               /* shift + direction */
-               ck_step = min(ddrphy_hpstep(delay_ckoffset, phy_base), 127);
-               ck_step_all = ((0x1<<(PHY_SLV_DLY_WIDTH + 1))|ck_step);
-       } else{
-               /* shift - direction */
-               ck_step = min(ddrphy_hpstep(-1*delay_ckoffset, phy_base), 127);
-               ck_step_all = ck_step;
-       }
-
-       ddrphy_set_phy_lane_sel(0, phy_base);
-       ddrphy_maskwritel(ck_step_all, MSK_DLLS_TRIM_CLK, phy_base + PHY_DLL_TRIM_CLK);
-}
-
-static void ddrphy_set_dll_recalib(int delay_qoffset, u32 recalib_cnt,
-                                  u8 disable_recalib, u8 ctr_start_val,
-                                  void __iomem *phy_base)
-{
-       u8 dlls_trim_adrctrl_ma, incr_dly_adrctrl_ma; /* qoffset_step and flag for inc/dec */
-       u32 recalib_all;        /* all fields of register dll_recalib */
-
-       /* Q-Offset */
-       if (delay_qoffset >= 0) {
-               dlls_trim_adrctrl_ma = min(ddrphy_hpstep(delay_qoffset, phy_base), 63);
-               incr_dly_adrctrl_ma = 0x1;
-       } else {
-               dlls_trim_adrctrl_ma = min(ddrphy_hpstep(-1*delay_qoffset, phy_base), 63);
-               incr_dly_adrctrl_ma = 0x0;
-       }
-
-       recalib_all = ((ctr_start_val & 0xf) << 28) |
-                       (incr_dly_adrctrl_ma << 27) |
-                       ((disable_recalib & 0x1) << 26) |
-                       ((recalib_cnt & 0x3ffff) << 8) |
-                       (dlls_trim_adrctrl_ma & 0x3f);
-
-       /* write value for all bits other than bit[7:6] */
-       ddrphy_maskwritel(recalib_all, ~0xc0, phy_base + PHY_DLL_RECALIB);
-}
-
-static void ddrphy_set_dll_adrctrl(int delay_qoffset, u8 override_adrctrl,
-                                  void __iomem *phy_base)
-{
-       u8 dlls_trim_adrctrl, incr_dly_adrctrl; /* qoffset_step for clock */
-       u32 adrctrl_all;
-
-       if (delay_qoffset >= 0) {
-               dlls_trim_adrctrl = min(ddrphy_hpstep(delay_qoffset, phy_base), 63);
-               incr_dly_adrctrl = 0x1;
-       } else {
-               dlls_trim_adrctrl = min(ddrphy_hpstep(-delay_qoffset, phy_base), 63);
-               incr_dly_adrctrl = 0x0;
-       }
-
-       adrctrl_all = (incr_dly_adrctrl << 9) |
-                       ((override_adrctrl & 0x1) << 8) |
-                       dlls_trim_adrctrl;
-
-       ddrphy_maskwritel(adrctrl_all, 0x33f, phy_base + PHY_DLL_ADRCTRL);
-}
-
-/* dio */
-static int dio_adrctrl_0[DRAM_BOARD_NR][DRAM_CH_NR] = {
-       {268-262, 268-263, 268-378},            /* LD20 reference */
-       {268-262, 268-263, 268-378},            /* LD20 TV */
-       {268-212, 268-268, 0},                  /* LD21 reference */
-       {268-212, 268-268, 0},                  /* LD21 TV */
+/* PHY */
+static const int ddrphy_adrctrl[DRAM_BOARD_NR][DRAM_CH_NR] = {
+       {268 - 262, 268 - 263, 268 - 378},      /* LD20 reference */
+       {268 - 262, 268 - 263, 268 - 378},      /* LD20 TV */
+       {268 - 262, 268 - 263, 268 - 378},      /* LD20 TV C1 */
+       {268 - 212, 268 - 268, /* No CH2 */},   /* LD21 reference */
+       {268 - 212, 268 - 268, /* No CH2 */},   /* LD21 TV */
 };
-static int dio_dlltrimclk_0[DRAM_BOARD_NR][DRAM_CH_NR] = {
+
+static const int ddrphy_dlltrimclk[DRAM_BOARD_NR][DRAM_CH_NR] = {
        {268, 268, 268},                        /* LD20 reference */
        {268, 268, 268},                        /* LD20 TV */
-       {268, 268+252, 0},                      /* LD21 reference */
-       {268, 268+202, 0},                      /* LD21 TV */
+       {189, 189, 189},                        /* LD20 TV C1 */
+       {268, 268 + 252, /* No CH2 */},         /* LD21 reference */
+       {268, 268 + 202, /* No CH2 */},         /* LD21 TV */
 };
-static int dio_dllrecalib_0[DRAM_BOARD_NR][DRAM_CH_NR] = {
-       {268-378, 268-263, 268-378},            /* LD20 reference */
-       {268-378, 268-263, 268-378},            /* LD20 TV */
-       {268-212, 268-536, 0},                  /* LD21 reference */
-       {268-212, 268-536, 0},                  /* LD21 TV */
+
+static const int ddrphy_dllrecalib[DRAM_BOARD_NR][DRAM_CH_NR] = {
+       {268 - 378, 268 - 263, 268 - 378},      /* LD20 reference */
+       {268 - 378, 268 - 263, 268 - 378},      /* LD20 TV */
+       {268 - 378, 268 - 263, 268 - 378},      /* LD20 TV C1 */
+       {268 - 212, 268 - 536, /* No CH2 */},   /* LD21 reference */
+       {268 - 212, 268 - 536, /* No CH2 */},   /* LD21 TV */
 };
 
-static u32 dio_phy_pad_ctrl[DRAM_BOARD_NR][DRAM_CH_NR] = {
+static const u32 ddrphy_phy_pad_ctrl[DRAM_BOARD_NR][DRAM_CH_NR] = {
        {0x50B840B1, 0x50B840B1, 0x50B840B1},   /* LD20 reference */
        {0x50BB40B1, 0x50BB40B1, 0x50BB40B1},   /* LD20 TV */
-       {0x50BB40B4, 0x50B840B1, 0x50BB40B1},   /* LD21 reference */
-       {0x50BB40B4, 0x50B840B1, 0x50BB40B1},   /* LD21 TV */
+       {0x50BB40B1, 0x50BB40B1, 0x50BB40B1},   /* LD20 TV C1 */
+       {0x50BB40B4, 0x50B840B1, /* No CH2 */}, /* LD21 reference */
+       {0x50BB40B4, 0x50B840B1, /* No CH2 */}, /* LD21 TV */
 };
 
-static u32 dio_scl_gate_timing[DRAM_CH_NR] = {0x00000140, 0x00000180, 0x00000140};
-
-static int dio_op_dq_shift_val[DRAM_BOARD_NR][DRAM_CH_NR][32] = {
-       { /* LD20 reference */
-               {
-                       2, 1, 0, 1, 2, 1, 1, 1, 2, 1, 1, 2, 1, 1, 1, 1,
-                       1, 2, 1, 1, 1, 2, 1, 1, 2, 2, 0, 1, 1, 2, 2, 1,
-               },
-               {
-                       1, 1, 0, 1, 2, 2, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
-                       1, 1, 0, 0, 1, 1, 0, 0, 0, 1, 1, 1, 2, 1, 2, 1,
-               },
-               {
-                       2, 2, 0, 2, 1, 1, 2, 1, 1, 1, 0, 1, 1, -1, 1, 1,
-                       2, 2, 2, 2, 1, 1, 1, 1, 1, 1, 1, 0, 2, 2, 1, 2,
-               },
-       },
-       { /* LD20 TV */
-               {
-                       2, 1, 0, 1, 2, 1, 1, 1, 2, 1, 1, 2, 1, 1, 1, 1,
-                       1, 2, 1, 1, 1, 2, 1, 1, 2, 2, 0, 1, 1, 2, 2, 1,
-               },
-               {
-                       1, 1, 0, 1, 2, 2, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
-                       1, 1, 0, 0, 1, 1, 0, 0, 0, 1, 1, 1, 2, 1, 2, 1,
-               },
-               {
-                       2, 2, 0, 2, 1, 1, 2, 1, 1, 1, 0, 1, 1, -1, 1, 1,
-                       2, 2, 2, 2, 1, 1, 1, 1, 1, 1, 1, 0, 2, 2, 1, 2,
-               },
+static const u32 ddrphy_scl_gate_timing[DRAM_CH_NR] = {
+       0x00000140, 0x00000180, 0x00000140
+};
+
+static const short ddrphy_op_dq_shift_val_ld20[DRAM_CH_NR][32] = {
+       {
+               2, 1, 0, 1, 2, 1, 1, 1,
+               2, 1, 1, 2, 1, 1, 1, 1,
+               1, 2, 1, 1, 1, 2, 1, 1,
+               2, 2, 0, 1, 1, 2, 2, 1,
        },
-       { /* LD21 reference */
-               {
-                       1, 1, 0, 1, 1, 1, 1, 1, 1, 0, 0, 0, 1, 1, 0, 2,
-                       1, 1, 0, 0, 1, 1, 1, 1, 1, 0, 0, 0, 1, 0, 0, 1,
-               },
-               {       1, 0, 2, 1, 1, 1, 1, 0, 1, 0, 0, 1, 0, 1, 0, 0,
-                       1, 0, 1, 0, 1, 1, 1, 0, 1, 1, 1, 1, 0, 1, 0, 0,
-               },
-               {       0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
-                       0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
-               },
+       {
+               1, 1, 0, 1, 2, 2, 1, 1,
+               1, 1, 1, 1, 1, 1, 1, 1,
+               1, 1, 0, 0, 1, 1, 0, 0,
+               0, 1, 1, 1, 2, 1, 2, 1,
        },
-       { /* LD21 TV */
-               {
-                       1, 1, 0, 1, 1, 1, 1, 1, 1, 0, 0, 0, 1, 1, 0, 2,
-                       1, 1, 0, 0, 1, 1, 1, 1, 1, 0, 0, 0, 1, 0, 0, 1,
-               },
-               {       1, 0, 2, 1, 1, 1, 1, 0, 1, 0, 0, 1, 0, 1, 0, 0,
-                       1, 0, 1, 0, 1, 1, 1, 0, 1, 1, 1, 1, 0, 1, 0, 0,
-               },
-               {       0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
-                       0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
-               },
+       {
+               2, 2, 0, 2, 1, 1, 2, 1,
+               1, 1, 0, 1, 1, -1, 1, 1,
+               2, 2, 2, 2, 1, 1, 1, 1,
+               1, 1, 1, 0, 2, 2, 1, 2,
        },
 };
-static int dio_ip_dq_shift_val[DRAM_BOARD_NR][DRAM_CH_NR][32] = {
-       { /* LD20 reference */
-               {
-                       3, 3, 3, 2, 3, 2, 0, 2, 2, 3, 3, 1, 2, 2, 2, 2,
-                       2, 2, 2, 2, 0, 1, 1, 1, 2, 2, 2, 2, 3, 0, 2, 2,
-               },
-               {
-                       2, 2, 1, 1, -1, 1, 1, 1, 2, 0, 2, 2, 2, 1, 0, 2,
-                       2, 1, 2, 1, 0, 1, 1, 1, 2, 2, 2, 2, 2, 2, 2, 2,
-               },
-               {
-                       2, 2, 3, 2, 1, 2, 2, 2, 2, 3, 4, 2, 3, 4, 3, 3,
-                       2, 2, 1, 2, 1, 1, 1, 1, 2, 2, 2, 2, 1, 2, 2, 1,
-               },
-       },
-       { /* LD20 TV */
-               {
-                       3, 3, 3, 2, 3, 2, 0, 2, 2, 3, 3, 1, 2, 2, 2, 2,
-                       2, 2, 2, 2, 0, 1, 1, 1, 2, 2, 2, 2, 3, 0, 2, 2,
-               },
-               {
-                       2, 2, 1, 1, -1, 1, 1, 1, 2, 0, 2, 2, 2, 1, 0, 2,
-                       2, 1, 2, 1, 0, 1, 1, 1, 2, 2, 2, 2, 2, 2, 2, 2,
-               },
-               {
-                       2, 2, 3, 2, 1, 2, 2, 2, 2, 3, 4, 2, 3, 4, 3, 3,
-                       2, 2, 1, 2, 1, 1, 1, 1, 2, 2, 2, 2, 1, 2, 2, 1,
-               },
-       },
-       { /* LD21 reference */
-               {
-                       2, 2, 2, 2, 1, 2, 2, 2, 2, 3, 3, 2, 2, 2, 2, 2,
-                       2, 1, 2, 2, 1, 1, 1, 1, 2, 2, 2, 3, 1, 2, 2, 2,
-               },
-               {
-                       3, 4, 4, 1, 0, 1, 1, 1, 1, 2, 1, 2, 2, 3, 3, 2,
-                       1, 0, 2, 1, 1, 0, 1, 0, 0, 1, 0, 0, 1, 1, 0, 1,
-               },
-               {
-                       0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
-                       0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
-               },
+
+static const short ddrphy_op_dq_shift_val_ld21[DRAM_CH_NR][32] = {
+       {
+               1, 1, 0, 1, 1, 1, 1, 1,
+               1, 0, 0, 0, 1, 1, 0, 2,
+               1, 1, 0, 0, 1, 1, 1, 1,
+               1, 0, 0, 0, 1, 0, 0, 1,
        },
-       { /* LD21 TV */
-               {
-                       2, 2, 2, 2, 1, 2, 2, 2, 2, 3, 3, 2, 2, 2, 2, 2,
-                       2, 1, 2, 2, 1, 1, 1, 1, 2, 2, 2, 3, 1, 2, 2, 2,
-               },
-               {
-                       3, 4, 4, 1, 0, 1, 1, 1, 1, 2, 1, 2, 2, 3, 3, 2,
-                       1, 0, 2, 1, 1, 0, 1, 0, 0, 1, 0, 0, 1, 1, 0, 1,
-               },
-               {
-                       0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
-                       0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
-               },
+       {       1, 0, 2, 1, 1, 1, 1, 0,
+               1, 0, 0, 1, 0, 1, 0, 0,
+               1, 0, 1, 0, 1, 1, 1, 0,
+               1, 1, 1, 1, 0, 1, 0, 0,
        },
+       /* No CH2 */
 };
 
-/* umc */
-static u32 umc_initctla[DRAM_FREQ_NR] = {0x71016D11};
-static u32 umc_initctlb[DRAM_FREQ_NR] = {0x07E390AC};
-static u32 umc_initctlc[DRAM_FREQ_NR] = {0x00FF00FF};
-static u32 umc_drmmr0[DRAM_FREQ_NR] = {0x00000114};
-static u32 umc_drmmr2[DRAM_FREQ_NR] = {0x000002a0};
-
-static u32 umc_memconf0a[DRAM_FREQ_NR][DRAM_SZ_NR] = {
-       /*  256MB       512MB */
-       {0x00000601, 0x00000801},       /* 1866 MHz */
-};
-static u32 umc_memconf0b[DRAM_FREQ_NR][DRAM_SZ_NR] = {
-       /*  256MB       512MB */
-       {0x00000120, 0x00000130},       /* 1866 MHz */
+static const short (* const ddrphy_op_dq_shift_val[DRAM_BOARD_NR])[32] = {
+       ddrphy_op_dq_shift_val_ld20,    /* LD20 reference */
+       ddrphy_op_dq_shift_val_ld20,    /* LD20 TV */
+       ddrphy_op_dq_shift_val_ld20,    /* LD20 TV C */
+       ddrphy_op_dq_shift_val_ld21,    /* LD21 reference */
+       ddrphy_op_dq_shift_val_ld21,    /* LD21 TV */
 };
-static u32 umc_memconfch[DRAM_FREQ_NR][DRAM_SZ_NR] = {
-       /*  256MB       512MB */
-       {0x00033603, 0x00033803},       /* 1866 MHz */
-};
-static u32 umc_cmdctla[DRAM_FREQ_NR] = {0x060D0D20};
-static u32 umc_cmdctlb[DRAM_FREQ_NR] = {0x2D211C08};
-static u32 umc_cmdctlc[DRAM_FREQ_NR] = {0x00150C04};
-static u32 umc_cmdctle[DRAM_FREQ_NR][DRAM_SZ_NR] = {
-       /*  256MB       512MB */
-       {0x0049071D, 0x0078071D},       /* 1866 MHz */
+
+static const short ddrphy_ip_dq_shift_val_ld20[DRAM_CH_NR][32] = {
+       {
+               3, 3, 3, 2, 3, 2, 0, 2,
+               2, 3, 3, 1, 2, 2, 2, 2,
+               2, 2, 2, 2, 0, 1, 1, 1,
+               2, 2, 2, 2, 3, 0, 2, 2,
+       },
+       {
+               2, 2, 1, 1, -1, 1, 1, 1,
+               2, 0, 2, 2, 2, 1, 0, 2,
+               2, 1, 2, 1, 0, 1, 1, 1,
+               2, 2, 2, 2, 2, 2, 2, 2,
+       },
+       {
+               2, 2, 3, 2, 1, 2, 2, 2,
+               2, 3, 4, 2, 3, 4, 3, 3,
+               2, 2, 1, 2, 1, 1, 1, 1,
+               2, 2, 2, 2, 1, 2, 2, 1,
+       },
 };
 
-static u32 umc_rdatactl_d0[DRAM_FREQ_NR] = {0x00000610};
-static u32 umc_rdatactl_d1[DRAM_FREQ_NR] = {0x00000610};
-static u32 umc_wdatactl_d0[DRAM_FREQ_NR] = {0x00000204};
-static u32 umc_wdatactl_d1[DRAM_FREQ_NR] = {0x00000204};
-static u32 umc_odtctl_d0[DRAM_FREQ_NR] = {0x02000002};
-static u32 umc_odtctl_d1[DRAM_FREQ_NR] = {0x02000002};
-static u32 umc_dataset[DRAM_FREQ_NR] = {0x04000000};
+static const short ddrphy_ip_dq_shift_val_ld21[DRAM_CH_NR][32] = {
+       {
+               2, 2, 2, 2, 1, 2, 2, 2,
+               2, 3, 3, 2, 2, 2, 2, 2,
+               2, 1, 2, 2, 1, 1, 1, 1,
+               2, 2, 2, 3, 1, 2, 2, 2,
+       },
+       {
+               3, 4, 4, 1, 0, 1, 1, 1,
+               1, 2, 1, 2, 2, 3, 3, 2,
+               1, 0, 2, 1, 1, 0, 1, 0,
+               0, 1, 0, 0, 1, 1, 0, 1,
+       },
+       /* No CH2 */
+};
 
-static u32 umc_flowctla[DRAM_FREQ_NR] = {0x0081E01E};
-static u32 umc_directbusctrla[DRAM_CH_NR] = {
-       0x00000000, 0x00000001, 0x00000001
+static const short (* const ddrphy_ip_dq_shift_val[DRAM_BOARD_NR])[32] = {
+       ddrphy_ip_dq_shift_val_ld20,    /* LD20 reference */
+       ddrphy_ip_dq_shift_val_ld20,    /* LD20 TV */
+       ddrphy_ip_dq_shift_val_ld20,    /* LD20 TV C */
+       ddrphy_ip_dq_shift_val_ld21,    /* LD21 reference */
+       ddrphy_ip_dq_shift_val_ld21,    /* LD21 TV */
 };
 
-/* polling function for PHY Init Complete */
-static void ddrphy_init_complete(void __iomem *dc_base)
+static void ddrphy_select_lane(void __iomem *phy_base, unsigned int lane,
+                              unsigned int bit)
 {
-       /* Wait for PHY Init Complete */
-       while (!(readl(dc_base + UMC_DFISTCTLC) & BIT(0)))
-               cpu_relax();
+       WARN_ON(lane >= 1 << PHY_LANE_SEL_LANE_WIDTH);
+       WARN_ON(bit >= 1 << PHY_LANE_SEL_BIT_WIDTH);
+
+       writel((bit << PHY_LANE_SEL_BIT_SHIFT) |
+              (lane << PHY_LANE_SEL_LANE_SHIFT),
+              phy_base + PHY_LANE_SEL);
 }
 
-/* DDR PHY */
-static void ddrphy_init(void __iomem *phy_base, void __iomem *dc_base,
-                       enum dram_freq freq, enum dram_board board, int ch)
+#define DDRPHY_EFUSEMON                (void *)0x5f900118
+
+static void ddrphy_init(void __iomem *phy_base, enum dram_board board, int ch)
 {
        writel(0x0C001001, phy_base + PHY_UNIQUIFY_TSMC_IO_1);
        while (!(readl(phy_base + PHY_UNIQUIFY_TSMC_IO_1) & BIT(1)))
                cpu_relax();
-       writel(0x0C001000, phy_base + PHY_UNIQUIFY_TSMC_IO_1);
+
+       if (readl(DDRPHY_EFUSEMON) & BIT(ch))
+               writel(0x00000000, phy_base + PHY_UNIQUIFY_TSMC_IO_1);
+       else
+               writel(0x0C001000, phy_base + PHY_UNIQUIFY_TSMC_IO_1);
 
        writel(0x00000000, phy_base + PHY_DLL_INCR_TRIM_3);
        writel(0x00000000, phy_base + PHY_DLL_INCR_TRIM_1);
-       writel(0x00000000, phy_base + PHY_LANE_SEL);
+       ddrphy_select_lane(phy_base, 0, 0);
        writel(0x00000005, phy_base + PHY_DLL_TRIM_1);
        writel(0x0000000a, phy_base + PHY_DLL_TRIM_3);
-       writel(0x00000006, phy_base + PHY_LANE_SEL);
+       ddrphy_select_lane(phy_base, 6, 0);
        writel(0x00000005, phy_base + PHY_DLL_TRIM_1);
        writel(0x0000000a, phy_base + PHY_DLL_TRIM_3);
-       writel(0x0000000c, phy_base + PHY_LANE_SEL);
+       ddrphy_select_lane(phy_base, 12, 0);
        writel(0x00000005, phy_base + PHY_DLL_TRIM_1);
        writel(0x0000000a, phy_base + PHY_DLL_TRIM_3);
-       writel(0x00000012, phy_base + PHY_LANE_SEL);
+       ddrphy_select_lane(phy_base, 18, 0);
        writel(0x00000005, phy_base + PHY_DLL_TRIM_1);
        writel(0x0000000a, phy_base + PHY_DLL_TRIM_3);
        writel(0x00000001, phy_base + PHY_SCL_WINDOW_TRIM);
        writel(0x00000000, phy_base + PHY_UNQ_ANALOG_DLL_1);
-       writel(dio_phy_pad_ctrl[board][ch], phy_base + PHY_PAD_CTRL);
+       writel(ddrphy_phy_pad_ctrl[board][ch], phy_base + PHY_PAD_CTRL);
        writel(0x00000070, phy_base + PHY_VREF_TRAINING);
        writel(0x01000075, phy_base + PHY_SCL_CONFIG_1);
        writel(0x00000501, phy_base + PHY_SCL_CONFIG_2);
        writel(0x00000000, phy_base + PHY_SCL_CONFIG_3);
        writel(0x000261c0, phy_base + PHY_DYNAMIC_WRITE_BIT_LVL);
        writel(0x00000000, phy_base + PHY_SCL_CONFIG_4);
-       writel(dio_scl_gate_timing[ch], phy_base + PHY_SCL_GATE_TIMING);
+       writel(ddrphy_scl_gate_timing[ch], phy_base + PHY_SCL_GATE_TIMING);
        writel(0x02a000a0, phy_base + PHY_WRLVL_DYN_ODT);
        writel(0x00840004, phy_base + PHY_WRLVL_ON_OFF);
        writel(0x0000020d, phy_base + PHY_DLL_ADRCTRL);
-       writel(0x00000000, phy_base + PHY_LANE_SEL);
+       ddrphy_select_lane(phy_base, 0, 0);
        writel(0x0000008d, phy_base + PHY_DLL_TRIM_CLK);
        writel(0xa800100d, phy_base + PHY_DLL_RECALIB);
        writel(0x00005076, phy_base + PHY_SCL_LATENCY);
+}
 
-       ddrphy_init_complete(dc_base);
+static int ddrphy_to_dly_step(void __iomem *phy_base, unsigned int freq,
+                             int delay)
+{
+       int mdl;
 
-       ddrphy_set_dll_adrctrl(dio_adrctrl_0[board][ch], 0, phy_base);
-       ddrphy_set_dll_trim_clk(dio_dlltrimclk_0[board][ch], phy_base);
-       ddrphy_set_dll_recalib(dio_dllrecalib_0[board][ch], 0x10, 0, 0xa,
-                              phy_base);
+       mdl = (readl(phy_base + PHY_DLL_ADRCTRL) & PHY_DLL_ADRCTRL_MDL_MASK) >>
+                                               PHY_DLL_ADRCTRL_MDL_SHIFT;
+
+       return DIV_ROUND_CLOSEST((long)freq * delay * mdl, 2 * 1000000L);
 }
 
-static void ddrphy_shift_dq(u32 reg_mask, u32 reg_addr, int shift_val,
-                           void __iomem *phy_base)
+static void ddrphy_set_delay(void __iomem *phy_base, unsigned int reg,
+                            u32 mask, u32 incr, int dly_step)
 {
-       u32 reg_val;
-       int dq_val;
+       u32 tmp;
 
-       reg_val = ddrphy_maskreadl(reg_mask, phy_base + reg_addr) & 0x7f;
-       dq_val = reg_val & 0x3f;
+       tmp = readl(phy_base + reg);
+       tmp &= ~mask;
+       tmp |= min_t(u32, abs(dly_step), mask);
 
-       if ((reg_val & 0x40) == 0x00)
-               dq_val = -1 * dq_val;
+       if (dly_step >= 0)
+               tmp |= incr;
+       else
+               tmp &= ~incr;
 
-       /* value shift*/
-       dq_val = dq_val + shift_val;
+       writel(tmp, phy_base + reg);
+}
 
-       if (dq_val >= 0)
-               reg_val = 0x40 + (dq_val & 0x3f);
-       else
-               reg_val = ((-1 * dq_val) & 0x3f);
+static void ddrphy_set_dll_recalib(void __iomem *phy_base, int dly_step)
+{
+       ddrphy_set_delay(phy_base, PHY_DLL_RECALIB,
+                        PHY_DLL_RECALIB_TRIM_MASK, PHY_DLL_RECALIB_INCR,
+                        dly_step);
+}
 
-       ddrphy_maskwritel(reg_val, reg_mask, phy_base + reg_addr);
+static void ddrphy_set_dll_adrctrl(void __iomem *phy_base, int dly_step)
+{
+       ddrphy_set_delay(phy_base, PHY_DLL_ADRCTRL,
+                        PHY_DLL_ADRCTRL_TRIM_MASK, PHY_DLL_ADRCTRL_INCR,
+                        dly_step);
 }
 
-static void ddrphy_shift(void __iomem *phy_base, enum dram_board board, int ch)
+static void ddrphy_set_dll_trim_clk(void __iomem *phy_base, int dly_step)
 {
-       u32 dx, bit;
+       ddrphy_select_lane(phy_base, 0, 0);
 
-       /* set override = 1 */
-       ddrphy_maskwritel(MSK_OVERRIDE, MSK_OVERRIDE,
-                         phy_base + PHY_OP_DQ_DM_DQS_BITWISE_TRIM);
-       ddrphy_maskwritel(MSK_OVERRIDE, MSK_OVERRIDE,
-                         phy_base + PHY_IP_DQ_DQS_BITWISE_TRIM);
+       ddrphy_set_delay(phy_base, PHY_DLL_TRIM_CLK,
+                        PHY_DLL_TRIM_CLK_MASK, PHY_DLL_TRIM_CLK_INCR,
+                        dly_step);
+}
 
-       for (dx = 0; dx < 4; dx++) {
-               /* set byte to PHY_LANE_SEL.phy_lane_sel= dx * (PHY_BITLVL_DLY_WIDTH+1) */
-               ddrphy_set_phy_lane_sel(dx * (PHY_BITLVL_DLY_WIDTH + 1),
-                                       phy_base);
+static void ddrphy_init_tail(void __iomem *phy_base, enum dram_board board,
+                            unsigned int freq, int ch)
+{
+       int step;
+
+       step = ddrphy_to_dly_step(phy_base, freq, ddrphy_adrctrl[board][ch]);
+       ddrphy_set_dll_adrctrl(phy_base, step);
+
+       step = ddrphy_to_dly_step(phy_base, freq, ddrphy_dlltrimclk[board][ch]);
+       ddrphy_set_dll_trim_clk(phy_base, step);
+
+       step = ddrphy_to_dly_step(phy_base, freq, ddrphy_dllrecalib[board][ch]);
+       ddrphy_set_dll_recalib(phy_base, step);
+}
+
+static void ddrphy_shift_one_dq(void __iomem *phy_base, unsigned int reg,
+                               u32 mask, u32 incr, short shift_val)
+{
+       u32 tmp;
+       int val;
+
+       tmp = readl(phy_base + reg);
+
+       val = tmp & mask;
+       if (!(tmp & incr))
+               val = -val;
 
+       val += shift_val;
+
+       tmp &= ~(incr | mask);
+       tmp |= min_t(u32, abs(val), mask);
+       if (val >= 0)
+               tmp |= incr;
+
+       writel(tmp, phy_base + reg);
+}
+
+static void ddrphy_shift_dq(void __iomem *phy_base, unsigned int reg,
+                           u32 mask, u32 incr, u32 override,
+                           const short *shift_val_array)
+{
+       u32 tmp;
+       int dx, bit;
+
+       tmp = readl(phy_base + reg);
+       tmp |= override;
+       writel(tmp, phy_base + reg);
+
+       for (dx = 0; dx < 4; dx++) {
                for (bit = 0; bit < 8; bit++) {
-                       ddrphy_set_bit_sel(bit, phy_base);
-
-                       /* shift write reg value*/
-                       ddrphy_shift_dq(MSK_OP_DQ_DM_DQS_BITWISE_TRIM,
-                                       PHY_OP_DQ_DM_DQS_BITWISE_TRIM,
-                                       dio_op_dq_shift_val[board][ch][dx * 8 + bit],
-                                       phy_base);
-                       /* shift read reg value */
-                       ddrphy_shift_dq(MSK_IP_DQ_DQS_BITWISE_TRIM,
-                                       PHY_IP_DQ_DQS_BITWISE_TRIM,
-                                       dio_ip_dq_shift_val[board][ch][dx * 8 + bit],
-                                       phy_base);
-               }
+                       ddrphy_select_lane(phy_base,
+                                          (PHY_BITLVL_DLY_WIDTH + 1) * dx,
+                                          bit);
 
+                       ddrphy_shift_one_dq(phy_base, reg, mask, incr,
+                                           shift_val_array[dx * 8 + bit]);
+               }
        }
-       ddrphy_set_phy_lane_sel(0, phy_base);
-       ddrphy_set_bit_sel(0, phy_base);
+
+       ddrphy_select_lane(phy_base, 0, 0);
 }
 
 static int ddrphy_training(void __iomem *phy_base, enum dram_board board,
@@ -455,7 +343,7 @@ static int ddrphy_training(void __iomem *phy_base, enum dram_board board,
        writel(0x00010000, phy_base + PHY_DLL_TRIM_2);
        writel(0x50000000, phy_base + PHY_SCL_START);
 
-       while (readl(phy_base + PHY_SCL_START) & BIT(28))
+       while (readl(phy_base + PHY_SCL_START) & PHY_SCL_START_GO_DONE)
                cpu_relax();
 
        writel(0x00000000, phy_base + PHY_DISABLE_GATING_FOR_SCL);
@@ -464,13 +352,13 @@ static int ddrphy_training(void __iomem *phy_base, enum dram_board board,
        writel(0xFBF8FFFF, phy_base + PHY_SCL_START_ADDR);
        writel(0x11000000, phy_base + PHY_SCL_START);
 
-       while (readl(phy_base + PHY_SCL_START) & BIT(28))
+       while (readl(phy_base + PHY_SCL_START) & PHY_SCL_START_GO_DONE)
                cpu_relax();
 
        writel(0xFBF0FFFF, phy_base + PHY_SCL_START_ADDR);
        writel(0x30500000, phy_base + PHY_SCL_START);
 
-       while (readl(phy_base + PHY_SCL_START) & BIT(28))
+       while (readl(phy_base + PHY_SCL_START) & PHY_SCL_START_GO_DONE)
                cpu_relax();
 
        writel(0x00000001, phy_base + PHY_DISABLE_GATING_FOR_SCL);
@@ -479,12 +367,12 @@ static int ddrphy_training(void __iomem *phy_base, enum dram_board board,
        writel(0xf10e4a56, phy_base + PHY_SCL_DATA_1);
        writel(0x11000000, phy_base + PHY_SCL_START);
 
-       while (readl(phy_base + PHY_SCL_START) & BIT(28))
+       while (readl(phy_base + PHY_SCL_START) & PHY_SCL_START_GO_DONE)
                cpu_relax();
 
        writel(0x34000000, phy_base + PHY_SCL_START);
 
-       while (readl(phy_base + PHY_SCL_START) & BIT(28))
+       while (readl(phy_base + PHY_SCL_START) & PHY_SCL_START_GO_DONE)
                cpu_relax();
 
        writel(0x00000003, phy_base + PHY_DISABLE_GATING_FOR_SCL);
@@ -493,16 +381,87 @@ static int ddrphy_training(void __iomem *phy_base, enum dram_board board,
        writel(0x00003270, phy_base + PHY_DYNAMIC_BIT_LVL);
        writel(0x011BD0C4, phy_base + PHY_DSCL_CNT);
 
-       /* shift ip_dq, op_dq trim */
-       ddrphy_shift(phy_base, board, ch);
+       /* shift ip_dq trim */
+       ddrphy_shift_dq(phy_base,
+                       PHY_IP_DQ_DQS_BITWISE_TRIM,
+                       PHY_IP_DQ_DQS_BITWISE_TRIM_MASK,
+                       PHY_IP_DQ_DQS_BITWISE_TRIM_INC,
+                       PHY_IP_DQ_DQS_BITWISE_TRIM_OVERRIDE,
+                       ddrphy_ip_dq_shift_val[board][ch]);
+
+       /* shift op_dq trim */
+       ddrphy_shift_dq(phy_base,
+                       PHY_OP_DQ_DM_DQS_BITWISE_TRIM,
+                       PHY_OP_DQ_DM_DQS_BITWISE_TRIM_MASK,
+                       PHY_OP_DQ_DM_DQS_BITWISE_TRIM_INC,
+                       PHY_OP_DQ_DM_DQS_BITWISE_TRIM_OVERRIDE,
+                       ddrphy_op_dq_shift_val[board][ch]);
+
        return 0;
 }
 
-static int umc_dc_init(void __iomem *dc_base, enum dram_freq freq,
+/* UMC */
+static const u32 umc_initctla[DRAM_FREQ_NR] = {0x71016D11};
+static const u32 umc_initctlb[DRAM_FREQ_NR] = {0x07E390AC};
+static const u32 umc_initctlc[DRAM_FREQ_NR] = {0x00FF00FF};
+static const u32 umc_drmmr0[DRAM_FREQ_NR] = {0x00000114};
+static const u32 umc_drmmr2[DRAM_FREQ_NR] = {0x000002a0};
+
+static const u32 umc_memconf0a[DRAM_FREQ_NR][DRAM_SZ_NR] = {
+       /*  256MB       512MB */
+       {0x00000601, 0x00000801},       /* 1866 MHz */
+};
+
+static const u32 umc_memconf0b[DRAM_FREQ_NR][DRAM_SZ_NR] = {
+       /*  256MB       512MB */
+       {0x00000120, 0x00000130},       /* 1866 MHz */
+};
+
+static const u32 umc_memconfch[DRAM_FREQ_NR][DRAM_SZ_NR] = {
+       /*  256MB       512MB */
+       {0x00033603, 0x00033803},       /* 1866 MHz */
+};
+
+static const u32 umc_cmdctla[DRAM_FREQ_NR] = {0x060D0D20};
+static const u32 umc_cmdctlb[DRAM_FREQ_NR] = {0x2D211C08};
+static const u32 umc_cmdctlc[DRAM_FREQ_NR] = {0x00150C04};
+static const u32 umc_cmdctle[DRAM_FREQ_NR][DRAM_SZ_NR] = {
+       /*  256MB       512MB */
+       {0x0049071D, 0x0078071D},       /* 1866 MHz */
+};
+
+static const u32 umc_rdatactl[DRAM_FREQ_NR] = {0x00000610};
+static const u32 umc_wdatactl[DRAM_FREQ_NR] = {0x00000204};
+static const u32 umc_odtctl[DRAM_FREQ_NR] = {0x02000002};
+static const u32 umc_dataset[DRAM_FREQ_NR] = {0x04000000};
+
+static const u32 umc_flowctla[DRAM_FREQ_NR] = {0x0081E01E};
+static const u32 umc_directbusctrla[DRAM_CH_NR] = {
+       0x00000000, 0x00000001, 0x00000001
+};
+
+static void umc_poll_phy_init_complete(void __iomem *dc_base)
+{
+       /* Wait for PHY Init Complete */
+       while (!(readl(dc_base + UMC_DFISTCTLC) & BIT(0)))
+               cpu_relax();
+}
+
+static int umc_dc_init(void __iomem *dc_base, unsigned int freq,
                       unsigned long size, int ch)
 {
+       enum dram_freq freq_e;
        enum dram_size size_e;
 
+       switch (freq) {
+       case 1866:
+               freq_e = DRAM_FREQ_1866M;
+               break;
+       default:
+               pr_err("unsupported DRAM frequency %ud MHz\n", freq);
+               return -EINVAL;
+       }
+
        switch (size) {
        case 0:
                return 0;
@@ -521,40 +480,40 @@ static int umc_dc_init(void __iomem *dc_base, enum dram_freq freq,
        writel(0x00000001, dc_base + UMC_DFICSOVRRD);
        writel(0x00000000, dc_base + UMC_DFITURNOFF);
 
-       writel(umc_initctla[freq], dc_base + UMC_INITCTLA);
-       writel(umc_initctlb[freq], dc_base + UMC_INITCTLB);
-       writel(umc_initctlc[freq], dc_base + UMC_INITCTLC);
+       writel(umc_initctla[freq_e], dc_base + UMC_INITCTLA);
+       writel(umc_initctlb[freq_e], dc_base + UMC_INITCTLB);
+       writel(umc_initctlc[freq_e], dc_base + UMC_INITCTLC);
 
-       writel(umc_drmmr0[freq], dc_base + UMC_DRMMR0);
+       writel(umc_drmmr0[freq_e], dc_base + UMC_DRMMR0);
        writel(0x00000004, dc_base + UMC_DRMMR1);
-       writel(umc_drmmr2[freq], dc_base + UMC_DRMMR2);
+       writel(umc_drmmr2[freq_e], dc_base + UMC_DRMMR2);
        writel(0x00000000, dc_base + UMC_DRMMR3);
 
-       writel(umc_memconf0a[freq][size_e], dc_base + UMC_MEMCONF0A);
-       writel(umc_memconf0b[freq][size_e], dc_base + UMC_MEMCONF0B);
-       writel(umc_memconfch[freq][size_e], dc_base + UMC_MEMCONFCH);
-       writel(0x00000008, dc_base + UMC_MEMMAPSET);
+       writel(umc_memconf0a[freq_e][size_e], dc_base + UMC_MEMCONF0A);
+       writel(umc_memconf0b[freq_e][size_e], dc_base + UMC_MEMCONF0B);
+       writel(umc_memconfch[freq_e][size_e], dc_base + UMC_MEMCONFCH);
+       writel(0x00000000, dc_base + UMC_MEMMAPSET);
 
-       writel(umc_cmdctla[freq], dc_base + UMC_CMDCTLA);
-       writel(umc_cmdctlb[freq], dc_base + UMC_CMDCTLB);
-       writel(umc_cmdctlc[freq], dc_base + UMC_CMDCTLC);
-       writel(umc_cmdctle[freq][size_e], dc_base + UMC_CMDCTLE);
+       writel(umc_cmdctla[freq_e], dc_base + UMC_CMDCTLA);
+       writel(umc_cmdctlb[freq_e], dc_base + UMC_CMDCTLB);
+       writel(umc_cmdctlc[freq_e], dc_base + UMC_CMDCTLC);
+       writel(umc_cmdctle[freq_e][size_e], dc_base + UMC_CMDCTLE);
 
-       writel(umc_rdatactl_d0[freq], dc_base + UMC_RDATACTL_D0);
-       writel(umc_rdatactl_d1[freq], dc_base + UMC_RDATACTL_D1);
+       writel(umc_rdatactl[freq_e], dc_base + UMC_RDATACTL_D0);
+       writel(umc_rdatactl[freq_e], dc_base + UMC_RDATACTL_D1);
 
-       writel(umc_wdatactl_d0[freq], dc_base + UMC_WDATACTL_D0);
-       writel(umc_wdatactl_d1[freq], dc_base + UMC_WDATACTL_D1);
-       writel(umc_odtctl_d0[freq], dc_base + UMC_ODTCTL_D0);
-       writel(umc_odtctl_d1[freq], dc_base + UMC_ODTCTL_D1);
-       writel(umc_dataset[freq], dc_base + UMC_DATASET);
+       writel(umc_wdatactl[freq_e], dc_base + UMC_WDATACTL_D0);
+       writel(umc_wdatactl[freq_e], dc_base + UMC_WDATACTL_D1);
+       writel(umc_odtctl[freq_e], dc_base + UMC_ODTCTL_D0);
+       writel(umc_odtctl[freq_e], dc_base + UMC_ODTCTL_D1);
+       writel(umc_dataset[freq_e], dc_base + UMC_DATASET);
 
        writel(0x00400020, dc_base + UMC_DCCGCTL);
        writel(0x00000003, dc_base + UMC_ACSSETA);
        writel(0x00000103, dc_base + UMC_FLOWCTLG);
        writel(0x00010200, dc_base + UMC_ACSSETB);
 
-       writel(umc_flowctla[freq], dc_base + UMC_FLOWCTLA);
+       writel(umc_flowctla[freq_e], dc_base + UMC_FLOWCTLA);
        writel(0x00004444, dc_base + UMC_FLOWCTLC);
        writel(0x00000000, dc_base + UMC_DFICUPDCTLA);
 
@@ -577,7 +536,7 @@ static int umc_dc_init(void __iomem *dc_base, enum dram_freq freq,
 }
 
 static int umc_ch_init(void __iomem *umc_ch_base, void __iomem *phy_ch_base,
-                      enum dram_freq freq, enum dram_board board,
+                      enum dram_board board, unsigned int freq,
                       unsigned long size, int ch)
 {
        void __iomem *dc_base = umc_ch_base + 0x00011000;
@@ -591,7 +550,11 @@ static int umc_ch_init(void __iomem *umc_ch_base, void __iomem *phy_ch_base,
        writel(UMC_DIOCTLA_CTL_NRST | UMC_DIOCTLA_CFG_NRST,
               dc_base + UMC_DIOCTLA);
 
-       ddrphy_init(phy_base, dc_base, freq, board, ch);
+       ddrphy_init(phy_base, board, ch);
+
+       umc_poll_phy_init_complete(dc_base);
+
+       ddrphy_init_tail(phy_base, board, freq, ch);
 
        ret = umc_dc_init(dc_base, freq, size, ch);
        if (ret)
@@ -624,19 +587,9 @@ int uniphier_ld20_umc_init(const struct uniphier_board_data *bd)
        void __iomem *um_base = (void __iomem *)0x5b600000;
        void __iomem *umc_ch_base = (void __iomem *)0x5b800000;
        void __iomem *phy_ch_base = (void __iomem *)0x6e200000;
-       enum dram_freq freq;
        enum dram_board board;
        int ch, ret;
 
-       switch (bd->dram_freq) {
-       case 1866:
-               freq = DRAM_FREQ_1866M;
-               break;
-       default:
-               pr_err("unsupported DRAM frequency %d MHz\n", bd->dram_freq);
-               return -EINVAL;
-       }
-
        switch (UNIPHIER_BD_BOARD_GET_TYPE(bd->flags)) {
        case UNIPHIER_BD_BOARD_LD20_REF:
                board = DRAM_BOARD_LD20_REF;
@@ -644,6 +597,9 @@ int uniphier_ld20_umc_init(const struct uniphier_board_data *bd)
        case UNIPHIER_BD_BOARD_LD20_GLOBAL:
                board = DRAM_BOARD_LD20_GLOBAL;
                break;
+       case UNIPHIER_BD_BOARD_LD20_C1:
+               board = DRAM_BOARD_LD20_C1;
+               break;
        case UNIPHIER_BD_BOARD_LD21_REF:
                board = DRAM_BOARD_LD21_REF;
                break;
@@ -656,15 +612,18 @@ int uniphier_ld20_umc_init(const struct uniphier_board_data *bd)
                return -EINVAL;
        }
 
-       for (ch = 0; ch < bd->dram_nr_ch; ch++) {
+       for (ch = 0; ch < DRAM_CH_NR; ch++) {
                unsigned long size = bd->dram_ch[ch].size;
                unsigned int width = bd->dram_ch[ch].width;
 
-               ret = umc_ch_init(umc_ch_base, phy_ch_base, freq, board,
-                                 size / (width / 16), ch);
-               if (ret) {
-                       pr_err("failed to initialize UMC ch%d\n", ch);
-                       return ret;
+               if (size) {
+                       ret = umc_ch_init(umc_ch_base, phy_ch_base, board,
+                                         bd->dram_freq, size / (width / 16),
+                                         ch);
+                       if (ret) {
+                               pr_err("failed to initialize UMC ch%d\n", ch);
+                               return ret;
+                       }
                }
 
                umc_ch_base += 0x00200000;