RK3036 DDR: support ddr selfrefresh when system suspend
authortyp <typ@rock-chips.com>
Wed, 10 Sep 2014 11:02:17 +0000 (19:02 +0800)
committertyp <typ@rock-chips.com>
Wed, 10 Sep 2014 11:02:17 +0000 (19:02 +0800)
arch/arm/mach-rockchip/ddr_rk3036.c [new file with mode: 0755]

diff --git a/arch/arm/mach-rockchip/ddr_rk3036.c b/arch/arm/mach-rockchip/ddr_rk3036.c
new file mode 100755 (executable)
index 0000000..518cac4
--- /dev/null
@@ -0,0 +1,2125 @@
+/*
+ * arch/arm/mach-rk2928/ddr.c-- for ddr3&ddr2
+ *
+ * Function Driver for DDR controller
+ *
+ * Copyright (C) 2012 Fuzhou Rockchip Electronics Co.,Ltd
+ * Author: 
+ * hcy@rock-chips.com
+ * yk@rock-chips.com
+ * typ@rock-chips.com
+ * 
+ * v1.00 
+ */
+#include <linux/kernel.h>
+#include <linux/io.h>
+#include <linux/module.h>
+#include <linux/clk.h>
+
+#include <asm/cacheflush.h>
+#include <asm/tlbflush.h>
+#include <linux/cpu.h>
+#include <dt-bindings/clock/ddr.h>
+#include <linux/rockchip/cru.h>
+#include <linux/rk_fb.h>
+#include "cpu_axi.h"
+
+
+typedef uint32_t uint32 ;
+
+
+#define DDR3_DDR2_DLL_DISABLE_FREQ    (300)  // ¿ÅÁ£dll disableµÄƵÂÊ
+#define DDR3_DDR2_ODT_DISABLE_FREQ    (333)  //¿ÅÁ£odt disableµÄƵÂÊ
+#define SR_IDLE                       (0x1)   //unit:32*DDR clk cycle, and 0 for disable auto self-refresh
+#define PD_IDLE                       (0x40)  //unit:DDR clk cycle, and 0 for disable auto power-down
+#define PHY_ODT_DISABLE_FREQ          (333)  //¶¨ÒåÖ÷¿Ø¶Ëodt disableµÄƵÂÊ
+#define PHY_DLL_DISABLE_FREQ          (266)  //¶¨ÒåÖ÷¿Ø¶Ëdll bypassµÄƵÂÊ
+
+#define ddr_print(x...) printk( "DDR DEBUG: " x )
+
+#define SRAM_CODE_OFFSET        rockchip_sram_virt
+#define SRAM_SIZE               rockchip_sram_size
+
+
+/***********************************
+ * DDR3 define
+ ***********************************/
+//mr0 for ddr3
+#define DDR3_BL8          (0)
+#define DDR3_BC4_8        (1)
+#define DDR3_BC4          (2)
+#define DDR3_CL(n)        (((((n)-4)&0x7)<<4)|((((n)-4)&0x8)>>1))
+#define DDR3_WR(n)        (((n)&0x7)<<9)
+#define DDR3_DLL_RESET    (1<<8)
+#define DDR3_DLL_DeRESET  (0<<8)
+    
+//mr1 for ddr3
+#define DDR3_DLL_ENABLE    (0)
+#define DDR3_DLL_DISABLE   (1)
+#define DDR3_MR1_AL(n)  (((n)&0x7)<<3)
+    
+#define DDR3_DS_40            (0)
+#define DDR3_DS_34            (1<<1)
+#define DDR3_Rtt_Nom_DIS      (0)
+#define DDR3_Rtt_Nom_60       (1<<2)
+#define DDR3_Rtt_Nom_120      (1<<6)
+#define DDR3_Rtt_Nom_40       ((1<<2)|(1<<6))
+    
+//mr2 for ddr3
+#define DDR3_MR2_CWL(n) ((((n)-5)&0x7)<<3)
+#define DDR3_Rtt_WR_DIS       (0)
+#define DDR3_Rtt_WR_60        (1<<9)
+#define DDR3_Rtt_WR_120       (2<<9)
+
+#define DDR_PLL_REFDIV  (1)
+#define FBDIV(n)        ((0xFFF<<16) | (n&0xfff))
+#define REFDIV(n)       ((0x3F<<16) | (n&0x3f))
+#define POSTDIV1(n)     ((0x7<<(12+16)) | ((n&0x7)<<12))
+#define POSTDIV2(n)     ((0x7<<(6+16)) | ((n&0x7)<<6))
+
+#define PLL_LOCK_STATUS  (0x1<<10)
+ //CRU Registers
+typedef volatile struct tagCRU_STRUCT
+{
+    uint32 CRU_PLL_CON[4][4]; 
+    uint32 CRU_MODE_CON;
+    uint32 CRU_CLKSEL_CON[35];
+    uint32 CRU_CLKGATE_CON[10];
+    uint32 reserved1[2];
+    uint32 CRU_GLB_SRST_FST_VALUE;
+    uint32 CRU_GLB_SRST_SND_VALUE;
+    uint32 reserved2[2];
+    uint32 CRU_SOFTRST_CON[9];
+    uint32 CRU_MISC_CON;
+    uint32 reserved3[2];
+    uint32 CRU_GLB_CNT_TH;
+    uint32 CRU_SDMMC_CON[2];
+    uint32 CRU_SDIO_CON[2];
+    uint32 CRU_EMMC_CON[2];
+    uint32 reserved4;
+    uint32 CRU_RST_ST;
+    uint32 reserved5[(0x1f0-0x164)/4];
+    uint32 CRU_PLL_MASK_CON;
+} CRU_REG, *pCRU_REG;
+
+typedef struct tagGPIO_LH
+{
+    uint32 GPIOL;
+    uint32 GPIOH;
+}GPIO_LH_T;
+
+typedef struct tagGPIO_IOMUX
+{
+    uint32 GPIOA_IOMUX;
+    uint32 GPIOB_IOMUX;
+    uint32 GPIOC_IOMUX;
+    uint32 GPIOD_IOMUX;
+}GPIO_IOMUX_T;
+
+/********************************
+GRF ¼Ä´æÆ÷ÖÐGRF_OS_REG1 ´æddr rank£¬typeµÈÐÅÏ¢
+GRF_SOC_CON2¼Ä´æÆ÷ÖпØÖÆc_sysreqÐźÅÏòpctl·¢ËͽøÈëlow power ÇëÇó
+GRF_DDRC_STAT ¿É²éѯpctlÊÇ·ñ½ÓÊÜÇëÇó ½øÈëlow power 
+********************************/
+//REG FILE registers    
+//GRF_SOC_STATUS0
+#define sys_pwr_idle     (1<<27)
+#define gpu_pwr_idle     (1<<26)
+#define vpu_pwr_idle     (1<<25)
+#define vio_pwr_idle     (1<<24)
+#define peri_pwr_idle    (1<<23)
+#define core_pwr_idle     (1<<22)
+//GRF_SOC_CON2
+#define core_pwr_idlereq    (13)
+#define peri_pwr_idlereq    (12)
+#define vio_pwr_idlereq     (11)
+#define vpu_pwr_idlereq     (10)
+#define gpu_pwr_idlereq     (9)
+#define sys_pwr_idlereq     (8)
+
+typedef volatile struct tagREG_FILE
+{
+    uint32 reserved0[(0xa8-0x0)/4];
+    GPIO_IOMUX_T GRF_GPIO_IOMUX[3]; // 0x00a8
+    uint32 reserved1[(0x100-0xd8)/4];
+    uint32 GRF_GPIO_DS;             //0x100
+    uint32 reserved2[(0x118-0x104)/4];
+    GPIO_LH_T GRF_GPIO_PULL[3];     // 0x118
+    uint32 reserved3[(0x140-0x130)/4];
+    uint32 GRF_SOC_CON[3];          // 0x140
+    uint32 GRF_SOC_STATUS0;
+    //uint32 GRF_LVDS_CON0;
+    uint32 reserved4;               //0x150
+    uint32 GRF_SOC_CON3;
+    uint32 reserved5[(0x15c-0x158)/4];
+    uint32 GRF_DMAC_CON[3];        //0x15c
+    uint32 reserved6[(0x17c-0x168)/4];
+    uint32 GRF_UOC0_CON5;         //0x17c
+    uint32 reserved7[(0x190-0x180)/4];
+    uint32 GRF_UOC1_CON4;         //0x190
+    uint32 GRF_UOC1_COM5;
+    uint32 reserved8;
+    uint32 GRF_DDRC_STAT;
+    uint32 GRF_UOC_CON6;
+    uint32 GRF_SOC_STATUS1;
+    uint32 GRF_CPU_CON[4];
+    uint32 reserved9[(0x1c0-0x1b8)/4];
+    uint32 GRF_CPU_STATUS[2];
+    uint32 GRF_OS_REG[8];
+    uint32 reserved10[(0x200-0x1e8)/4];
+    uint32 GRF_DLL_CON[4];          //0X200
+    uint32 GRF_DLL_STATUS[4];
+    //uint32 reserved10[(0x220-0x214)/4];
+    uint32 GRF_DFI_WRNUM;           //0X220
+    uint32 GRF_DFI_RDNUM;
+    uint32 GRF_DFI_ACTNUM;
+    uint32 GRF_DFI_TIMERVAL;
+    uint32 GRF_NIF_FIFO[4];
+    uint32 reserved11[(0x280-0x240)/4];
+    uint32 GRF_USBPHY0_CON[8];
+    uint32 GRF_USBPHY1_CON[8];
+    uint32 reserved12[(0x300-0x2c0)/4];
+    uint32 GRF_CHIP_TAG;
+    uint32 GRF_SDMMC_DET_CNT;
+} REG_FILE, *pREG_FILE;
+
+//SCTL
+#define INIT_STATE                     (0)
+#define CFG_STATE                      (1)
+#define GO_STATE                       (2)
+#define SLEEP_STATE                    (3)
+#define WAKEUP_STATE                   (4)
+
+//STAT
+#define Init_mem                       (0)
+#define Config                         (1)
+#define Config_req                     (2)
+#define Access                         (3)
+#define Access_req                     (4)
+#define Low_power                      (5)
+#define Low_power_entry_req            (6)
+#define Low_power_exit_req             (7)
+
+//MCFG
+#define mddr_lpddr2_clk_stop_idle(n)   ((n)<<24)
+#define pd_idle(n)                     ((n)<<8)
+#define mddr_en                        (2<<22)
+#define lpddr2_en                      (3<<22)
+#define ddr2_en                        (0<<5)
+#define ddr3_en                        (1<<5)
+#define lpddr2_s2                      (0<<6)
+#define lpddr2_s4                      (1<<6)
+#define mddr_lpddr2_bl_2               (0<<20)
+#define mddr_lpddr2_bl_4               (1<<20)
+#define mddr_lpddr2_bl_8               (2<<20)
+#define mddr_lpddr2_bl_16              (3<<20)
+#define ddr2_ddr3_bl_4                 (0)
+#define ddr2_ddr3_bl_8                 (1)
+#define tfaw_cfg(n)                    (((n)-4)<<18)
+#define pd_exit_slow                   (0<<17)
+#define pd_exit_fast                   (1<<17)
+#define pd_type(n)                     ((n)<<16)
+#define two_t_en(n)                    ((n)<<3)
+#define bl8int_en(n)                   ((n)<<2)
+#define cke_or_en(n)                   ((n)<<1)
+
+//POWCTL
+#define power_up_start                 (1<<0)
+
+//POWSTAT
+#define power_up_done                  (1<<0)
+
+//DFISTSTAT0
+#define dfi_init_complete              (1<<0)
+
+//CMDTSTAT
+#define cmd_tstat                      (1<<0)
+
+//CMDTSTATEN
+#define cmd_tstat_en                   (1<<1)
+
+//MCMD
+#define Deselect_cmd                   (0)
+#define PREA_cmd                       (1)
+#define REF_cmd                        (2)
+#define MRS_cmd                        (3)
+#define ZQCS_cmd                       (4)
+#define ZQCL_cmd                       (5)
+#define RSTL_cmd                       (6)
+#define MRR_cmd                        (8)
+#define DPDE_cmd                       (9)
+
+#define lpddr2_op(n)                   ((n)<<12)
+#define lpddr2_ma(n)                   ((n)<<4)
+
+#define bank_addr(n)                   ((n)<<17)
+#define cmd_addr(n)                    ((n)<<4)
+
+#define start_cmd                      (1u<<31)
+
+typedef union STAT_Tag
+{
+    uint32 d32;
+    struct
+    {
+        unsigned ctl_stat : 3;
+        unsigned reserved3 : 1;
+        unsigned lp_trig : 3;
+        unsigned reserved7_31 : 25;
+    }b;
+}STAT_T;
+
+typedef union SCFG_Tag
+{
+    uint32 d32;
+    struct
+    {
+        unsigned hw_low_power_en : 1;
+        unsigned reserved1_5 : 5;
+        unsigned nfifo_nif1_dis : 1;
+        unsigned reserved7 : 1;
+        unsigned bbflags_timing : 4;
+        unsigned reserved12_31 : 20;
+    } b;
+}SCFG_T;
+
+/* DDR Controller register struct */
+typedef volatile struct DDR_REG_Tag
+{
+    //Operational State, Control, and Status Registers
+    SCFG_T SCFG;                   //State Configuration Register
+    volatile uint32 SCTL;                   //State Control Register
+    STAT_T STAT;                   //State Status Register
+    volatile uint32 INTRSTAT;               //Interrupt Status Register
+    uint32 reserved0[(0x40-0x10)/4];
+    //Initailization Control and Status Registers
+    volatile uint32 MCMD;                   //Memory Command Register
+    volatile uint32 POWCTL;                 //Power Up Control Registers
+    volatile uint32 POWSTAT;                //Power Up Status Register
+    volatile uint32 CMDTSTAT;               //Command Timing Status Register
+    volatile uint32 CMDTSTATEN;             //Command Timing Status Enable Register
+    uint32 reserved1[(0x60-0x54)/4];
+    volatile uint32 MRRCFG0;                //MRR Configuration 0 Register
+    volatile uint32 MRRSTAT0;               //MRR Status 0 Register
+    volatile uint32 MRRSTAT1;               //MRR Status 1 Register
+    uint32 reserved2[(0x7c-0x6c)/4];
+    //Memory Control and Status Registers
+    volatile uint32 MCFG1;                  //Memory Configuration 1 Register
+    volatile uint32 MCFG;                   //Memory Configuration Register
+    volatile uint32 PPCFG;                  //Partially Populated Memories Configuration Register
+    volatile uint32 MSTAT;                  //Memory Status Register
+    volatile uint32 LPDDR2ZQCFG;            //LPDDR2 ZQ Configuration Register
+    uint32 reserved3;
+    //DTU Control and Status Registers
+    volatile uint32 DTUPDES;                //DTU Status Register
+    volatile uint32 DTUNA;                  //DTU Number of Random Addresses Created Register
+    volatile uint32 DTUNE;                  //DTU Number of Errors Register
+    volatile uint32 DTUPRD0;                //DTU Parallel Read 0
+    volatile uint32 DTUPRD1;                //DTU Parallel Read 1
+    volatile uint32 DTUPRD2;                //DTU Parallel Read 2
+    volatile uint32 DTUPRD3;                //DTU Parallel Read 3
+    volatile uint32 DTUAWDT;                //DTU Address Width
+    uint32 reserved4[(0xc0-0xb4)/4];
+    //Memory Timing Registers
+    volatile uint32 TOGCNT1U;               //Toggle Counter 1U Register
+    volatile uint32 TINIT;                  //t_init Timing Register
+    volatile uint32 TRSTH;                  //Reset High Time Register
+    volatile uint32 TOGCNT100N;             //Toggle Counter 100N Register
+    volatile uint32 TREFI;                  //t_refi Timing Register
+    volatile uint32 TMRD;                   //t_mrd Timing Register
+    volatile uint32 TRFC;                   //t_rfc Timing Register
+    volatile uint32 TRP;                    //t_rp Timing Register
+    volatile uint32 TRTW;                   //t_rtw Timing Register
+    volatile uint32 TAL;                    //AL Latency Register
+    volatile uint32 TCL;                    //CL Timing Register
+    volatile uint32 TCWL;                   //CWL Register
+    volatile uint32 TRAS;                   //t_ras Timing Register
+    volatile uint32 TRC;                    //t_rc Timing Register
+    volatile uint32 TRCD;                   //t_rcd Timing Register
+    volatile uint32 TRRD;                   //t_rrd Timing Register
+    volatile uint32 TRTP;                   //t_rtp Timing Register
+    volatile uint32 TWR;                    //t_wr Timing Register
+    volatile uint32 TWTR;                   //t_wtr Timing Register
+    volatile uint32 TEXSR;                  //t_exsr Timing Register
+    volatile uint32 TXP;                    //t_xp Timing Register
+    volatile uint32 TXPDLL;                 //t_xpdll Timing Register
+    volatile uint32 TZQCS;                  //t_zqcs Timing Register
+    volatile uint32 TZQCSI;                 //t_zqcsi Timing Register
+    volatile uint32 TDQS;                   //t_dqs Timing Register
+    volatile uint32 TCKSRE;                 //t_cksre Timing Register
+    volatile uint32 TCKSRX;                 //t_cksrx Timing Register
+    volatile uint32 TCKE;                   //t_cke Timing Register
+    volatile uint32 TMOD;                   //t_mod Timing Register
+    volatile uint32 TRSTL;                  //Reset Low Timing Register
+    volatile uint32 TZQCL;                  //t_zqcl Timing Register
+    volatile uint32 TMRR;                   //t_mrr Timing Register
+    volatile uint32 TCKESR;                 //t_ckesr Timing Register
+    volatile uint32 TDPD;                   //t_dpd Timing Register
+    uint32 reserved5[(0x180-0x148)/4];
+    //ECC Configuration, Control, and Status Registers
+    volatile uint32 ECCCFG;                   //ECC Configuration Register
+    volatile uint32 ECCTST;                   //ECC Test Register
+    volatile uint32 ECCCLR;                   //ECC Clear Register
+    volatile uint32 ECCLOG;                   //ECC Log Register
+    uint32 reserved6[(0x200-0x190)/4];
+    //DTU Control and Status Registers
+    volatile uint32 DTUWACTL;                 //DTU Write Address Control Register
+    volatile uint32 DTURACTL;                 //DTU Read Address Control Register
+    volatile uint32 DTUCFG;                   //DTU Configuration Control Register
+    volatile uint32 DTUECTL;                  //DTU Execute Control Register
+    volatile uint32 DTUWD0;                   //DTU Write Data 0
+    volatile uint32 DTUWD1;                   //DTU Write Data 1
+    volatile uint32 DTUWD2;                   //DTU Write Data 2
+    volatile uint32 DTUWD3;                   //DTU Write Data 3
+    volatile uint32 DTUWDM;                   //DTU Write Data Mask
+    volatile uint32 DTURD0;                   //DTU Read Data 0
+    volatile uint32 DTURD1;                   //DTU Read Data 1
+    volatile uint32 DTURD2;                   //DTU Read Data 2
+    volatile uint32 DTURD3;                   //DTU Read Data 3
+    volatile uint32 DTULFSRWD;                //DTU LFSR Seed for Write Data Generation
+    volatile uint32 DTULFSRRD;                //DTU LFSR Seed for Read Data Generation
+    volatile uint32 DTUEAF;                   //DTU Error Address FIFO
+    //DFI Control Registers
+    volatile uint32 DFITCTRLDELAY;            //DFI tctrl_delay Register
+    volatile uint32 DFIODTCFG;                //DFI ODT Configuration Register
+    volatile uint32 DFIODTCFG1;               //DFI ODT Configuration 1 Register
+    volatile uint32 DFIODTRANKMAP;            //DFI ODT Rank Mapping Register
+    //DFI Write Data Registers
+    volatile uint32 DFITPHYWRDATA;            //DFI tphy_wrdata Register
+    volatile uint32 DFITPHYWRLAT;             //DFI tphy_wrlat Register
+    uint32 reserved7[(0x260-0x258)/4];
+    volatile uint32 DFITRDDATAEN;             //DFI trddata_en Register
+    volatile uint32 DFITPHYRDLAT;             //DFI tphy_rddata Register
+    uint32 reserved8[(0x270-0x268)/4];
+    //DFI Update Registers
+    volatile uint32 DFITPHYUPDTYPE0;          //DFI tphyupd_type0 Register
+    volatile uint32 DFITPHYUPDTYPE1;          //DFI tphyupd_type1 Register
+    volatile uint32 DFITPHYUPDTYPE2;          //DFI tphyupd_type2 Register
+    volatile uint32 DFITPHYUPDTYPE3;          //DFI tphyupd_type3 Register
+    volatile uint32 DFITCTRLUPDMIN;           //DFI tctrlupd_min Register
+    volatile uint32 DFITCTRLUPDMAX;           //DFI tctrlupd_max Register
+    volatile uint32 DFITCTRLUPDDLY;           //DFI tctrlupd_dly Register
+    uint32 reserved9;
+    volatile uint32 DFIUPDCFG;                //DFI Update Configuration Register
+    volatile uint32 DFITREFMSKI;              //DFI Masked Refresh Interval Register
+    volatile uint32 DFITCTRLUPDI;             //DFI tctrlupd_interval Register
+    uint32 reserved10[(0x2ac-0x29c)/4];
+    volatile uint32 DFITRCFG0;                //DFI Training Configuration 0 Register
+    volatile uint32 DFITRSTAT0;               //DFI Training Status 0 Register
+    volatile uint32 DFITRWRLVLEN;             //DFI Training dfi_wrlvl_en Register
+    volatile uint32 DFITRRDLVLEN;             //DFI Training dfi_rdlvl_en Register
+    volatile uint32 DFITRRDLVLGATEEN;         //DFI Training dfi_rdlvl_gate_en Register
+    //DFI Status Registers
+    volatile uint32 DFISTSTAT0;               //DFI Status Status 0 Register
+    volatile uint32 DFISTCFG0;                //DFI Status Configuration 0 Register
+    volatile uint32 DFISTCFG1;                //DFI Status configuration 1 Register
+    uint32 reserved11;
+    volatile uint32 DFITDRAMCLKEN;            //DFI tdram_clk_enalbe Register
+    volatile uint32 DFITDRAMCLKDIS;           //DFI tdram_clk_disalbe Register
+    volatile uint32 DFISTCFG2;                //DFI Status configuration 2 Register
+    volatile uint32 DFISTPARCLR;              //DFI Status Parity Clear Register
+    volatile uint32 DFISTPARLOG;              //DFI Status Parity Log Register
+    uint32 reserved12[(0x2f0-0x2e4)/4];
+    //DFI Low Power Registers
+    volatile uint32 DFILPCFG0;                //DFI Low Power Configuration 0 Register
+    uint32 reserved13[(0x300-0x2f4)/4];
+    //DFI Training 2 Registers
+    volatile uint32 DFITRWRLVLRESP0;          //DFI Training dif_wrlvl_resp Status 0 Register
+    volatile uint32 DFITRWRLVLRESP1;          //DFI Training dif_wrlvl_resp Status 1 Register
+    volatile uint32 DFITRWRLVLRESP2;          //DFI Training dif_wrlvl_resp Status 2 Register
+    volatile uint32 DFITRRDLVLRESP0;          //DFI Training dif_rdlvl_resp Status 0 Register
+    volatile uint32 DFITRRDLVLRESP1;          //DFI Training dif_rdlvl_resp Status 1 Register
+    volatile uint32 DFITRRDLVLRESP2;          //DFI Training dif_rdlvl_resp Status 2 Register
+    volatile uint32 DFITRWRLVLDELAY0;         //DFI Training dif_wrlvl_delay Configuration 0 Register
+    volatile uint32 DFITRWRLVLDELAY1;         //DFI Training dif_wrlvl_delay Configuration 1 Register
+    volatile uint32 DFITRWRLVLDELAY2;         //DFI Training dif_wrlvl_delay Configuration 2 Register
+    volatile uint32 DFITRRDLVLDELAY0;         //DFI Training dif_rdlvl_delay Configuration 0 Register
+    volatile uint32 DFITRRDLVLDELAY1;         //DFI Training dif_rdlvl_delay Configuration 1 Register
+    volatile uint32 DFITRRDLVLDELAY2;         //DFI Training dif_rdlvl_delay Configuration 2 Register
+    volatile uint32 DFITRRDLVLGATEDELAY0;     //DFI Training dif_rdlvl_gate_delay Configuration 0 Register
+    volatile uint32 DFITRRDLVLGATEDELAY1;     //DFI Training dif_rdlvl_gate_delay Configuration 1 Register
+    volatile uint32 DFITRRDLVLGATEDELAY2;     //DFI Training dif_rdlvl_gate_delay Configuration 2 Register
+    volatile uint32 DFITRCMD;                 //DFI Training Command Register
+    uint32 reserved14[(0x3f8-0x340)/4];
+    //IP Status Registers
+    volatile uint32 IPVR;                     //IP Version Register
+    volatile uint32 IPTR;                     //IP Type Register
+}DDR_REG_T, *pDDR_REG_T;
+
+//PHY_REG2
+#define PHY_AUTO_CALIBRATION (1<<0)
+#define PHY_SW_CALIBRATION   (1<<1)
+#define PHY_MEM_TYPE         (6)
+
+//PHY_REG22,25,26,27,28
+#define PHY_RON_DISABLE     (0)
+#define PHY_RON_309ohm      (1)
+#define PHY_RON_155ohm      (2)
+#define PHY_RON_103ohm      (3)
+#define PHY_RON_77ohm       (4)
+#define PHY_RON_63ohm       (5)
+#define PHY_RON_52ohm       (6)
+#define PHY_RON_45ohm       (7)
+//#define PHY_RON_77ohm       (8)
+#define PHY_RON_62ohm       (9)
+//#define PHY_RON_52ohm       (10)
+#define PHY_RON_44ohm       (11)
+#define PHY_RON_39ohm       (12)
+#define PHY_RON_34ohm       (13)
+#define PHY_RON_31ohm       (14)
+#define PHY_RON_28ohm       (15)
+
+#define PHY_RTT_DISABLE     (0)
+#define PHY_RTT_816ohm      (1)
+#define PHY_RTT_431ohm      (2)
+#define PHY_RTT_287ohm      (3)
+#define PHY_RTT_216ohm      (4)
+#define PHY_RTT_172ohm      (5)
+#define PHY_RTT_145ohm      (6)
+#define PHY_RTT_124ohm      (7)
+#define PHY_RTT_215ohm      (8)
+//#define PHY_RTT_172ohm      (9)
+#define PHY_RTT_144ohm      (10)
+#define PHY_RTT_123ohm      (11)
+#define PHY_RTT_108ohm      (12)
+#define PHY_RTT_96ohm       (13)
+#define PHY_RTT_86ohm       (14)
+#define PHY_RTT_78ohm       (15)
+
+/* DDR PHY register struct */
+typedef volatile struct DDRPHY_REG_Tag
+{
+    volatile uint32 PHY_REG1;               //PHY soft reset Register
+    volatile uint32 PHY_REG3;               //Burst type select Register
+    volatile uint32 PHY_REG2;               //PHY DQS squelch calibration Register
+    uint32 reserved1[(0x38-0x0a)/4];
+    volatile uint32 PHY_REG4a;              //CL,AL set register
+    volatile uint32 PHY_REG4b;              //dqs gata delay select bypass mode register
+    uint32 reserved2[(0x54-0x40)/4];
+    volatile uint32 PHY_REG16;              //
+    uint32 reserved3[(0x5c-0x58)/4];
+    volatile uint32 PHY_REG18;              //0x5c
+    volatile uint32 PHY_REG19;
+    uint32 reserved4[(0x68-0x64)/4];
+    volatile uint32 PHY_REG21;              //0x68
+    uint32 reserved5[(0x70-0x6c)/4];     
+    volatile uint32 PHY_REG22;              //0x70
+    uint32 reserved6[(0x80-0x74)/4];
+    volatile uint32 PHY_REG25;              //0x80
+    volatile uint32 PHY_REG26;
+    volatile uint32 PHY_REG27;
+    volatile uint32 PHY_REG28;
+    uint32 reserved7[(0xd4-0x90)/4];
+    volatile uint32 PHY_REG6;               //0xd4
+    volatile uint32 PHY_REG7;
+    uint32 reserved8[(0xe0-0xdc)/4];
+    volatile uint32 PHY_REG8;               //0xe0
+    volatile uint32 PHY_REG0e4;             //use for DQS ODT off
+    uint32 reserved9[(0x114-0xe8)/4];
+    volatile uint32 PHY_REG9;               //0x114
+    volatile uint32 PHY_REG10;
+    uint32 reserved10[(0x120-0x11c)/4];
+    volatile uint32 PHY_REG11;              //0x120
+    volatile uint32 PHY_REG124;             //use for DQS ODT off
+    uint32 reserved11[(0x1c0-0x128)/4];
+    volatile uint32 PHY_REG29;              //0x1c0
+    uint32 reserved12[(0x264-0x1c4)/4];
+       volatile uint32 PHY_REG264;             //use for phy soft reset
+       uint32 reserved13[(0x2b0-0x268)/4];
+    volatile uint32 PHY_REG2a;              //0x2b0
+    uint32 reserved14[(0x2c4-0x2b4)/4];
+//    volatile uint32 PHY_TX_DeSkew[24];        //0x2c4-0x320
+    volatile uint32 PHY_REG30;
+    volatile uint32 PHY_REG31;
+    volatile uint32 PHY_REG32;
+    volatile uint32 PHY_REG33;
+    volatile uint32 PHY_REG34;
+    volatile uint32 PHY_REG35;
+    volatile uint32 PHY_REG36;
+    volatile uint32 PHY_REG37;
+    volatile uint32 PHY_REG38;
+    volatile uint32 PHY_REG39;
+    volatile uint32 PHY_REG40;
+    volatile uint32 PHY_REG41;
+    volatile uint32 PHY_REG42;
+    volatile uint32 PHY_REG43;
+    volatile uint32 PHY_REG44;
+    volatile uint32 PHY_REG45;
+    volatile uint32 PHY_REG46;
+    volatile uint32 PHY_REG47;
+    volatile uint32 PHY_REG48;
+    volatile uint32 PHY_REG49;
+    volatile uint32 PHY_REG50;
+    volatile uint32 PHY_REG51;
+    volatile uint32 PHY_REG52;
+    volatile uint32 PHY_REG53;
+    uint32 reserved15[(0x328-0x324)/4];
+//    volatile uint32 PHY_RX_DeSkew[11];      //0x328-0x350
+    volatile uint32 PHY_REG54;
+    volatile uint32 PHY_REG55;
+    volatile uint32 PHY_REG56;
+    volatile uint32 PHY_REG57;
+    volatile uint32 PHY_REG58;
+    volatile uint32 PHY_REG59;
+    volatile uint32 PHY_REG5a;
+    volatile uint32 PHY_REG5b;
+    volatile uint32 PHY_REG5c;
+    volatile uint32 PHY_REG5d;
+    volatile uint32 PHY_REG5e;    
+    uint32 reserved16[(0x3c4-0x354)/4];
+    volatile uint32 PHY_REG5f;              //0x3c4
+    uint32 reserved17[(0x3e0-0x3c8)/4];
+    volatile uint32 PHY_REG60;
+    volatile uint32 PHY_REG61;
+    volatile uint32 PHY_REG62;            
+}DDRPHY_REG_T, *pDDRPHY_REG_T;
+
+#define pCRU_Reg               ((pCRU_REG)RK_CRU_VIRT)
+#define pGRF_Reg               ((pREG_FILE)RK_GRF_VIRT)
+#define pDDR_Reg               ((pDDR_REG_T)RK_DDR_VIRT)
+#define pPHY_Reg               ((pDDRPHY_REG_T)(RK_DDR_VIRT+RK3036_DDR_PCTL_SIZE))
+#define SysSrv_DdrTiming       (RK_CPU_AXI_BUS_VIRT+0xc)
+#define READ_CS_INFO()   ((((pGRF_Reg->GRF_OS_REG[1])>>11)&0x1)+1)
+#define READ_COL_INFO()  (9+(((pGRF_Reg->GRF_OS_REG[1])>>9)&0x3))
+#define READ_BK_INFO()   (3-(((pGRF_Reg->GRF_OS_REG[1])>>8)&0x1))
+#define READ_CS0_ROW_INFO()  (13+(((pGRF_Reg->GRF_OS_REG[1])>>6)&0x3))
+#define READ_CS1_ROW_INFO()  (13+(((pGRF_Reg->GRF_OS_REG[1])>>4)&0x3))
+#define READ_BW_INFO()   (2>>(((pGRF_Reg->GRF_OS_REG[1])&0xc)>>2))    //´úÂëÖР0->8bit 1->16bit 2->32bit  ÓëgrfÖж¨ÒåÏà·´
+#define READ_DIE_BW_INFO()   (2>>((pGRF_Reg->GRF_OS_REG[1])&0x3))
+
+typedef enum PLL_ID_Tag
+{
+    APLL=0,
+    DPLL,
+    CPLL,
+    GPLL,
+    PLL_MAX
+}PLL_ID;
+
+typedef enum DRAM_TYPE_Tag
+{
+    LPDDR = 0,
+    DDR,
+    DDR2,
+    DDR3,
+    LPDDR2_S2,
+    LPDDR2_S4,
+
+    DRAM_MAX
+}DRAM_TYPE;
+
+struct ddr_freq_t {
+    unsigned long screen_ft_us;
+    unsigned long long t0;
+    unsigned long long t1;
+    unsigned long t2;
+};
+
+
+typedef struct PCTRL_TIMING_Tag
+{
+    uint32 ddrFreq;
+    //Memory Timing Registers
+    uint32 togcnt1u;               //Toggle Counter 1U Register
+    uint32 tinit;                  //t_init Timing Register
+    uint32 trsth;                  //Reset High Time Register
+    uint32 togcnt100n;             //Toggle Counter 100N Register
+    uint32 trefi;                  //t_refi Timing Register
+    uint32 tmrd;                   //t_mrd Timing Register
+    uint32 trfc;                   //t_rfc Timing Register
+    uint32 trp;                    //t_rp Timing Register
+    uint32 trtw;                   //t_rtw Timing Register
+    uint32 tal;                    //AL Latency Register
+    uint32 tcl;                    //CL Timing Register
+    uint32 tcwl;                   //CWL Register
+    uint32 tras;                   //t_ras Timing Register
+    uint32 trc;                    //t_rc Timing Register
+    uint32 trcd;                   //t_rcd Timing Register
+    uint32 trrd;                   //t_rrd Timing Register
+    uint32 trtp;                   //t_rtp Timing Register
+    uint32 twr;                    //t_wr Timing Register
+    uint32 twtr;                   //t_wtr Timing Register
+    uint32 texsr;                  //t_exsr Timing Register
+    uint32 txp;                    //t_xp Timing Register
+    uint32 txpdll;                 //t_xpdll Timing Register
+    uint32 tzqcs;                  //t_zqcs Timing Register
+    uint32 tzqcsi;                 //t_zqcsi Timing Register
+    uint32 tdqs;                   //t_dqs Timing Register
+    uint32 tcksre;                 //t_cksre Timing Register
+    uint32 tcksrx;                 //t_cksrx Timing Register
+    uint32 tcke;                   //t_cke Timing Register
+    uint32 tmod;                   //t_mod Timing Register
+    uint32 trstl;                  //Reset Low Timing Register
+    uint32 tzqcl;                  //t_zqcl Timing Register
+    uint32 tmrr;                   //t_mrr Timing Register
+    uint32 tckesr;                 //t_ckesr Timing Register
+    uint32 tdpd;                   //t_dpd Timing Register
+}PCTL_TIMING_T;
+
+struct ddr_change_freq_sram_param {
+    uint32 freq;
+    uint32 freq_slew;
+};
+
+
+typedef union NOC_TIMING_Tag
+{
+    uint32 d32;
+    struct 
+    {
+        unsigned ActToAct : 6;
+        unsigned RdToMiss : 6;
+        unsigned WrToMiss : 6;
+        unsigned BurstLen : 3;
+        unsigned RdToWr : 5;
+        unsigned WrToRd : 5;
+        unsigned BwRatio : 1;
+    } b;
+}NOC_TIMING_T;
+
+typedef struct BACKUP_REG_Tag
+{
+    PCTL_TIMING_T pctl_timing;
+    NOC_TIMING_T noc_timing;
+    uint32 ddrMR[4];
+    uint32 mem_type;
+    uint32 ddr_speed_bin;
+    uint32 ddr_capability_per_die;
+}BACKUP_REG_T;
+
+BACKUP_REG_T DEFINE_PIE_DATA(ddr_reg);
+static BACKUP_REG_T *p_ddr_reg;
+
+uint32 DEFINE_PIE_DATA(ddr_freq);
+static uint32 *p_ddr_freq;
+uint32 DEFINE_PIE_DATA(ddr_sr_idle);
+uint32 DEFINE_PIE_DATA(ddr_dll_status);  // ¼Ç¼ddr dllµÄ״̬£¬ÔÚselfrefresh exitʱѡÔñÊÇ·ñ½øÐÐdll reset
+
+
+
+static uint32_t  ddr3_cl_cwl[22][4]={
+/*   0~330           330~400         400~533        speed
+* tCK  >3             2.5~3          1.875~2.5     1.875~1.5
+*    cl<<16, cwl    cl<<16, cwl     cl<<16, cwl              */
+    {((5<<16)|5),   ((5<<16)|5),    0          ,   0}, //DDR3_800D
+    {((5<<16)|5),   ((6<<16)|5),    0          ,   0}, //DDR3_800E
+
+    {((5<<16)|5),   ((5<<16)|5),    ((6<<16)|6),   0}, //DDR3_1066E
+    {((5<<16)|5),   ((6<<16)|5),    ((7<<16)|6),   0}, //DDR3_1066F
+    {((5<<16)|5),   ((6<<16)|5),    ((8<<16)|6),   0}, //DDR3_1066G
+
+    {((5<<16)|5),   ((5<<16)|5),    ((6<<16)|6),   ((7<<16)|7)}, //DDR3_1333F
+    {((5<<16)|5),   ((5<<16)|5),    ((7<<16)|6),   ((8<<16)|7)}, //DDR3_1333G
+    {((5<<16)|5),   ((6<<16)|5),    ((7<<16)|6),   ((9<<16)|7)}, //DDR3_1333H
+    {((5<<16)|5),   ((6<<16)|5),    ((8<<16)|6),   ((10<<16)|7)}, //DDR3_1333J
+
+    {((5<<16)|5),   ((5<<16)|5),    ((6<<16)|6),   ((7<<16)|7)}, //DDR3_1600G
+    {((5<<16)|5),   ((5<<16)|5),    ((6<<16)|6),   ((8<<16)|7)}, //DDR3_1600H
+    {((5<<16)|5),   ((5<<16)|5),    ((7<<16)|6),   ((9<<16)|7)}, //DDR3_1600J
+    {((5<<16)|5),   ((6<<16)|5),    ((7<<16)|6),   ((10<<16)|7)}, //DDR3_1600K
+
+    {((5<<16)|5),   ((5<<16)|5),    ((6<<16)|6),   ((8<<16)|7)}, //DDR3_1866J
+    {((5<<16)|5),   ((5<<16)|5),    ((7<<16)|6),   ((8<<16)|7)}, //DDR3_1866K
+    {((6<<16)|5),   ((6<<16)|5),    ((7<<16)|6),   ((9<<16)|7)}, //DDR3_1866L
+    {((6<<16)|5),   ((6<<16)|5),    ((8<<16)|6),   ((10<<16)|7)}, //DDR3_1866M
+
+    {((5<<16)|5),   ((5<<16)|5),    ((6<<16)|6),   ((7<<16)|7)}, //DDR3_2133K
+    {((5<<16)|5),   ((5<<16)|5),    ((6<<16)|6),   ((8<<16)|7)}, //DDR3_2133L
+    {((5<<16)|5),   ((5<<16)|5),    ((7<<16)|6),   ((9<<16)|7)}, //DDR3_2133M
+    {((6<<16)|5),   ((6<<16)|5),    ((7<<16)|6),   ((9<<16)|7)},  //DDR3_2133N
+
+    {((6<<16)|5),   ((6<<16)|5),    ((8<<16)|6),   ((10<<16)|7)} //DDR3_DEFAULT
+
+};
+static uint32_t  ddr3_tRC_tFAW[22]={
+/**    tRC    tFAW   */
+    ((50<<16)|50), //DDR3_800D
+    ((53<<16)|50), //DDR3_800E
+
+    ((49<<16)|50), //DDR3_1066E
+    ((51<<16)|50), //DDR3_1066F
+    ((53<<16)|50), //DDR3_1066G
+
+    ((47<<16)|45), //DDR3_1333F
+    ((48<<16)|45), //DDR3_1333G
+    ((50<<16)|45), //DDR3_1333H
+    ((51<<16)|45), //DDR3_1333J
+
+    ((45<<16)|40), //DDR3_1600G
+    ((47<<16)|40), //DDR3_1600H
+    ((48<<16)|40), //DDR3_1600J
+    ((49<<16)|40), //DDR3_1600K
+
+    ((45<<16)|35), //DDR3_1866J
+    ((46<<16)|35), //DDR3_1866K
+    ((47<<16)|35), //DDR3_1866L
+    ((48<<16)|35), //DDR3_1866M
+
+    ((44<<16)|35), //DDR3_2133K
+    ((45<<16)|35), //DDR3_2133L
+    ((46<<16)|35), //DDR3_2133M
+    ((47<<16)|35), //DDR3_2133N
+
+    ((53<<16)|50)  //DDR3_DEFAULT
+};
+
+
+/****************************************************************************
+Internal sram us delay function
+Cpu highest frequency is 1.6 GHz
+1 cycle = 1/1.6 ns
+1 us = 1000 ns = 1000 * 1.6 cycles = 1600 cycles
+*****************************************************************************/
+//__sramdata volatile uint32 loops_per_us;
+volatile uint32 DEFINE_PIE_DATA(loops_per_us);
+#define LPJ_100MHZ  999456UL
+
+/*----------------------------------------------------------------------
+Name   : void __sramlocalfunc ddr_delayus(uint32_t us)
+Desc   : ddr ÑÓʱº¯Êý
+Params  : uint32_t us  --ÑÓʱʱ¼ä
+Return  : void
+Notes   : loops_per_us ÎªÈ«¾Ö±äÁ¿ ÐèÒª¸ù¾Ýarm freq¶ø¶¨
+----------------------------------------------------------------------*/
+static void __sramfunc ddr_delayus(uint32 us)
+{
+    do
+    {
+        volatile unsigned int i = (DATA(loops_per_us)*us);
+        if (i < 7) i = 7;
+        barrier();
+        asm volatile(".align 4; 1: subs %0, %0, #1; bne 1b;" : "+r" (i));
+    } while (0);
+}
+
+
+/*----------------------------------------------------------------------
+Name   : __sramfunc void ddr_copy(uint32 *pDest, uint32 *pSrc, uint32 words)
+Desc   : ddr ¿½±´¼Ä´æÆ÷º¯Êý
+Params  : pDest ->Ä¿±ê¼Ä´æÆ÷Ê×µØÖ·
+          pSrc  ->Ô´±ê¼Ä´æÆ÷Ê×µØÖ·
+          words ->¿½±´³¤¶È
+Return  : void
+Notes   : 
+----------------------------------------------------------------------*/
+
+static __sramfunc void ddr_copy(uint32 *pDest, uint32 *pSrc, uint32 words)
+{
+    uint32 i;
+
+    for(i=0; i<words; i++)
+    {
+        pDest[i] = pSrc[i];
+    }
+}
+
+/*----------------------------------------------------------------------
+Name   : __sramfunc void ddr_move_to_Lowpower_state(void)
+Desc   : pctl ½øÈë lowpower state
+Params  : void
+Return  : void
+Notes   : 
+----------------------------------------------------------------------*/
+static __sramfunc void ddr_move_to_Lowpower_state(void)
+{
+    volatile uint32 value;
+
+    while(1)
+    {
+        value = pDDR_Reg->STAT.b.ctl_stat;
+        if(value == Low_power)
+        {
+            break;
+        }
+        switch(value)
+        {
+            case Init_mem:
+                pDDR_Reg->SCTL = CFG_STATE;
+                dsb();
+                while((pDDR_Reg->STAT.b.ctl_stat) != Config);
+            case Config:
+                pDDR_Reg->SCTL = GO_STATE;
+                dsb();
+                while((pDDR_Reg->STAT.b.ctl_stat) != Access);
+            case Access:
+                pDDR_Reg->SCTL = SLEEP_STATE;
+                dsb();
+                while((pDDR_Reg->STAT.b.ctl_stat) != Low_power);
+                break;
+            default:  //Transitional state
+                break;
+        }
+    }
+}
+
+/*----------------------------------------------------------------------
+Name   : __sramfunc void ddr_move_to_Access_state(void)
+Desc   : pctl ½øÈë Access state
+Params  : void
+Return  : void
+Notes   : 
+----------------------------------------------------------------------*/
+static __sramfunc void ddr_move_to_Access_state(void)
+{
+    volatile uint32 value;
+
+    //set auto self-refresh idle
+    //pDDR_Reg->MCFG1=(pDDR_Reg->MCFG1&0xffffff00)| DATA(ddr_sr_idle) | (1<<31);
+       pDDR_Reg->MCFG1=(pDDR_Reg->MCFG1&0xffffff00)| 0 | (1<<31);
+
+    while(1)
+    {
+        value = pDDR_Reg->STAT.b.ctl_stat;
+        if((value == Access)
+           || ((pDDR_Reg->STAT.b.lp_trig == 1) && ((pDDR_Reg->STAT.b.ctl_stat) == Low_power)))
+        {
+            break;
+        }
+        switch(value)
+        {
+            case Low_power:
+                pDDR_Reg->SCTL = WAKEUP_STATE;
+                dsb();
+                while((pDDR_Reg->STAT.b.ctl_stat) != Access);
+                break;
+            case Init_mem:
+                pDDR_Reg->SCTL = CFG_STATE;
+                dsb();
+                while((pDDR_Reg->STAT.b.ctl_stat) != Config);
+            case Config:
+                pDDR_Reg->SCTL = GO_STATE;
+                dsb();
+                while(!(((pDDR_Reg->STAT.b.ctl_stat) == Access)
+                      || ((pDDR_Reg->STAT.b.lp_trig == 1) && ((pDDR_Reg->STAT.b.ctl_stat) == Low_power))));
+                break;
+            default:  //Transitional state
+                break;
+        }
+    }
+    pGRF_Reg->GRF_SOC_CON[2] = (1<<16 | 0);//de_hw_wakeup :enable auto sr if sr_idle != 0
+}
+
+/*----------------------------------------------------------------------
+Name   : __sramfunc void ddr_move_to_Config_state(void)
+Desc   : pctl ½øÈë config state
+Params  : void
+Return  : void
+Notes   : 
+----------------------------------------------------------------------*/
+static __sramfunc void ddr_move_to_Config_state(void)
+{
+    volatile uint32 value;
+    pGRF_Reg->GRF_SOC_CON[2] = (1<<16 | 1); //hw_wakeup :disable auto sr
+    while(1)
+    {
+        value = pDDR_Reg->STAT.b.ctl_stat;
+        if(value == Config)
+        {          
+            break;
+        }
+        switch(value)
+        {
+            case Low_power:
+                pDDR_Reg->SCTL = WAKEUP_STATE;
+                dsb();
+            case Access:
+            case Init_mem:
+                pDDR_Reg->SCTL = CFG_STATE;
+                dsb();
+                break;
+            default:  //Transitional state
+                break;
+        }
+    }
+}
+
+/*----------------------------------------------------------------------
+Name   : void __sramlocalfunc ddr_send_command(uint32 rank, uint32 cmd, uint32 arg)
+Desc   : Í¨¹ýд pctl MCMD¼Ä´æÆ÷Ïòddr·¢ËÍÃüÁî
+Params  : rank ->ddr rank Êý
+          cmd  ->·¢ËÍÃüÁîÀàÐÍ
+          arg  ->·¢Ë͵ÄÊý¾Ý
+Return  : void 
+Notes   : arg°üÀ¨bank_addrºÍcmd_addr
+----------------------------------------------------------------------*/
+static void __sramfunc ddr_send_command(uint32 rank, uint32 cmd, uint32 arg)
+{
+    pDDR_Reg->MCMD = (start_cmd | (rank<<20) | arg | cmd);
+    dsb();
+    while(pDDR_Reg->MCMD & start_cmd);
+}
+
+__sramdata uint32 copy_data[8]={0xffffffff,0x00000000,0x55555555,0xAAAAAAAA,
+                               0xEEEEEEEE,0x11111111,0x22222222,0xDDDDDDDD};/**/
+EXPORT_PIE_SYMBOL(copy_data[8]);
+static uint32 * p_copy_data;
+
+/*----------------------------------------------------------------------
+Name   : uint32_t __sramlocalfunc ddr_data_training(void)
+Desc   : ¶Ôddr×ödata training
+Params  : void
+Return  : void 
+Notes   : Ã»ÓÐ×ödata trainingУÑé
+----------------------------------------------------------------------*/
+static uint32_t __sramfunc ddr_data_training(void)
+{
+    uint32 value;
+    value = pDDR_Reg->TREFI;
+    pDDR_Reg->TREFI = 0;
+    // trigger DTT
+    pPHY_Reg->PHY_REG2 = ((pPHY_Reg->PHY_REG2 & (~0x1)) | PHY_AUTO_CALIBRATION);
+    // wait echo byte DTDONE
+       dsb();
+//    ddr_delayus(1);
+    // stop DTT
+    while((pPHY_Reg->PHY_REG62 & 0x3)!=0x3);
+    pPHY_Reg->PHY_REG2 = (pPHY_Reg->PHY_REG2 & (~0x1));
+    // send some auto refresh to complement the lost while DTT
+    ddr_send_command(3, REF_cmd, 0);    
+    ddr_send_command(3, REF_cmd, 0);
+    ddr_send_command(3, REF_cmd, 0);    
+    ddr_send_command(3, REF_cmd, 0);
+
+    // resume auto refresh
+    pDDR_Reg->TREFI = value;
+
+    return(0);
+}
+
+/*----------------------------------------------------------------------
+Name    : void __sramlocalfunc ddr_set_dll_bypass(uint32 freq)
+Desc    : ÉèÖÃPHY dll ¹¤×÷ģʽ
+Params  : freq -> ddr¹¤×÷ƵÂÊ
+Return  : void 
+Notes   : 
+----------------------------------------------------------------------*/
+static void __sramfunc ddr_set_dll_bypass(uint32 freq)
+{
+    if(freq <= PHY_DLL_DISABLE_FREQ)
+    {
+        pPHY_Reg->PHY_REG2a = 0x1F;         //set cmd,left right dll bypass
+        pPHY_Reg->PHY_REG19 = 0x08;         //cmd slave dll
+        pPHY_Reg->PHY_REG6 = 0x18;          //left TX DQ DLL
+        pPHY_Reg->PHY_REG7 = 0x00;          //left TX DQS DLL
+        pPHY_Reg->PHY_REG9 = 0x18;          //right TX DQ DLL
+        pPHY_Reg->PHY_REG10 = 0x00;         //right TX DQS DLL
+        
+    }
+    else 
+    {
+        pPHY_Reg->PHY_REG2a = 0x03;         //set cmd,left right dll bypass
+        pPHY_Reg->PHY_REG19 = 0x08;         //cmd slave dll
+        pPHY_Reg->PHY_REG6 = 0x0c;          //left TX DQ DLL
+        pPHY_Reg->PHY_REG7 = 0x00;          //left TX DQS DLL
+        pPHY_Reg->PHY_REG9 = 0x0c;          //right TX DQ DLL
+        pPHY_Reg->PHY_REG10 = 0x00;         //right TX DQS DLL                
+    }
+    dsb();
+    //ÆäËûÓëdllÏà¹ØµÄ¼Ä´æÆ÷ÓÐ:REG8(RX DQS),REG11(RX DQS),REG18(CMD),REG21(CK) ±£³ÖĬÈÏÖµ
+}
+
+static noinline uint32 ddr_get_pll_freq(PLL_ID pll_id)   //APLL-1;CPLL-2;DPLL-3;GPLL-4
+{
+    uint32 ret = 0; 
+
+    // freq = (fin*fbdiv/(refdiv * postdiv1 * postdiv2))
+    if(((pCRU_Reg->CRU_MODE_CON>>(pll_id*4))&1) == 1)             // DPLL Normal mode
+        ret= 24 *((pCRU_Reg->CRU_PLL_CON[pll_id][0]&0xfff))    // NF = 2*(CLKF+1)
+                /((pCRU_Reg->CRU_PLL_CON[pll_id][1]&0x3f)
+                *((pCRU_Reg->CRU_PLL_CON[pll_id][0]>>12)&0x7)*((pCRU_Reg->CRU_PLL_CON[pll_id][1]>>6)&0x7));             // OD = 2^CLKOD
+    else
+        ret = 24;
+
+    return ret;
+}
+
+static __sramdata uint32 clkFbDiv;
+static __sramdata uint32 clkPostDiv1;
+static __sramdata uint32 clkPostDiv2;
+
+/*****************************************
+REFDIV   FBDIV     POSTDIV1/POSTDIV2      FOUTPOSTDIV           freq Step        FOUTPOSRDIV            finally use
+==================================================================================================================
+1        17 - 66   4                      100MHz - 400MHz          6MHz          200MHz  <= 300MHz             <= 150MHz
+1        17 - 66   3                      133MHz - 533MHz          8MHz             
+1        17 - 66   2                      200MHz - 800MHz          12MHz         300MHz  <= 600MHz      150MHz <= 300MHz
+1        17 - 66   1                      400MHz - 1600MHz         24MHz         600MHz  <= 1200MHz     300MHz <= 600MHz
+******************************************/
+//for minimum jitter operation, the highest VCO and FREF frequencies should be used.
+/*----------------------------------------------------------------------
+Name    : uint32_t __sramlocalfunc ddr_set_pll(uint32_t nMHz, uint32_t set)
+Desc    : ÉèÖÃddr pll
+Params  : nMHZ -> ddr¹¤×÷ƵÂÊ
+          set  ->0»ñÈ¡ÉèÖõÄƵÂÊÐÅÏ¢
+                 1ÉèÖÃddr pll
+Return  : ÉèÖõÄƵÂÊÖµ 
+Notes   : ÔÚ±äƵʱÐèÒªÏÈset=0µ÷ÓÃÒ»´Îddr_set_pll£¬ÔÙset=1 µ÷ÓÃddr_set_pll
+----------------------------------------------------------------------*/
+static uint32 __sramfunc ddr_set_pll(uint32 nMHz, uint32 set)
+{
+    uint32 ret = 0;
+    int delay = 1000;
+    uint32 pll_id=1;  //DPLL     
+    
+    if(nMHz == 24)
+    {
+        ret = 24;
+        goto out;
+    }
+    if(!set)
+    {
+        if(nMHz <= 150) //ʵ¼ÊÊä³öƵÂÊ<300
+        {
+            clkPostDiv1 = 6;
+        }
+        else if(nMHz <=200)
+        {
+            clkPostDiv1 = 4;
+        }
+        else if(nMHz <= 300)
+        {
+            clkPostDiv1 = 3;
+        }
+        else if(nMHz <=450)
+        {
+            clkPostDiv1 = 2;
+        }
+        else
+        {
+            clkPostDiv1 = 1;
+        }
+        clkPostDiv2 = 1;
+        clkFbDiv = (nMHz * 2 * DDR_PLL_REFDIV * clkPostDiv1 * clkPostDiv2)/24;//×îºóËÍÈëddrµÄÊÇÔÙ¾­¹ý2·ÖƵ
+        ret = (24 * clkFbDiv)/(2 * DDR_PLL_REFDIV * clkPostDiv1 * clkPostDiv2);
+    }
+    else
+    {
+        pCRU_Reg->CRU_MODE_CON = (0x1<<((pll_id*4) +  16)) | (0x0<<(pll_id*4));            //PLL slow-mode
+    
+        pCRU_Reg->CRU_PLL_CON[pll_id][0] = FBDIV(clkFbDiv) | POSTDIV1(clkPostDiv1);
+        pCRU_Reg->CRU_PLL_CON[pll_id][1] = REFDIV(DDR_PLL_REFDIV) | POSTDIV2(clkPostDiv2) | (0x10001<<12);//interger mode
+
+        ddr_delayus(1);
+
+        while (delay > 0) 
+        {
+           ddr_delayus(1);
+               if (pCRU_Reg->CRU_PLL_CON[pll_id][1] & (PLL_LOCK_STATUS))        // wait for pll locked
+                       break;
+               delay--;
+       }
+        
+        pCRU_Reg->CRU_CLKSEL_CON[26] = ((0x3<<16) | 0x0);           //clk_ddr_src:clk_ddrphy = 1:1       
+        pCRU_Reg->CRU_MODE_CON = (0x1<<((pll_id*4) +  16))  | (0x1<<(pll_id*4));            //PLL normal
+    }
+out:
+    return ret;
+}
+
+uint32 PIE_FUNC(ddr_set_pll)(uint32 nMHz, uint32 set)
+{
+    return ddr_set_pll(nMHz,set);
+}
+EXPORT_PIE_SYMBOL(FUNC(ddr_set_pll));
+
+/*----------------------------------------------------------------------
+Name    : uint32_t ddr_get_parameter(uint32_t nMHz)
+Desc    : »ñÈ¡ÅäÖòÎÊý
+Params  : nMHZ -> ddr¹¤×÷ƵÂÊ     
+Return  : 0 ³É¹¦
+          -1 Ê§°Ü
+          -4 ÆµÂÊÖµ³¬¹ý¿ÅÁ£×î´óƵÂÊ
+Notes   : 
+----------------------------------------------------------------------*/
+static uint32 ddr_get_parameter(uint32 nMHz)
+{
+    uint32_t tmp;
+    uint32_t ret = 0;
+    uint32_t al;
+    uint32_t bl;
+    uint32_t cl;
+    uint32_t cwl;    
+    PCTL_TIMING_T *p_pctl_timing = &(p_ddr_reg->pctl_timing);
+    NOC_TIMING_T  *p_noc_timing=&(p_ddr_reg->noc_timing);
+
+    p_pctl_timing->togcnt1u = nMHz;
+    p_pctl_timing->togcnt100n = nMHz/10;
+    p_pctl_timing->tinit = 200;
+    p_pctl_timing->trsth = 500;
+
+    if(p_ddr_reg->mem_type == DDR3)
+    {
+        if(p_ddr_reg->ddr_speed_bin > DDR3_DEFAULT)
+        {
+            ret = -1;
+            goto out;
+        }
+
+        #define DDR3_tREFI_7_8_us    (78)
+        #define DDR3_tMRD            (4)
+        #define DDR3_tRFC_512Mb      (90)
+        #define DDR3_tRFC_1Gb        (110)
+        #define DDR3_tRFC_2Gb        (160)
+        #define DDR3_tRFC_4Gb        (300)
+        #define DDR3_tRFC_8Gb        (350)
+        #define DDR3_tRTW            (2)   //register min valid value
+        #define DDR3_tRAS            (37)
+        #define DDR3_tRRD            (10)
+        #define DDR3_tRTP            (7)
+        #define DDR3_tWR             (15)
+        #define DDR3_tWTR            (7)
+        #define DDR3_tXP             (7)
+        #define DDR3_tXPDLL          (24)
+        #define DDR3_tZQCS           (80)
+        #define DDR3_tZQCSI          (10000)
+        #define DDR3_tDQS            (1)
+        #define DDR3_tCKSRE          (10)
+        #define DDR3_tCKE_400MHz     (7)
+        #define DDR3_tCKE_533MHz     (6)
+        #define DDR3_tMOD            (15)
+        #define DDR3_tRSTL           (100)
+        #define DDR3_tZQCL           (320)
+        #define DDR3_tDLLK           (512)
+
+        al = 0;
+        bl = 8;
+        if(nMHz <= 330)
+        {
+            tmp = 0;
+        }
+        else if(nMHz<=400)
+        {
+            tmp = 1;
+        }
+        else if(nMHz<=533)
+        {
+            tmp = 2;
+        }
+        else //666MHz
+        {
+            tmp = 3;
+        }
+        if(nMHz < DDR3_DDR2_DLL_DISABLE_FREQ)       //when dll bypss cl = cwl = 6;
+        {
+            cl = 6;
+            cwl = 6;
+        }
+        else
+        {
+            cl = ddr3_cl_cwl[p_ddr_reg->ddr_speed_bin][tmp] >> 16;
+            cwl = ddr3_cl_cwl[p_ddr_reg->ddr_speed_bin][tmp] & 0x0ff;
+        }
+        if(cl == 0)
+        {
+            ret = -4; //³¬¹ý¿ÅÁ£µÄ×î´óƵÂÊ
+        }
+        if(nMHz <= DDR3_DDR2_ODT_DISABLE_FREQ)     
+        {
+            p_ddr_reg->ddrMR[1] = DDR3_DS_40 | DDR3_Rtt_Nom_DIS;
+        }
+        else
+        {
+            p_ddr_reg->ddrMR[1] = DDR3_DS_40 | DDR3_Rtt_Nom_120;
+        }
+        p_ddr_reg->ddrMR[2] = DDR3_MR2_CWL(cwl) /* | DDR3_Rtt_WR_60 */;
+        p_ddr_reg->ddrMR[3] = 0;
+        /**************************************************
+         * PCTL Timing
+         **************************************************/
+        /*
+         * tREFI, average periodic refresh interval, 7.8us
+         */
+        p_pctl_timing->trefi = DDR3_tREFI_7_8_us;
+        /*
+         * tMRD, 4 tCK
+         */
+        p_pctl_timing->tmrd = DDR3_tMRD & 0x7;
+        /*
+         * tRFC, 90ns(512Mb),110ns(1Gb),160ns(2Gb),300ns(4Gb),350ns(8Gb)
+         */
+        if(p_ddr_reg->ddr_capability_per_die <= 0x4000000)         // 512Mb 90ns
+        {
+            tmp = DDR3_tRFC_512Mb;
+        }
+        else if(p_ddr_reg->ddr_capability_per_die <= 0x8000000)    // 1Gb 110ns
+        {
+            tmp = DDR3_tRFC_1Gb;
+        }
+        else if(p_ddr_reg->ddr_capability_per_die <= 0x10000000)   // 2Gb 160ns
+        {
+            tmp = DDR3_tRFC_2Gb;
+        }
+        else if(p_ddr_reg->ddr_capability_per_die <= 0x20000000)   // 4Gb 300ns
+        {
+            tmp = DDR3_tRFC_4Gb;
+        }
+        else    // 8Gb  350ns
+        {
+            tmp = DDR3_tRFC_8Gb;
+        }
+        p_pctl_timing->trfc = (tmp*nMHz+999)/1000;
+        /*
+         * tXSR, =tDLLK=512 tCK
+         */
+        p_pctl_timing->texsr = DDR3_tDLLK;
+        /*
+         * tRP=CL
+         */
+        p_pctl_timing->trp = cl;
+        /*
+         * WrToMiss=WL*tCK + tWR + tRP + tRCD
+         */
+        p_noc_timing->b.WrToMiss = ((cwl+((DDR3_tWR*nMHz+999)/1000)+cl+cl)&0x3F);
+        /*
+         * tRC=tRAS+tRP
+         */
+        p_pctl_timing->trc = ((((ddr3_tRC_tFAW[p_ddr_reg->ddr_speed_bin]>>16)*nMHz+999)/1000)&0x3F);
+        p_noc_timing->b.ActToAct = ((((ddr3_tRC_tFAW[p_ddr_reg->ddr_speed_bin]>>16)*nMHz+999)/1000)&0x3F);
+
+        p_pctl_timing->trtw = (cl+2-cwl);//DDR3_tRTW;
+        p_noc_timing->b.RdToWr = ((cl+2-cwl)&0x1F);
+        p_pctl_timing->tal = al;
+        p_pctl_timing->tcl = cl;
+        p_pctl_timing->tcwl = cwl;
+        /*
+         * tRAS, 37.5ns(400MHz)     37.5ns(533MHz)
+         */
+        p_pctl_timing->tras = (((DDR3_tRAS*nMHz+(nMHz>>1)+999)/1000)&0x3F);
+        /*
+         * tRCD=CL
+         */
+        p_pctl_timing->trcd = cl;
+        /*
+         * tRRD = max(4nCK, 7.5ns), DDR3-1066(1K), DDR3-1333(2K), DDR3-1600(2K)
+         *        max(4nCK, 10ns), DDR3-800(1K,2K), DDR3-1066(2K)
+         *        max(4nCK, 6ns), DDR3-1333(1K), DDR3-1600(1K)
+         *
+         */
+        tmp = ((DDR3_tRRD*nMHz+999)/1000);
+        if(tmp < 4)
+        {
+            tmp = 4;
+        }
+        p_pctl_timing->trrd = (tmp&0xF);
+        /*
+         * tRTP, max(4 tCK,7.5ns)
+         */
+        tmp = ((DDR3_tRTP*nMHz+(nMHz>>1)+999)/1000);
+        if(tmp < 4)
+        {
+            tmp = 4;
+        }
+        p_pctl_timing->trtp = tmp&0xF;
+        /*
+         * RdToMiss=tRTP+tRP + tRCD - (BL/2 * tCK)
+         */
+        p_noc_timing->b.RdToMiss = ((tmp+cl+cl-(bl>>1))&0x3F);
+        /*
+         * tWR, 15ns
+         */
+        tmp = ((DDR3_tWR*nMHz+999)/1000);
+        p_pctl_timing->twr = tmp&0x1F;
+        if(tmp<9)
+            tmp = tmp - 4;
+        else
+            tmp = tmp>>1;
+        p_ddr_reg->ddrMR[0] = DDR3_BL8 | DDR3_CL(cl) | DDR3_WR(tmp);
+
+        /*
+         * tWTR, max(4 tCK,7.5ns)
+         */
+        tmp = ((DDR3_tWTR*nMHz+(nMHz>>1)+999)/1000);
+        if(tmp < 4)
+        {
+            tmp = 4;
+        }
+        p_pctl_timing->twtr = tmp&0xF;
+        p_noc_timing->b.WrToRd = ((tmp+cwl)&0x1F);
+        /*
+         * tXP, max(3 tCK, 7.5ns)(<933MHz)
+         */
+        tmp = ((DDR3_tXP*nMHz+(nMHz>>1)+999)/1000);
+        if(tmp < 3)
+        {
+            tmp = 3;
+        }
+        p_pctl_timing->txp = tmp&0x7;
+        /*
+         * tXPDLL, max(10 tCK,24ns)
+         */
+        tmp = ((DDR3_tXPDLL*nMHz+999)/1000);
+        if(tmp < 10)
+        {
+            tmp = 10;
+        }
+        p_pctl_timing->txpdll = tmp & 0x3F;
+        /*
+         * tZQCS, max(64 tCK, 80ns)
+         */
+        tmp = ((DDR3_tZQCS*nMHz+999)/1000);
+        if(tmp < 64)
+        {
+            tmp = 64;
+        }
+        p_pctl_timing->tzqcs = tmp&0x7F;
+        /*
+         * tZQCSI,
+         */
+        p_pctl_timing->tzqcsi = DDR3_tZQCSI;
+        /*
+         * tDQS,
+         */
+        p_pctl_timing->tdqs = DDR3_tDQS;
+        /*
+         * tCKSRE, max(5 tCK, 10ns)
+         */
+        tmp = ((DDR3_tCKSRE*nMHz+999)/1000);
+        if(tmp < 5)
+        {
+            tmp = 5;
+        }
+        p_pctl_timing->tcksre = tmp & 0x1F;
+        /*
+         * tCKSRX, max(5 tCK, 10ns)
+         */
+        p_pctl_timing->tcksrx = tmp & 0x1F;
+        /*
+         * tCKE, max(3 tCK,7.5ns)(400MHz) max(3 tCK,5.625ns)(533MHz)
+         */
+        if(nMHz>=533)
+        {
+            tmp = ((DDR3_tCKE_533MHz*nMHz+999)/1000);
+        }
+        else
+        {
+            tmp = ((DDR3_tCKE_400MHz*nMHz+(nMHz>>1)+999)/1000);
+        }
+        if(tmp < 3)
+        {
+            tmp = 3;
+        }
+        p_pctl_timing->tcke = tmp & 0x7;
+        /*
+         * tCKESR, =tCKE + 1tCK
+         */
+        p_pctl_timing->tckesr = (tmp+1)&0xF;
+        /*
+         * tMOD, max(12 tCK,15ns)
+         */
+        tmp = ((DDR3_tMOD*nMHz+999)/1000);
+        if(tmp < 12)
+        {
+            tmp = 12;
+        }
+        p_pctl_timing->tmod = tmp&0x1F;
+        /*
+         * tRSTL, 100ns
+         */
+        p_pctl_timing->trstl = ((DDR3_tRSTL*nMHz+999)/1000)&0x7F;
+        /*
+         * tZQCL, max(256 tCK, 320ns)
+         */
+        tmp = ((DDR3_tZQCL*nMHz+999)/1000);
+        if(tmp < 256)
+        {
+            tmp = 256;
+        }
+        p_pctl_timing->tzqcl = tmp&0x3FF;
+        /*
+         * tMRR, 0 tCK
+         */
+        p_pctl_timing->tmrr = 0;
+        /*
+         * tDPD, 0
+         */
+        p_pctl_timing->tdpd = 0;
+
+        /**************************************************
+         * NOC Timing
+         **************************************************/
+        p_noc_timing->b.BurstLen = ((bl>>1)&0x7);
+    }
+    else
+    {
+        ret = -1;
+    }
+        
+out:
+    return ret;
+}
+
+/*----------------------------------------------------------------------
+Name    : uint32_t __sramlocalfunc ddr_update_timing(void)
+Desc    : ¸üÐÂpctl phy Ïà¹Øtiming¼Ä´æÆ÷
+Params  : void  
+Return  : 0 ³É¹¦
+Notes   : 
+----------------------------------------------------------------------*/
+static uint32 __sramfunc ddr_update_timing(void)
+{
+    PCTL_TIMING_T *p_pctl_timing = &(DATA(ddr_reg).pctl_timing);
+    NOC_TIMING_T  *p_noc_timing = &(DATA(ddr_reg).noc_timing);
+
+    ddr_copy((uint32 *)&(pDDR_Reg->TOGCNT1U), (uint32*)&(p_pctl_timing->togcnt1u), 34);
+    pPHY_Reg->PHY_REG3 = (0x12 << 1) | (ddr2_ddr3_bl_8);   //0x12Ϊ±£ÁôλµÄĬÈÏÖµ£¬ÒÔĬÈÏÖµ»Øд
+    pPHY_Reg->PHY_REG4a = ((p_pctl_timing->tcl << 4) | (p_pctl_timing->tal));
+    *(volatile uint32 *)SysSrv_DdrTiming = p_noc_timing->d32;
+    // Update PCTL BL
+//    if(DATA(ddr_reg).mem_type == DDR3)
+    {
+        pDDR_Reg->MCFG = (pDDR_Reg->MCFG & (~(0x1|(0x3<<18)|(0x1<<17)|(0x1<<16)))) | ddr2_ddr3_bl_8 | tfaw_cfg(5)|pd_exit_slow|pd_type(1);
+        pDDR_Reg->DFITRDDATAEN   = (pDDR_Reg->TAL + pDDR_Reg->TCL)-3;  //trdata_en = rl-3
+        pDDR_Reg->DFITPHYWRLAT   = pDDR_Reg->TCWL-1;
+    }
+    return 0;
+}
+
+/*----------------------------------------------------------------------
+Name    : uint32_t __sramlocalfunc ddr_update_mr(void)
+Desc    : ¸üпÅÁ£MR¼Ä´æÆ÷
+Params  : void  
+Return  : void
+Notes   : 
+----------------------------------------------------------------------*/
+static uint32 __sramfunc ddr_update_mr(void)
+{
+    uint32 cs;
+
+    cs = READ_CS_INFO();
+    cs = cs + (1 << cs);                               //case 0:1rank cs=1; case 1:2rank cs =3;
+    if(DATA(ddr_freq) > DDR3_DDR2_DLL_DISABLE_FREQ)
+    {
+        if(DATA(ddr_dll_status) == DDR3_DLL_DISABLE)  // off -> on
+        {
+            ddr_send_command(cs, MRS_cmd, bank_addr(0x1) | cmd_addr((DATA(ddr_reg).ddrMR[1])));  //DLL enable
+            ddr_send_command(cs, MRS_cmd, bank_addr(0x0) | cmd_addr(((DATA(ddr_reg).ddrMR[0]))| DDR3_DLL_RESET));  //DLL reset
+            ddr_delayus(2);  //at least 200 DDR cycle
+            ddr_send_command(cs, MRS_cmd, bank_addr(0x0) | cmd_addr((DATA(ddr_reg).ddrMR[0])));
+            DATA(ddr_dll_status) = DDR3_DLL_ENABLE;
+        }
+        else // on -> on
+        {
+            ddr_send_command(cs, MRS_cmd, bank_addr(0x1) | cmd_addr((DATA(ddr_reg).ddrMR[1])));
+            ddr_send_command(cs, MRS_cmd, bank_addr(0x0) | cmd_addr((DATA(ddr_reg).ddrMR[0])));
+        }
+    }
+    else
+    {
+        ddr_send_command(cs, MRS_cmd, bank_addr(0x1) | cmd_addr(((DATA(ddr_reg).ddrMR[1])) | DDR3_DLL_DISABLE));  //DLL disable
+        ddr_send_command(cs, MRS_cmd, bank_addr(0x0) | cmd_addr((DATA(ddr_reg).ddrMR[0])));
+        DATA(ddr_dll_status) = DDR3_DLL_DISABLE;
+    }
+    ddr_send_command(cs, MRS_cmd, bank_addr(0x2) | cmd_addr((DATA(ddr_reg).ddrMR[2])));
+
+    return 0;
+}
+
+/*----------------------------------------------------------------------
+Name    : void __sramlocalfunc ddr_update_odt(void)
+Desc    : update PHY odt & PHY driver impedance
+Params  : void  
+Return  : void
+Notes   : 
+----------------------------------------------------------------------*/
+static void __sramfunc ddr_update_odt(void)
+{
+    uint32 tmp;
+    
+    //adjust DRV and ODT
+    if(DATA(ddr_freq) <= PHY_ODT_DISABLE_FREQ)
+    {
+        pPHY_Reg->PHY_REG27 = PHY_RTT_DISABLE;  //dynamic RTT disable, Left 8bit ODT
+        pPHY_Reg->PHY_REG28 = PHY_RTT_DISABLE;  //Right 8bit ODT
+        pPHY_Reg->PHY_REG0e4 = (0x0E & 0xc)|0x1;//off DQS ODT  bit[1:0]=2'b01 
+        pPHY_Reg->PHY_REG124 = (0x0E & 0xc)|0x1;//off DQS ODT  bit[1:0]=2'b01 
+    }
+    else
+    {
+        pPHY_Reg->PHY_REG27 = ((PHY_RTT_215ohm<<4) | PHY_RTT_215ohm);       
+        pPHY_Reg->PHY_REG28 = ((PHY_RTT_215ohm<<4) | PHY_RTT_215ohm);    
+        pPHY_Reg->PHY_REG0e4 = 0x0E;           //on DQS ODT default:0x0E
+        pPHY_Reg->PHY_REG124 = 0x0E;           //on DQS ODT default:0x0E
+    }
+
+    tmp = ((PHY_RON_45ohm<<4) | PHY_RON_45ohm);     
+    pPHY_Reg->PHY_REG16 = tmp;  //CMD driver strength
+    pPHY_Reg->PHY_REG22 = tmp;  //CK driver strength    
+    pPHY_Reg->PHY_REG25 = tmp;  //Left 8bit DQ driver strength
+    pPHY_Reg->PHY_REG26 = tmp;  //Right 8bit DQ driver strength
+    dsb();
+}
+
+/*----------------------------------------------------------------------
+Name    : __sramfunc void ddr_adjust_config(uint32_t dram_type)
+Desc    : 
+Params  : dram_type ->¿ÅÁ£ÀàÐÍ
+Return  : void
+Notes   : 
+----------------------------------------------------------------------*/
+#if 0
+__sramfunc void ddr_adjust_config(uint32_t dram_type)
+{
+//    uint32 value;
+    unsigned long save_sp;
+    uint32 i;
+    volatile uint32 n; 
+    volatile unsigned int * temp=(volatile unsigned int *)SRAM_CODE_OFFSET;
+
+    //get data training address before idle port
+//    value = ddr_get_datatraing_addr();    //Inno PHY ²»ÐèÒªtraining address
+
+    /** 1. Make sure there is no host access */
+    flush_cache_all();
+    outer_flush_all();
+    flush_tlb_all();
+    DDR_SAVE_SP(save_sp);
+
+    for(i=0;i<2;i++)        //8KB SRAM
+    {
+        n=temp[1024*i];
+        barrier();
+    }
+    n= pDDR_Reg->SCFG.d32;
+    n= pPHY_Reg->PHY_REG1;
+    n= pCRU_Reg->CRU_PLL_CON[0][0];
+    n= *(volatile uint32_t *)SysSrv_DdrTiming;
+    dsb();
+    
+    //enter config state
+    ddr_move_to_Config_state();
+//    pDDR_Reg->DFIODTCFG = ((1<<3) | (1<<11));  //loaderÖЩÁ˳õʼ»¯
+    pPHY_Reg->PHY_REG5d = 0X77;
+    pPHY_Reg->PHY_REG5e = 0X77;
+    //set auto power down idle
+    pDDR_Reg->MCFG=(pDDR_Reg->MCFG&0xffff00ff)|(PD_IDLE<<8);
+
+    //enable the hardware low-power interface
+    pDDR_Reg->SCFG.b.hw_low_power_en = 1;
+
+    ddr_update_odt();
+
+    //enter access state
+    ddr_move_to_Access_state();
+
+    DDR_RESTORE_SP(save_sp);
+}
+#endif 
+
+static void __sramfunc idle_port(void)
+{
+    int i;
+    uint32 clk_gate[10];
+
+    //save clock gate status
+    for(i=0;i<10;i++)
+    {
+        clk_gate[i]=pCRU_Reg->CRU_CLKGATE_CON[i];
+    }
+    //enable all clock gate for request idle
+    for(i=0;i<10;i++)
+    {
+        pCRU_Reg->CRU_CLKGATE_CON[i]=0xffff0000;
+    }
+
+    pGRF_Reg->GRF_SOC_CON[2] = (1 << (16+peri_pwr_idlereq))+(1 << peri_pwr_idlereq);         //peri   bit 12
+    dsb();
+    while( (pGRF_Reg->GRF_SOC_STATUS0 & peri_pwr_idle) == 0);//   bit 23
+
+    pGRF_Reg->GRF_SOC_CON[2] = (1 << (16+vio_pwr_idlereq))+(1 << vio_pwr_idlereq);          //vio
+    dsb();
+    while( (pGRF_Reg->GRF_SOC_STATUS0 & vio_pwr_idle) == 0);
+  
+    pGRF_Reg->GRF_SOC_CON[2] = (1 << (16+vpu_pwr_idlereq))+(1 << vpu_pwr_idlereq);          //vpu
+    dsb();
+    while( (pGRF_Reg->GRF_SOC_STATUS0 & vpu_pwr_idle) == 0);
+      
+    pGRF_Reg->GRF_SOC_CON[2] = (1 << (16+gpu_pwr_idlereq))+(1 << gpu_pwr_idlereq);          //gpu
+    dsb();
+    while( (pGRF_Reg->GRF_SOC_STATUS0 & gpu_pwr_idle) == 0);
+    
+       //resume clock gate status
+    for(i=0;i<10;i++)
+        pCRU_Reg->CRU_CLKGATE_CON[i]=  (clk_gate[i] | 0xffff0000);
+}
+
+
+static void __sramfunc deidle_port(void)
+{
+    int i;
+    uint32 clk_gate[10];
+
+    //save clock gate status
+    for(i=0;i<10;i++)
+    {
+        clk_gate[i]=pCRU_Reg->CRU_CLKGATE_CON[i];
+    }
+    //enable all clock gate for request idle
+    for(i=0;i<10;i++)
+    {
+        pCRU_Reg->CRU_CLKGATE_CON[i]=0xffff0000;
+    }
+   
+    pGRF_Reg->GRF_SOC_CON[2] = (1 << (16+peri_pwr_idlereq))+(0 << peri_pwr_idlereq);         //peri   bit 12
+    dsb();
+    while( (pGRF_Reg->GRF_SOC_STATUS0 & peri_pwr_idle) != 0);
+
+    pGRF_Reg->GRF_SOC_CON[2] = (1 << (16+vio_pwr_idlereq))+(0 << vio_pwr_idlereq);          //vio
+    dsb();
+    while( (pGRF_Reg->GRF_SOC_STATUS0 & vio_pwr_idle) != 0);
+      
+    pGRF_Reg->GRF_SOC_CON[2] = (1 << (16+vpu_pwr_idlereq))+(0 << vpu_pwr_idlereq);          //vpu
+    dsb();
+    while( (pGRF_Reg->GRF_SOC_STATUS0 & vpu_pwr_idle) != 0);
+        
+    pGRF_Reg->GRF_SOC_CON[2] = (1 << (16+gpu_pwr_idlereq))+(0 << gpu_pwr_idlereq);          //gpu
+    dsb();
+    while( (pGRF_Reg->GRF_SOC_STATUS0 & gpu_pwr_idle) != 0);
+    
+    //resume clock gate status
+    for(i=0;i<10;i++)
+        pCRU_Reg->CRU_CLKGATE_CON[i]=  (clk_gate[i] | 0xffff0000);
+
+}
+
+
+
+/*----------------------------------------------------------------------
+Name    : void __sramlocalfunc ddr_selfrefresh_enter(uint32 nMHz)
+Desc    : ½øÈë×ÔË¢ÐÂ
+Params  : nMHz ->ddrƵÂÊ
+Return  : void
+Notes   : 
+----------------------------------------------------------------------*/
+/*
+static void __sramfunc ddr_selfrefresh_enter(uint32 nMHz)
+{    
+    ddr_move_to_Config_state();
+    ddr_move_to_Lowpower_state();
+       pPHY_Reg->PHY_REG264 &= ~(1<<1);
+    pPHY_Reg->PHY_REG1 = (pPHY_Reg->PHY_REG1 & (~(0x3<<2)));     //phy soft reset
+    dsb();
+    pCRU_Reg->CRU_CLKGATE_CON[0] = ((0x1<<2)<<16) | (1<<2);  //disable DDR PHY clock
+    ddr_delayus(1);
+}
+*/
+static uint32 dtt_buffer[8];
+
+/*----------------------------------------------------------------------
+Name    : void ddr_dtt_check(void)
+Desc    : data training check
+Params  : void
+Return  : void
+Notes   : 
+----------------------------------------------------------------------*/
+static void ddr_dtt_check(void)
+{
+    uint32 i;
+    for(i=0;i<8;i++)
+    {
+        dtt_buffer[i] = p_copy_data[i];
+    }
+    dsb();
+    flush_cache_all();
+    outer_flush_all();
+    for(i=0;i<8;i++)
+    {
+        if(dtt_buffer[i] != p_copy_data[i])
+        {
+//            sram_printascii("DTT failed!\n");
+            break;
+        }
+        dtt_buffer[i] = 0;
+    }
+
+}
+
+/*----------------------------------------------------------------------
+Name    : void __sramlocalfunc ddr_selfrefresh_exit(void)
+Desc    : Í˳ö×ÔË¢ÐÂ
+Params  : void
+Return  : void
+Notes   : 
+----------------------------------------------------------------------*/
+#if 0
+static void __sramfunc ddr_selfrefresh_exit(void)
+{
+    pCRU_Reg->CRU_CLKGATE_CON[0] = ((0x1<<2)<<16) | (0<<2);  //enable DDR PHY clock
+    dsb();
+    ddr_delayus(1);
+       pPHY_Reg->PHY_REG1 = (pPHY_Reg->PHY_REG1 | (0x3 << 2)); //phy soft de-reset
+       pPHY_Reg->PHY_REG264 |= (1<<1);
+       dsb();
+    ddr_move_to_Config_state();    
+    ddr_data_training(); 
+    ddr_move_to_Access_state();
+//    ddr_dtt_check();
+}
+#endif
+/*----------------------------------------------------------------------
+Name    : void __sramlocalfunc ddr_change_freq_in(uint32 freq_slew)
+Desc    : ÉèÖÃddr pllÇ°µÄtiming¼°mr²ÎÊýµ÷Õû
+Params  : freq_slew :±äƵбÂÊ 1Éýƽ  0½µÆµ
+Return  : void
+Notes   : 
+----------------------------------------------------------------------*/
+static void __sramlocalfunc ddr_change_freq_in(uint32 freq_slew)
+{
+    uint32 value_100n, value_1u;
+    
+    if(freq_slew == 1)
+    {
+        value_100n = DATA(ddr_reg).pctl_timing.togcnt100n;
+        value_1u = DATA(ddr_reg).pctl_timing.togcnt1u;
+        DATA(ddr_reg).pctl_timing.togcnt1u = pDDR_Reg->TOGCNT1U;
+        DATA(ddr_reg).pctl_timing.togcnt100n = pDDR_Reg->TOGCNT100N;
+        ddr_update_timing();                
+        ddr_update_mr();
+        DATA(ddr_reg).pctl_timing.togcnt100n = value_100n;
+        DATA(ddr_reg).pctl_timing.togcnt1u = value_1u;
+    }
+    else
+    {
+        pDDR_Reg->TOGCNT100N = DATA(ddr_reg).pctl_timing.togcnt100n;
+        pDDR_Reg->TOGCNT1U = DATA(ddr_reg).pctl_timing.togcnt1u;
+    }
+
+    pDDR_Reg->TZQCSI = 0;    
+
+}
+
+
+
+/*----------------------------------------------------------------------
+Name    : void __sramlocalfunc ddr_change_freq_out(uint32 freq_slew)
+Desc    : ÉèÖÃddr pllºóµÄtiming¼°mr²ÎÊýµ÷Õû
+Params  : freq_slew :±äƵбÂÊ 1Éýƽ  0½µÆµ
+Return  : void
+Notes   : 
+----------------------------------------------------------------------*/
+static void __sramlocalfunc ddr_change_freq_out(uint32 freq_slew)
+{
+    if(freq_slew == 1)
+    {
+        pDDR_Reg->TOGCNT100N = DATA(ddr_reg).pctl_timing.togcnt100n;
+        pDDR_Reg->TOGCNT1U = DATA(ddr_reg).pctl_timing.togcnt1u;
+        pDDR_Reg->TZQCSI = DATA(ddr_reg).pctl_timing.tzqcsi;
+    }
+    else
+    {
+        ddr_update_timing();
+        ddr_update_mr();
+    }
+    ddr_data_training();
+}
+
+static void __sramfunc ddr_SRE_2_SRX(uint32 freq, uint32 freq_slew)
+{
+    idle_port();
+
+    ddr_move_to_Config_state(); 
+    DATA(ddr_freq) = freq;
+    ddr_change_freq_in(freq_slew);
+    ddr_move_to_Lowpower_state();
+    pPHY_Reg->PHY_REG264 &= ~(1<<1);
+    pPHY_Reg->PHY_REG1 = (pPHY_Reg->PHY_REG1 & (~(0x3<<2)));     //phy soft reset
+    dsb();    
+    /** 3. change frequence  */
+    FUNC(ddr_set_pll)(freq,1);
+    ddr_set_dll_bypass(freq);    //set phy dll mode;
+       pPHY_Reg->PHY_REG1 = (pPHY_Reg->PHY_REG1 | (0x3 << 2)); //phy soft de-reset
+       pPHY_Reg->PHY_REG264 |= (1<<1);
+       dsb();
+       ddr_update_odt();
+    ddr_move_to_Config_state();
+    ddr_change_freq_out(freq_slew);
+    ddr_move_to_Access_state();
+
+    deidle_port();
+}
+
+void PIE_FUNC(ddr_change_freq_sram)(void *arg)
+{
+    struct ddr_change_freq_sram_param *param = arg;  
+    /* Make sure ddr_SRE_2_SRX paramter less than 4 */
+    ddr_SRE_2_SRX(param->freq, param->freq_slew);
+}
+EXPORT_PIE_SYMBOL(FUNC(ddr_change_freq_sram));
+
+/*----------------------------------------------------------------------
+Name    : uint32_t __sramfunc ddr_change_freq(uint32_t nMHz)
+Desc    : ddr±äƵ
+Params  : nMHz -> ±äƵµÄƵÂÊÖµ
+Return  : ÆµÂÊÖµ
+Notes   :
+----------------------------------------------------------------------*/
+static uint32 ddr_change_freq_sram(uint32 nMHz, struct ddr_freq_t ddr_freq_t)
+{
+    uint32 ret;
+    uint32 i;
+    volatile uint32 n; 
+    unsigned long flags;
+    volatile unsigned int * temp=(volatile unsigned int *)SRAM_CODE_OFFSET;
+
+    struct ddr_change_freq_sram_param param;
+    //uint32 freq;
+       uint32 freq_slew;
+       uint32 arm_freq;
+       
+    arm_freq= ddr_get_pll_freq(APLL);   
+    *kern_to_pie(rockchip_pie_chunk, &DATA(loops_per_us)) = LPJ_100MHZ*arm_freq/1000000;  
+    ret =(fn_to_pie(rockchip_pie_chunk, &FUNC(ddr_set_pll)))(nMHz,0);
+    if(ret == *p_ddr_freq)
+    {
+        goto out;
+    }
+    else 
+    {
+        freq_slew = (ret > *p_ddr_freq)? 1 : -1;
+    }    
+    ddr_get_parameter(ret);
+    //*kern_to_pie(rockchip_pie_chunk, &DATA(ddr_freq))= ret;
+    /** 1. Make sure there is no host access */
+    local_irq_save(flags);
+       local_fiq_disable();
+    flush_cache_all();
+       outer_flush_all();
+       flush_tlb_all();
+       //DDR_SAVE_SP(save_sp);
+       
+#if defined (DDR_CHANGE_FREQ_IN_LCDC_VSYNC)  
+        n = ddr_freq_t.screen_ft_us;
+        n = ddr_freq_t.t0;
+        dsb();
+    
+        if(ddr_freq_t.screen_ft_us > 0){
+    
+            ddr_freq_t.t1 = cpu_clock(0);
+            ddr_freq_t.t2 = (u32)(ddr_freq_t.t1 - ddr_freq_t.t0);   //ns
+    
+    
+            if( (ddr_freq_t.t2 > ddr_freq_t.screen_ft_us*1000) && (ddr_freq_t.screen_ft_us != 0xfefefefe)){
+            
+            //DDR_RESTORE_SP(save_sp);
+            local_fiq_enable();
+            local_irq_restore(flags);
+            return 0;
+            }else{                      
+                rk_fb_poll_wait_frame_complete();
+            }
+        }
+#endif
+
+       for(i=0;i<2;i++)    //8KB SRAM
+       {
+           n=temp[1024*i];
+        barrier();
+       }
+    n= pDDR_Reg->SCFG.d32;
+    n= pPHY_Reg->PHY_REG1;
+    n= pCRU_Reg->CRU_PLL_CON[0][0];
+    n= *(volatile uint32_t *)SysSrv_DdrTiming;
+    n= pGRF_Reg->GRF_SOC_STATUS0;
+    dsb();
+    param.freq = ret;
+    param.freq_slew = freq_slew;
+    call_with_stack(fn_to_pie(rockchip_pie_chunk, &FUNC(ddr_change_freq_sram)),
+                    &param,
+                    rockchip_sram_stack-(NR_CPUS-1)*PAUSE_CPU_STACK_SIZE);
+    /** 5. Issues a Mode Exit command   */
+   // DDR_RESTORE_SP(save_sp);
+    ddr_dtt_check();
+    local_fiq_enable();
+    local_irq_restore(flags);
+//    clk_set_rate(clk_get(NULL, "ddr_pll"), 0);    
+out:
+    return ret;
+}
+
+static uint32 _ddr_change_freq_3036(uint32_t nMHz)
+{
+       struct ddr_freq_t ddr_freq_t;
+       ddr_freq_t.screen_ft_us = 0;
+
+       return ddr_change_freq_sram(nMHz,ddr_freq_t);
+}
+
+EXPORT_SYMBOL(_ddr_change_freq_3036);
+
+static void __sramlocalfunc ddr_selfrefresh_enter(uint32 nMHz)
+{    
+    ddr_move_to_Config_state();
+    ddr_move_to_Lowpower_state();
+       pPHY_Reg->PHY_REG264 &= ~(1<<1);
+    pPHY_Reg->PHY_REG1 = (pPHY_Reg->PHY_REG1 & (~(0x3<<2)));     //phy soft reset
+    dsb();
+    pCRU_Reg->CRU_CLKGATE_CON[0] = ((0x1<<2)<<16) | (1<<2);  //disable DDR PHY clock
+    ddr_delayus(1);
+}
+
+static void __sramlocalfunc ddr_selfrefresh_exit(void)
+{
+    pCRU_Reg->CRU_CLKGATE_CON[0] = ((0x1<<2)<<16) | (0<<2);  //enable DDR PHY clock
+    dsb();
+    ddr_delayus(1);
+       pPHY_Reg->PHY_REG1 = (pPHY_Reg->PHY_REG1 | (0x3 << 2)); //phy soft de-reset
+       pPHY_Reg->PHY_REG264 |= (1<<1);
+       dsb();
+    ddr_move_to_Config_state();    
+    ddr_data_training(); 
+    ddr_move_to_Access_state();
+    /*ddr_dtt_check();*/
+}
+
+void PIE_FUNC(ddr_suspend)(void)
+{
+       ddr_selfrefresh_enter(0);
+       pCRU_Reg->CRU_MODE_CON = (0x1 << ((1 * 4) + 16)) | (0x0 << (1 * 4));    /*PLL slow-mode*/
+       dsb();
+       ddr_delayus(1);
+       pCRU_Reg->CRU_PLL_CON[1][1] = ((0x1 << 13) << 16) | (0x1 << 13);        /*PLL power-down*/
+       dsb();
+       ddr_delayus(1);
+}
+EXPORT_PIE_SYMBOL(FUNC(ddr_suspend));
+
+/*----------------------------------------------------------------------
+Name    : void __sramfunc ddr_suspend(void)
+Desc    : ½øÈëddr suspend
+Params  : void
+Return  : void
+Notes   :  
+----------------------------------------------------------------------*/
+#if 0
+void ddr_suspend(void)
+{
+       uint32 i;
+       volatile uint32 n;
+       volatile unsigned int *temp = (volatile unsigned int *)SRAM_CODE_OFFSET;
+       /** 1. Make sure there is no host access */
+       flush_cache_all();
+       outer_flush_all();
+       flush_tlb_all();
+
+       /*sram size = 8KB*/
+       for (i = 0; i < 2; i++) {
+               n = temp[1024 * i];
+               barrier();
+       }
+       n = pDDR_Reg->SCFG.d32;
+       n = pPHY_Reg->PHY_REG1;
+       n = pCRU_Reg->CRU_PLL_CON[0][0];
+       n = *(volatile uint32_t *)SysSrv_DdrTiming;
+       n = pGRF_Reg->GRF_SOC_STATUS0;
+       dsb();
+
+       fn_to_pie(rockchip_pie_chunk, &FUNC(ddr_suspend)) ();
+}
+EXPORT_SYMBOL(ddr_suspend);
+#endif 
+
+void PIE_FUNC(ddr_resume)(void)
+{
+       uint32 delay = 1000;
+
+       pCRU_Reg->CRU_PLL_CON[1][1] = ((0x1 << 13) << 16) | (0x0 << 13);        /*PLL no power-down*/
+       dsb();
+       while (delay > 0) {
+               ddr_delayus(1);
+               if (pCRU_Reg->CRU_PLL_CON[1][1] & (0x1 << 10))
+                       break;
+               delay--;
+       }
+
+       pCRU_Reg->CRU_MODE_CON = (0x1 << ((1 * 4) + 16)) | (0x1 << (1 * 4));    /*PLL normal*/
+       dsb();
+
+       ddr_selfrefresh_exit();
+}
+
+EXPORT_PIE_SYMBOL(FUNC(ddr_resume));
+#if 0
+static uint32 ddr_get_cap(void)
+{
+    uint32 cs, bank, row, col,row1;
+
+    bank = READ_BK_INFO();
+    row = READ_CS0_ROW_INFO();
+    col = READ_COL_INFO();
+    cs = READ_CS_INFO(); 
+    if(cs>1)
+    {
+        row1 = READ_CS1_ROW_INFO();
+        return ((1 << (row + col + bank + 1))+(1 << (row1 + col + bank + 1)));
+    }
+    else
+    {
+        return (1 << (row + col + bank + 1));
+    }
+}
+#endif 
+#if 0
+/*----------------------------------------------------------------------
+Name    : int ddr_init(uint32_t dram_speed_bin, uint32_t freq)
+Desc    : ddr  ³õʼ»¯º¯Êý
+Params  : dram_speed_bin ->ddr¿ÅÁ£ÀàÐÍ
+          freq ->ƵÂÊÖµ
+Return  : 0 ³É¹¦
+Notes   :  
+----------------------------------------------------------------------*/
+static int ddr_init(uint32_t dram_speed_bin, uint32 freq)
+{
+    volatile uint32_t value = 0;
+    uint32_t cs,die=1;
+
+    ddr_print("version 1.00 20140704 \n");
+    cs = READ_CS_INFO();    //case 0:1rank ; case 1:2rank ; 
+
+    p_ddr_reg = kern_to_pie(rockchip_pie_chunk, &DATA(ddr_reg));
+    p_ddr_freq =kern_to_pie(rockchip_pie_chunk, &DATA(ddr_freq)); 
+    p_ddr_reg->mem_type = ((pGRF_Reg->GRF_OS_REG[1] >> 13) &0x7);
+    p_ddr_reg->ddr_speed_bin = dram_speed_bin;
+    *p_ddr_freq= 0;
+    *kern_to_pie(rockchip_pie_chunk, &DATA(ddr_sr_idle)) = 0;
+    *kern_to_pie(rockchip_pie_chunk, &DATA(ddr_dll_status)) = DDR3_DLL_DISABLE;
+    p_copy_data = kern_to_pie(rockchip_pie_chunk, &copy_data[0]);
+    if(p_ddr_reg->mem_type != DDR3)
+    {        
+        ddr_print("ddr type error type=%d\n",(p_ddr_reg->mem_type));
+        return -1;
+    }
+    
+    switch(READ_DIE_BW_INFO())
+    {
+        case 0:         //8bit
+            die = 2;
+            break;
+               case 1:         //16bit 
+                       die = 1;
+                       break;
+        default:
+            ddr_print("ddr die BW error=%d\n",READ_DIE_BW_INFO());
+            break;
+    }
+       
+    
+    //get capability per chip, not total size, used for calculate tRFC
+    p_ddr_reg->ddr_capability_per_die = ddr_get_cap()/(cs * die);
+    ddr_print("%d CS, ROW=%d, Bank=%d, COL=%d, Total Capability=%dMB\n", 
+                                                                    cs, \
+                                                                    READ_CS0_ROW_INFO(), \
+                                                                    (0x1<<(READ_BK_INFO())), \
+                                                                    READ_COL_INFO(), \
+                                                                    (ddr_get_cap()>>20));/*
+*/                                                                    
+    //ddr_adjust_config(p_ddr_reg->mem_type);
+
+    if(freq != 0)
+        value=_ddr_change_freq(freq);
+
+    /*clk_set_rate(clk_get(NULL, "ddr"), 0);*/
+    ddr_print("init success!!! freq=%dMHz\n", (int)value);
+    return 0;
+}
+#endif
+