--- /dev/null
+/*
+ * 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)),
+ ¶m,
+ 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, ©_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
+