/* * Copyright (c) 2015-2018, Renesas Electronics Corporation. All rights reserved. * * SPDX-License-Identifier: BSD-3-Clause */ #include #include #include "boot_init_dram_regdef_e3.h" #include "ddr_init_e3.h" #include "../dram_sub_func.h" /* rev.0.04 add variables */ /******************************************************************************* * variables ******************************************************************************/ uint32_t ddrBackup; /* rev.0.03 add Prototypes */ /******************************************************************************* * Prototypes ******************************************************************************/ /* static uint32_t init_ddr(void); rev.0.04 */ /* static uint32_t recovery_from_backup_mode(void); rev.0.04 */ /* int32_t dram_update_boot_status(uint32_t status); rev.0.04 */ /* rev.0.03 add Comment */ /******************************************************************************* * register write/read function ******************************************************************************/ static void WriteReg_32(uint32_t a, uint32_t v) { (*(volatile uint32_t*)(uintptr_t)a) = v; } /* WriteReg_32 */ static uint32_t ReadReg_32(uint32_t a) { uint32_t w = (*(volatile uint32_t*)(uintptr_t)a); return w; } /* ReadReg_32 */ /* rev.0.04 add Comment */ /******************************************************************************* * Initialize ddr ******************************************************************************/ uint32_t init_ddr(void) { uint32_t RegVal_R2, RegVal_R5, RegVal_R6, RegVal_R7, RegVal_R12, i; uint32_t ddr_md; /* rev.0.08 */ uint32_t RegVal,j; uint32_t dqsgd_0c, bdlcount_0c, bdlcount_0c_div2, bdlcount_0c_div4, bdlcount_0c_div8, bdlcount_0c_div16; uint32_t gatesl_0c, rdqsd_0c, rdqsnd_0c, rbd_0c[4]; uint32_t pdqsr_ctl,lcdl_ctl,lcdl_judge1,lcdl_judge2; /* rev.0.08 */ if ((ReadReg_32(0xFFF00044) & 0x000000FF) == 0x00000000) { pdqsr_ctl = 1; lcdl_ctl = 1; }else { pdqsr_ctl = 0; lcdl_ctl = 0; } /* Judge the DDR bit rate (ddr_md : 0 = 1584Mbps, 1 = 1856Mbps) */ ddr_md = (ReadReg_32(RST_MODEMR)>>19)&BIT0; /* 1584Mbps setting */ if (ddr_md==0){ /* CPG setting ===============================================*/ WriteReg_32(CPG_CPGWPR,0x5A5AFFFF); WriteReg_32(CPG_CPGWPCR,0xA5A50000); WriteReg_32(CPG_SRCR4,0x20000000); WriteReg_32(0xE61500DC,0xe2200000); /* Change to 1584Mbps */ while ( (BIT11 & ReadReg_32(CPG_PLLECR)) == 0 ); WriteReg_32(CPG_SRSTCLR4,0x20000000); WriteReg_32(CPG_CPGWPCR,0xA5A50001); /* CPG setting ===============================================*/ } /* ddr_md */ WriteReg_32(DBSC_E3_DBSYSCNT0,0x00001234); WriteReg_32(DBSC_E3_DBKIND,0x00000007); #if RCAR_DRAM_DDR3L_MEMCONF == 0 WriteReg_32(DBSC_E3_DBMEMCONF00,0x0f030a02); /* 1GB */ #elif RCAR_DRAM_DDR3L_MEMCONF == 1 WriteReg_32(DBSC_E3_DBMEMCONF00,0x10030a02); /* 2GB(default) */ #elif RCAR_DRAM_DDR3L_MEMCONF == 2 WriteReg_32(DBSC_E3_DBMEMCONF00,0x10030b02); /* 4GB */ #else WriteReg_32(DBSC_E3_DBMEMCONF00,0x10030a02); /* 2GB */ #endif #if RCAR_DRAM_DDR3L_MEMDUAL == 1 RegVal_R2 = (ReadReg_32(0xE6790614)); WriteReg_32(0xE6790614,RegVal_R2 | 0x00000003); /* MCS1_N/MODT1 are activated. */ #endif WriteReg_32(DBSC_E3_DBPHYCONF0,0x00000001); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBTR0,0x0000000B); WriteReg_32(DBSC_E3_DBTR1,0x00000008); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBTR0,0x0000000D); WriteReg_32(DBSC_E3_DBTR1,0x00000009); } /* ddr_md */ WriteReg_32(DBSC_E3_DBTR2,0x00000000); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBTR3,0x0000000B); WriteReg_32(DBSC_E3_DBTR4,0x000B000B); WriteReg_32(DBSC_E3_DBTR5,0x00000027); WriteReg_32(DBSC_E3_DBTR6,0x0000001C); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBTR3,0x0000000D); WriteReg_32(DBSC_E3_DBTR4,0x000D000D); WriteReg_32(DBSC_E3_DBTR5,0x0000002D); WriteReg_32(DBSC_E3_DBTR6,0x00000020); } /* ddr_md */ WriteReg_32(DBSC_E3_DBTR7,0x00060006); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBTR8,0x00000020); WriteReg_32(DBSC_E3_DBTR9,0x00000006); WriteReg_32(DBSC_E3_DBTR10,0x0000000C); WriteReg_32(DBSC_E3_DBTR11,0x0000000A); WriteReg_32(DBSC_E3_DBTR12,0x00120012); WriteReg_32(DBSC_E3_DBTR13,0x000000CE); WriteReg_32(DBSC_E3_DBTR14,0x00140005); WriteReg_32(DBSC_E3_DBTR15,0x00050004); WriteReg_32(DBSC_E3_DBTR16,0x071F0305); WriteReg_32(DBSC_E3_DBTR17,0x040C0000); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBTR8,0x00000021); WriteReg_32(DBSC_E3_DBTR9,0x00000007); WriteReg_32(DBSC_E3_DBTR10,0x0000000E); WriteReg_32(DBSC_E3_DBTR11,0x0000000C); WriteReg_32(DBSC_E3_DBTR12,0x00140014); WriteReg_32(DBSC_E3_DBTR13,0x000000F2); WriteReg_32(DBSC_E3_DBTR14,0x00170006); WriteReg_32(DBSC_E3_DBTR15,0x00060005); WriteReg_32(DBSC_E3_DBTR16,0x09210507); WriteReg_32(DBSC_E3_DBTR17,0x040E0000); } /* ddr_md */ WriteReg_32(DBSC_E3_DBTR18,0x00000200); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBTR19,0x01000040); WriteReg_32(DBSC_E3_DBTR20,0x020000D6); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBTR19,0x0129004B); WriteReg_32(DBSC_E3_DBTR20,0x020000FB); } /* ddr_md */ WriteReg_32(DBSC_E3_DBTR21,0x00040004); WriteReg_32(DBSC_E3_DBBL,0x00000000); WriteReg_32(DBSC_E3_DBODT0,0x00000001); WriteReg_32(DBSC_E3_DBADJ0,0x00000001); WriteReg_32(DBSC_E3_DBSYSCONF1,0x00000002); WriteReg_32(DBSC_E3_DBDFICNT0,0x00000010); WriteReg_32(DBSC_E3_DBBCAMDIS,0x00000001); WriteReg_32(DBSC_E3_DBSCHRW1,0x00000046); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_SCFCTST0,0x0D050B03); WriteReg_32(DBSC_E3_SCFCTST1,0x0306030C); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_SCFCTST0,0x0C050B03); WriteReg_32(DBSC_E3_SCFCTST1,0x0305030C); } /* ddr_md */ /* rev.0.03 add Comment */ /**************************************************************************** * Initial_Step0( INITBYP ) ***************************************************************************/ WriteReg_32(DBSC_E3_DBPDLK0,0x0000A55A); WriteReg_32(DBSC_E3_DBCMD,0x01840001); WriteReg_32(DBSC_E3_DBCMD,0x08840000); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x80010000); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); /* rev.0.03 add Comment */ /**************************************************************************** * Initial_Step1( ZCAL,PLLINIT,DCAL,PHYRST training ) ***************************************************************************/ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000008); WriteReg_32(DBSC_E3_DBPDRGD0,0x000B8000); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000090); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x04058904); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x04058A04); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000091); WriteReg_32(DBSC_E3_DBPDRGD0,0x0007BB6B); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000095); WriteReg_32(DBSC_E3_DBPDRGD0,0x0007BBAD); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000099); WriteReg_32(DBSC_E3_DBPDRGD0,0x0007BB6B); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000090); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x04058900); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x04058A00); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000021); WriteReg_32(DBSC_E3_DBPDRGD0,0x0024641E); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00010073); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); /* rev.0.03 add Comment */ /**************************************************************************** * Initial_Step2( DRAMRST/DRAMINT training ) ***************************************************************************/ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000090); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x0C058900); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x0C058A00); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000090); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x04058900); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x04058A00); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000003); WriteReg_32(DBSC_E3_DBPDRGD0,0x0780C700); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000007); while ( (BIT30 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000004); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,(uint32_t)(REFRESH_RATE*792/125)-400 + 0x08B00000); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,(uint32_t)(REFRESH_RATE*928/125)-400 + 0x0A300000); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000022); WriteReg_32(DBSC_E3_DBPDRGD0,0x1000040B); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000023); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x2D9C0B66); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x35A00D77); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000024); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x2A88B400); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x2A8A2C28); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000025); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x30005200); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x30005E00); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000026); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x0014A9C9); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x0014CB49); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000027); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x00000D70); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x00000F14); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000028); WriteReg_32(DBSC_E3_DBPDRGD0,0x00000046); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000029); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ if (REFRESH_RATE > 3900) { WriteReg_32(DBSC_E3_DBPDRGD0,0x00000018); /* [7]SRT=0 */ } else { WriteReg_32(DBSC_E3_DBPDRGD0,0x00000098); /* [7]SRT=1 */ } } else { /* 1856Mbps */ if (REFRESH_RATE > 3900) { WriteReg_32(DBSC_E3_DBPDRGD0,0x00000020); /* [7]SRT=0 */ } else { WriteReg_32(DBSC_E3_DBPDRGD0,0x000000A0); /* [7]SRT=1 */ } /* REFRESH_RATE */ } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x0000002C); WriteReg_32(DBSC_E3_DBPDRGD0,0x81003047); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000020); WriteReg_32(DBSC_E3_DBPDRGD0,0x00181884); WriteReg_32(DBSC_E3_DBPDRGA0,0x0000001A); WriteReg_32(DBSC_E3_DBPDRGD0,0x33C03C10); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A7); WriteReg_32(DBSC_E3_DBPDRGD0,0x0D0D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A8); WriteReg_32(DBSC_E3_DBPDRGD0,0x0D0D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A9); WriteReg_32(DBSC_E3_DBPDRGD0,0x000D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C7); WriteReg_32(DBSC_E3_DBPDRGD0,0x0D0D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C8); WriteReg_32(DBSC_E3_DBPDRGD0,0x0D0D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C9); WriteReg_32(DBSC_E3_DBPDRGD0,0x000D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E7); WriteReg_32(DBSC_E3_DBPDRGD0,0x0D0D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E8); WriteReg_32(DBSC_E3_DBPDRGD0,0x0D0D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E9); WriteReg_32(DBSC_E3_DBPDRGD0,0x000D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000107); WriteReg_32(DBSC_E3_DBPDRGD0,0x0D0D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000108); WriteReg_32(DBSC_E3_DBPDRGD0,0x0D0D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000109); WriteReg_32(DBSC_E3_DBPDRGD0,0x000D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00010181); WriteReg_32(DBSC_E3_DBCMD,0x08840001); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); /* rev.0.03 add Comment */ /**************************************************************************** * Initial_Step3( WL/QSG training ) ***************************************************************************/ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00010601); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); /* rev.0.03 add Comment */ /**************************************************************************** * Initial_Step4( WLADJ training ) ***************************************************************************/ for ( i = 0; i<4; i++){ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B1 + i*0x20); RegVal_R5 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0x0000FF00) >> 0x8; WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B4 + i*0x20); RegVal_R6 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0x000000FF); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B3 + i*0x20); RegVal_R7 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0x00000007); if ( RegVal_R6 > 0 ){ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B2 + i*0x20); RegVal_R2 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFFF8); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B2 + i*0x20); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal_R2 | ((RegVal_R7 + 0x1) & 0x00000007)); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); RegVal_R2 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFF00); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal_R2 | RegVal_R6); } else { WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B2 + i*0x20); RegVal_R2 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFFF8); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B2 + i*0x20); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal_R2 | RegVal_R7); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); RegVal_R2 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFF00); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal_R2 | ((RegVal_R6 + ((RegVal_R5) << 1)) & 0x000000FF)); } /* RegVal_R6 */ } /* for i */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000005); WriteReg_32(DBSC_E3_DBPDRGD0,0xC1AA00C0); /* rev.0.08 */ if (pdqsr_ctl == 1){}else{ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000100); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); } WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00010801); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); /* rev.0.03 add Comment */ /**************************************************************************** * Initial_Step5678( RdWrbitRdWreye ) ***************************************************************************/ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000005); WriteReg_32(DBSC_E3_DBPDRGD0,0xC1AA00D8); /* rev.0.08 */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00011001); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); if (pdqsr_ctl == 1){ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000100); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); } WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00012001); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); if (pdqsr_ctl == 1){ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C000285); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C000285); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C000285); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000100); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C000285); } WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00014001); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); if (pdqsr_ctl == 1){ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000100); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); } WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00018001); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); /* rev.0.03 add Comment */ /**************************************************************************** * Initial_Step3_2( DQS Gate Training ) ***************************************************************************/ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C000285); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C000285); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C000285); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000100); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C000285); WriteReg_32(DBSC_E3_DBPDRGA0,0x0000002C); WriteReg_32(DBSC_E3_DBPDRGD0,0x81003087); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00010401); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); /* rev.0.03 add Comment */ /**************************************************************************** * Initial_Step5-2_7-2( Rd bit Rd eye ) ***************************************************************************/ for ( i = 0; i < 4; i++){ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B1 + i*0x20); RegVal_R5 = ((ReadReg_32(DBSC_E3_DBPDRGD0) & 0x0000FF00) >> 0x8); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B4 + i*0x20); RegVal_R6 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0x000000FF); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B3 + i*0x20); RegVal_R7 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0x00000007); RegVal_R12 = (RegVal_R5 >> 0x2); if ( RegVal_R12 < RegVal_R6 ){ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B2 + i*0x20); RegVal_R2 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFFF8); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B2 + i*0x20); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal_R2 | ((RegVal_R7 + 0x1) & 0x00000007)); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); RegVal_R2 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFF00); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal_R2 | ((RegVal_R6 - (RegVal_R12)) & 0x000000FF)); } else { WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B2 + i*0x20); RegVal_R2 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFFF8); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B2 + i*0x20); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal_R2 | (RegVal_R7 & 0x00000007)); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); RegVal_R2 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFF00); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal_R2 | ((RegVal_R6 + (RegVal_R5) + ((RegVal_R5) >> 1) + (RegVal_R12)) & 0x000000FF)); } /* RegVal_R12 < RegVal_R6 */ } /* for i */ /* rev.0.08 */ if (pdqsr_ctl == 1){}else{ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000100); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); } WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00015001); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); /* rev.0.08 */ if (lcdl_ctl == 1){ for (i=0; i< 4; i++) { WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); dqsgd_0c = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0x000000FF); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B1 + i*0x20); bdlcount_0c = ((ReadReg_32(DBSC_E3_DBPDRGD0) & 0x0000FF00) >> 8); bdlcount_0c_div2 = (bdlcount_0c >> 1); bdlcount_0c_div4 = (bdlcount_0c >> 2); bdlcount_0c_div8 = (bdlcount_0c >> 3); bdlcount_0c_div16 = (bdlcount_0c >> 4); if (ddr_md==0){ /* 1584Mbps */ lcdl_judge1 = bdlcount_0c_div2 + bdlcount_0c_div4 + bdlcount_0c_div8 ; lcdl_judge2 = bdlcount_0c + bdlcount_0c_div4 + bdlcount_0c_div16 ; } else { /* 1856Mbps */ lcdl_judge1 = bdlcount_0c_div2 + bdlcount_0c_div4 ; lcdl_judge2 = bdlcount_0c + bdlcount_0c_div4 ; } /* ddr_md */ if (dqsgd_0c > lcdl_judge1) { if (dqsgd_0c <= lcdl_judge2) { WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000B0 + i * 0x20); RegVal = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFF00); WriteReg_32(DBSC_E3_DBPDRGD0,((dqsgd_0c - bdlcount_0c_div8) | RegVal)); } else { WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000B0 + i * 0x20); RegVal = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFF00); WriteReg_32(DBSC_E3_DBPDRGD0, RegVal); WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000B2 + i * 0x20); gatesl_0c = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0x00000007); WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000B2 + i * 0x20); RegVal = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFFF8); WriteReg_32(DBSC_E3_DBPDRGD0, (RegVal|(gatesl_0c + 1))); WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000AF + i * 0x20); RegVal = (ReadReg_32(DBSC_E3_DBPDRGD0)); rdqsd_0c = (RegVal & 0x0000FF00) >> 8; rdqsnd_0c = (RegVal & 0x00FF0000) >> 16; WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000AF + i * 0x20); WriteReg_32(DBSC_E3_DBPDRGD0, ((RegVal & 0xFF0000FF)|((rdqsd_0c + bdlcount_0c_div4) << 8)|((rdqsnd_0c + bdlcount_0c_div4) << 16))); WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000AA + i * 0x20); RegVal = (ReadReg_32(DBSC_E3_DBPDRGD0)); rbd_0c[0] = (RegVal ) & 0x0000001f; rbd_0c[1] = (RegVal >> 8) & 0x0000001f; rbd_0c[2] = (RegVal >> 16) & 0x0000001f; rbd_0c[3] = (RegVal >> 24) & 0x0000001f; WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000AA + i * 0x20); RegVal = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xE0E0E0E0); for (j=0; j< 4; j++) { rbd_0c[j] = (rbd_0c[j] + bdlcount_0c_div4); if (rbd_0c[j] > 0x1F) rbd_0c[j] = 0x1F; RegVal = RegVal | (rbd_0c[j] <<8*j); } WriteReg_32(DBSC_E3_DBPDRGD0, RegVal); WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000AB + i * 0x20); RegVal = (ReadReg_32(DBSC_E3_DBPDRGD0)); rbd_0c[0] = (RegVal ) & 0x0000001f; rbd_0c[1] = (RegVal >> 8) & 0x0000001f; rbd_0c[2] = (RegVal >> 16) & 0x0000001f; rbd_0c[3] = (RegVal >> 24) & 0x0000001f; WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000AB + i * 0x20); RegVal = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xE0E0E0E0); for (j=0; j< 4; j++) { rbd_0c[j] = (rbd_0c[j] + bdlcount_0c_div4); if (rbd_0c[j] > 0x1F) rbd_0c[j] = 0x1F; RegVal = RegVal | (rbd_0c[j] <<8*j); } WriteReg_32(DBSC_E3_DBPDRGD0, RegVal); } } } WriteReg_32(DBSC_E3_DBPDRGA0,0x00000002); WriteReg_32(DBSC_E3_DBPDRGD0,0x07D81E37); } WriteReg_32(DBSC_E3_DBPDRGA0,0x00000003); WriteReg_32(DBSC_E3_DBPDRGD0,0x0380C700); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000007); while ( (BIT30 & ReadReg_32(DBSC_E3_DBPDRGD0)) != 0 ); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000021); WriteReg_32(DBSC_E3_DBPDRGD0,0x0024643E); WriteReg_32(DBSC_E3_DBBUS0CNF1,0x00000010); WriteReg_32(DBSC_E3_DBCALCNF, (uint32_t)(64000000/REFRESH_RATE) + 0x01000000); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBRFCNF1, (uint32_t)(REFRESH_RATE*99/125) + 0x00080000); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBRFCNF1, (uint32_t)(REFRESH_RATE*116/125) + 0x00080000); } /* ddr_md */ WriteReg_32(DBSC_E3_DBRFCNF2,0x00010000); WriteReg_32(DBSC_E3_DBDFICUPDCNF,0x40100001); WriteReg_32(DBSC_E3_DBRFEN,0x00000001); WriteReg_32(DBSC_E3_DBACEN,0x00000001); /* rev.0.08 */ if (pdqsr_ctl == 1){ WriteReg_32(0xE67F0018,0x00000001); RegVal = ReadReg_32(0x40000000); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000000); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000100); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); } /* rev.0.03 add Comment */ /**************************************************************************** * Initial_Step9( Initial End ) ***************************************************************************/ WriteReg_32(DBSC_E3_DBPDLK0,0x00000000); WriteReg_32(DBSC_E3_DBSYSCNT0,0x00000000); #ifdef ddr_qos_init_setting /* only for non qos_init */ WriteReg_32(DBSC_E3_DBSYSCNT0,0x00001234); WriteReg_32(DBSC_E3_DBCAM0CNF1,0x00043218); WriteReg_32(DBSC_E3_DBCAM0CNF2,0x000000F4); WriteReg_32(DBSC_E3_DBSCHCNT0,0x000f0037); WriteReg_32(DBSC_E3_DBSCHSZ0,0x00000001); WriteReg_32(DBSC_E3_DBSCHRW0,0x22421111); WriteReg_32(DBSC_E3_SCFCTST2,0x012F1123); WriteReg_32(DBSC_E3_DBSCHQOS00,0x00000F00); WriteReg_32(DBSC_E3_DBSCHQOS01,0x00000B00); WriteReg_32(DBSC_E3_DBSCHQOS02,0x00000000); WriteReg_32(DBSC_E3_DBSCHQOS03,0x00000000); WriteReg_32(DBSC_E3_DBSCHQOS40,0x00000300); WriteReg_32(DBSC_E3_DBSCHQOS41,0x000002F0); WriteReg_32(DBSC_E3_DBSCHQOS42,0x00000200); WriteReg_32(DBSC_E3_DBSCHQOS43,0x00000100); WriteReg_32(DBSC_E3_DBSCHQOS90,0x00000100); WriteReg_32(DBSC_E3_DBSCHQOS91,0x000000F0); WriteReg_32(DBSC_E3_DBSCHQOS92,0x000000A0); WriteReg_32(DBSC_E3_DBSCHQOS93,0x00000040); WriteReg_32(DBSC_E3_DBSCHQOS130,0x00000100); WriteReg_32(DBSC_E3_DBSCHQOS131,0x000000F0); WriteReg_32(DBSC_E3_DBSCHQOS132,0x000000A0); WriteReg_32(DBSC_E3_DBSCHQOS133,0x00000040); WriteReg_32(DBSC_E3_DBSCHQOS140,0x000000C0); WriteReg_32(DBSC_E3_DBSCHQOS141,0x000000B0); WriteReg_32(DBSC_E3_DBSCHQOS142,0x00000080); WriteReg_32(DBSC_E3_DBSCHQOS143,0x00000040); WriteReg_32(DBSC_E3_DBSCHQOS150,0x00000040); WriteReg_32(DBSC_E3_DBSCHQOS151,0x00000030); WriteReg_32(DBSC_E3_DBSCHQOS152,0x00000020); WriteReg_32(DBSC_E3_DBSCHQOS153,0x00000010); /* rev.0.08 */ if (pdqsr_ctl == 1){}else{ WriteReg_32(0xE67F0018,0x00000001); } WriteReg_32(DBSC_E3_DBSYSCNT0,0x00000000); #endif return 1; /* rev.0.04 Restore the return code */ } /* init_ddr */ /* rev.0.04 add function */ uint32_t recovery_from_backup_mode(void) { /**************************************************************************** * recovery_Step0(DBSC Setting 1) / same "init_ddr" ***************************************************************************/ uint32_t RegVal_R2, RegVal_R5, RegVal_R6, RegVal_R7, RegVal_R12, i; uint32_t ddr_md; uint32_t err; /* rev.0.08 */ uint32_t RegVal,j; uint32_t dqsgd_0c, bdlcount_0c, bdlcount_0c_div2, bdlcount_0c_div4, bdlcount_0c_div8, bdlcount_0c_div16; uint32_t gatesl_0c, rdqsd_0c, rdqsnd_0c, rbd_0c[4]; uint32_t pdqsr_ctl,lcdl_ctl,lcdl_judge1,lcdl_judge2; /* rev.0.08 */ if ((ReadReg_32(0xFFF00044) & 0x000000FF) == 0x00000000) { pdqsr_ctl = 1; lcdl_ctl = 1; }else { pdqsr_ctl = 0; lcdl_ctl = 0; } /* Judge the DDR bit rate (ddr_md : 0 = 1584Mbps, 1 = 1856Mbps) */ ddr_md = (ReadReg_32(RST_MODEMR)>>19)&BIT0; /* 1584Mbps setting */ if (ddr_md==0){ /* CPG setting ===============================================*/ WriteReg_32(CPG_CPGWPR,0x5A5AFFFF); WriteReg_32(CPG_CPGWPCR,0xA5A50000); WriteReg_32(CPG_SRCR4,0x20000000); WriteReg_32(0xE61500DC,0xe2200000); /* Change to 1584Mbps */ while ( (BIT11 & ReadReg_32(CPG_PLLECR)) == 0 ); WriteReg_32(CPG_SRSTCLR4,0x20000000); WriteReg_32(CPG_CPGWPCR,0xA5A50001); /* CPG setting ===============================================*/ } /* ddr_md */ WriteReg_32(DBSC_E3_DBSYSCNT0,0x00001234); WriteReg_32(DBSC_E3_DBKIND,0x00000007); #if RCAR_DRAM_DDR3L_MEMCONF == 0 WriteReg_32(DBSC_E3_DBMEMCONF00,0x0f030a02); #elif RCAR_DRAM_DDR3L_MEMCONF == 1 WriteReg_32(DBSC_E3_DBMEMCONF00,0x10030a02); #elif RCAR_DRAM_DDR3L_MEMCONF == 2 WriteReg_32(DBSC_E3_DBMEMCONF00,0x10030b02); #else WriteReg_32(DBSC_E3_DBMEMCONF00,0x10030a02); #endif /* rev.0.08 */ #if RCAR_DRAM_DDR3L_MEMDUAL == 1 RegVal_R2 = (ReadReg_32(0xE6790614)); WriteReg_32(0xE6790614,RegVal_R2 | 0x00000003); /* MCS1_N/MODT1 are activated. */ #endif WriteReg_32(DBSC_E3_DBPHYCONF0,0x00000001); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBTR0,0x0000000B); WriteReg_32(DBSC_E3_DBTR1,0x00000008); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBTR0,0x0000000D); WriteReg_32(DBSC_E3_DBTR1,0x00000009); } /* ddr_md */ WriteReg_32(DBSC_E3_DBTR2,0x00000000); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBTR3,0x0000000B); WriteReg_32(DBSC_E3_DBTR4,0x000B000B); WriteReg_32(DBSC_E3_DBTR5,0x00000027); WriteReg_32(DBSC_E3_DBTR6,0x0000001C); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBTR3,0x0000000D); WriteReg_32(DBSC_E3_DBTR4,0x000D000D); WriteReg_32(DBSC_E3_DBTR5,0x0000002D); WriteReg_32(DBSC_E3_DBTR6,0x00000020); } /* ddr_md */ WriteReg_32(DBSC_E3_DBTR7,0x00060006); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBTR8,0x00000020); WriteReg_32(DBSC_E3_DBTR9,0x00000006); WriteReg_32(DBSC_E3_DBTR10,0x0000000C); WriteReg_32(DBSC_E3_DBTR11,0x0000000A); WriteReg_32(DBSC_E3_DBTR12,0x00120012); WriteReg_32(DBSC_E3_DBTR13,0x000000CE); WriteReg_32(DBSC_E3_DBTR14,0x00140005); WriteReg_32(DBSC_E3_DBTR15,0x00050004); WriteReg_32(DBSC_E3_DBTR16,0x071F0305); WriteReg_32(DBSC_E3_DBTR17,0x040C0000); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBTR8,0x00000021); WriteReg_32(DBSC_E3_DBTR9,0x00000007); WriteReg_32(DBSC_E3_DBTR10,0x0000000E); WriteReg_32(DBSC_E3_DBTR11,0x0000000C); WriteReg_32(DBSC_E3_DBTR12,0x00140014); WriteReg_32(DBSC_E3_DBTR13,0x000000F2); WriteReg_32(DBSC_E3_DBTR14,0x00170006); WriteReg_32(DBSC_E3_DBTR15,0x00060005); WriteReg_32(DBSC_E3_DBTR16,0x09210507); WriteReg_32(DBSC_E3_DBTR17,0x040E0000); } /* ddr_md */ WriteReg_32(DBSC_E3_DBTR18,0x00000200); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBTR19,0x01000040); WriteReg_32(DBSC_E3_DBTR20,0x020000D6); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBTR19,0x0129004B); WriteReg_32(DBSC_E3_DBTR20,0x020000FB); } /* ddr_md */ WriteReg_32(DBSC_E3_DBTR21,0x00040004); WriteReg_32(DBSC_E3_DBBL,0x00000000); WriteReg_32(DBSC_E3_DBODT0,0x00000001); WriteReg_32(DBSC_E3_DBADJ0,0x00000001); WriteReg_32(DBSC_E3_DBSYSCONF1,0x00000002); WriteReg_32(DBSC_E3_DBDFICNT0,0x00000010); WriteReg_32(DBSC_E3_DBBCAMDIS,0x00000001); WriteReg_32(DBSC_E3_DBSCHRW1,0x00000046); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_SCFCTST0,0x0D050B03); WriteReg_32(DBSC_E3_SCFCTST1,0x0306030C); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_SCFCTST0,0x0C050B03); WriteReg_32(DBSC_E3_SCFCTST1,0x0305030C); } /* ddr_md */ /**************************************************************************** * recovery_Step1(PHY setting 1) ***************************************************************************/ WriteReg_32(DBSC_E3_DBPDLK0,0x0000A55A); WriteReg_32(DBSC_E3_DBCMD,0x01840001); WriteReg_32(DBSC_E3_DBCMD,0x0A840000); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000008); /* DDR_PLLCR */ WriteReg_32(DBSC_E3_DBPDRGD0,0x000B8000); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000003); /* DDR_PGCR1 */ WriteReg_32(DBSC_E3_DBPDRGD0,0x0780C700); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000020); /* DDR_DXCCR */ WriteReg_32(DBSC_E3_DBPDRGD0,0x00181884); WriteReg_32(DBSC_E3_DBPDRGA0,0x0000001A); /* DDR_ACIOCR0 */ WriteReg_32(DBSC_E3_DBPDRGD0,0x33C03C10); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000007); while ( (BIT30 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000004); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,(uint32_t)(REFRESH_RATE*792/125)-400 + 0x08B00000); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,(uint32_t)(REFRESH_RATE*928/125)-400 + 0x0A300000); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000022); WriteReg_32(DBSC_E3_DBPDRGD0,0x1000040B); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000023); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x2D9C0B66); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x35A00D77); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000024); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x2A88B400); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x2A8A2C28); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000025); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x30005200); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x30005E00); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000026); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x0014A9C9); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x0014CB49); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000027); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x00000D70); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x00000F14); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000028); WriteReg_32(DBSC_E3_DBPDRGD0,0x00000046); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000029); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ if (REFRESH_RATE > 3900) { WriteReg_32(DBSC_E3_DBPDRGD0,0x00000018); /* [7]SRT=0 */ } else { WriteReg_32(DBSC_E3_DBPDRGD0,0x00000098); /* [7]SRT=1 */ } } else { /* 1856Mbps */ if (REFRESH_RATE > 3900) { WriteReg_32(DBSC_E3_DBPDRGD0,0x00000020); /* [7]SRT=0 */ } else { WriteReg_32(DBSC_E3_DBPDRGD0,0x000000A0); /* [7]SRT=1 */ } /* REFRESH_RATE */ } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x0000002C); WriteReg_32(DBSC_E3_DBPDRGD0,0x81003047); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000091); WriteReg_32(DBSC_E3_DBPDRGD0,0x0007BB6B); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000095); WriteReg_32(DBSC_E3_DBPDRGD0,0x0007BBAD); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000099); WriteReg_32(DBSC_E3_DBPDRGD0,0x0007BB6B); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000021); /* DDR_DSGCR */ WriteReg_32(DBSC_E3_DBPDRGD0,0x0024641E); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); /* DDR_PGSR0 */ while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); /* DDR_PIR */ WriteReg_32(DBSC_E3_DBPDRGD0,0x40010000); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); /* DDR_PGSR0 */ while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000092); /* DDR_ZQ0DR */ WriteReg_32(DBSC_E3_DBPDRGD0,0xC2C59AB5); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000096); /* DDR_ZQ1DR */ WriteReg_32(DBSC_E3_DBPDRGD0,0xC4285FBF); WriteReg_32(DBSC_E3_DBPDRGA0,0x0000009A); /* DDR_ZQ2DR */ WriteReg_32(DBSC_E3_DBPDRGD0,0xC2C59AB5); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000090); /* DDR_ZQCR */ /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x0C058900); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x0C058A00); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000090); /* DDR_ZQCR */ /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x04058900); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x04058A00); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); /* DDR_PIR */ WriteReg_32(DBSC_E3_DBPDRGD0,0x00050001); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); /* DDR_PGSR0 */ while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); /* ddr backupmode end */ if(ddrBackup) { NOTICE("[WARM_BOOT]"); } else { NOTICE("[COLD_BOOT]"); } /* ddrBackup */ err=rcar_dram_update_boot_status(ddrBackup); if(err){ NOTICE("[BOOT_STATUS_UPDATE_ERROR]"); return INITDRAM_ERR_I; } /* err */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000092); /* DDR_ZQ0DR */ WriteReg_32(DBSC_E3_DBPDRGD0,0x02C59AB5); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000096); /* DDR_ZQ1DR */ WriteReg_32(DBSC_E3_DBPDRGD0,0x04285FBF); WriteReg_32(DBSC_E3_DBPDRGA0,0x0000009A); /* DDR_ZQ2DR */ WriteReg_32(DBSC_E3_DBPDRGD0,0x02C59AB5); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); /* DDR_PIR */ WriteReg_32(DBSC_E3_DBPDRGD0,0x08000000); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); /* DDR_PIR */ WriteReg_32(DBSC_E3_DBPDRGD0,0x00000003); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); /* DDR_PGSR0 */ while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); /* DDR_PIR */ WriteReg_32(DBSC_E3_DBPDRGD0,0x80010000); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); /* DDR_PGSR0 */ while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); /* DDR_PIR */ WriteReg_32(DBSC_E3_DBPDRGD0,0x00010073); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); /* DDR_PGSR0 */ while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000090); /* DDR_ZQCR */ /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x0C058900); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x0C058A00); } /* ddr_md */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000090); /* DDR_ZQCR */ /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x04058900); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBPDRGD0,0x04058A00); } /* ddr_md */ /* rev0.08 */ WriteReg_32(DBSC_E3_DBPDRGA0,0x0000000C); WriteReg_32(DBSC_E3_DBPDRGD0,0x18000040); /**************************************************************************** * recovery_Step2(PHY setting 2) ***************************************************************************/ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A7); WriteReg_32(DBSC_E3_DBPDRGD0,0x0D0D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A8); WriteReg_32(DBSC_E3_DBPDRGD0,0x0D0D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A9); WriteReg_32(DBSC_E3_DBPDRGD0,0x000D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C7); WriteReg_32(DBSC_E3_DBPDRGD0,0x0D0D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C8); WriteReg_32(DBSC_E3_DBPDRGD0,0x0D0D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C9); WriteReg_32(DBSC_E3_DBPDRGD0,0x000D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E7); WriteReg_32(DBSC_E3_DBPDRGD0,0x0D0D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E8); WriteReg_32(DBSC_E3_DBPDRGD0,0x0D0D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E9); WriteReg_32(DBSC_E3_DBPDRGD0,0x000D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000107); WriteReg_32(DBSC_E3_DBPDRGD0,0x0D0D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000108); WriteReg_32(DBSC_E3_DBPDRGD0,0x0D0D0D0D); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000109); WriteReg_32(DBSC_E3_DBPDRGD0,0x000D0D0D); WriteReg_32(DBSC_E3_DBCALCNF, (uint32_t)(64000000/REFRESH_RATE) + 0x01000000); WriteReg_32(DBSC_E3_DBBUS0CNF1,0x00000010); /* Select setting value in bps */ if (ddr_md==0){ /* 1584Mbps */ WriteReg_32(DBSC_E3_DBRFCNF1, (uint32_t)(REFRESH_RATE*99/125) + 0x00080000); } else { /* 1856Mbps */ WriteReg_32(DBSC_E3_DBRFCNF1, (uint32_t)(REFRESH_RATE*116/125) + 0x00080000); } /* ddr_md */ WriteReg_32(DBSC_E3_DBRFCNF2,0x00010000); WriteReg_32(DBSC_E3_DBRFEN,0x00000001); WriteReg_32(DBSC_E3_DBCMD,0x0A840001); while ( (BIT0 & ReadReg_32(DBSC_E3_DBWAIT)) != 0 ); WriteReg_32(DBSC_E3_DBCMD,0x00000000); WriteReg_32(DBSC_E3_DBCMD,0x04840010); while ( (BIT0 & ReadReg_32(DBSC_E3_DBWAIT)) != 0 ); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); /* DDR_PGSR0 */ while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); /* DDR_PIR */ WriteReg_32(DBSC_E3_DBPDRGD0,0x00010701); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); /* DDR_PGSR0 */ while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); for ( i = 0; i<4; i++) { WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B1 + i*0x20); RegVal_R5 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0x0000FF00) >> 0x8; WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B4 + i*0x20); RegVal_R6 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0x000000FF); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B3 + i*0x20); RegVal_R7 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0x00000007); if ( RegVal_R6 > 0 ){ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B2 + i*0x20); RegVal_R2 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFFF8); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B2 + i*0x20); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal_R2 | ((RegVal_R7 + 0x1) & 0x00000007)); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); RegVal_R2 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFF00); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal_R2 | RegVal_R6); } else { WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B2 + i*0x20); RegVal_R2 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFFF8); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B2 + i*0x20); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal_R2 | RegVal_R7); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); RegVal_R2 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFF00); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal_R2 | ((RegVal_R6 + ((RegVal_R5) << 1)) & 0x000000FF)); } /* RegVal_R6 */ } /* for i */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000005); WriteReg_32(DBSC_E3_DBPDRGD0,0xC1AA00C0); /* rev.0.08 */ if (pdqsr_ctl == 1){}else{ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000100); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); } WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00010801); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000005); WriteReg_32(DBSC_E3_DBPDRGD0,0xC1AA00D8); /* rev.0.08 */ WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00011001); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); if (pdqsr_ctl == 1){ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000100); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); } WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00012001); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); if (pdqsr_ctl == 1){ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C000285); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C000285); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C000285); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000100); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C000285); } WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00014001); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); if (pdqsr_ctl == 1){ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000100); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); } WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00018001); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C000285); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C000285); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C000285); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000100); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C000285); WriteReg_32(DBSC_E3_DBPDRGA0,0x0000002C); WriteReg_32(DBSC_E3_DBPDRGD0,0x81003087); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00010401); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); for ( i = 0; i < 4; i++){ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B1 + i*0x20); RegVal_R5 = ((ReadReg_32(DBSC_E3_DBPDRGD0) & 0x0000FF00) >> 0x8); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B4 + i*0x20); RegVal_R6 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0x000000FF); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B3 + i*0x20); RegVal_R7 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0x00000007); RegVal_R12 = (RegVal_R5 >> 0x2); if ( RegVal_R12 < RegVal_R6 ){ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B2 + i*0x20); RegVal_R2 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFFF8); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B2 + i*0x20); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal_R2 | ((RegVal_R7 + 0x1) & 0x00000007)); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); RegVal_R2 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFF00); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal_R2 | ((RegVal_R6 - (RegVal_R12)) & 0x000000FF)); } else { WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B2 + i*0x20); RegVal_R2 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFFF8); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B2 + i*0x20); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal_R2 | (RegVal_R7 & 0x00000007)); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); RegVal_R2 = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFF00); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal_R2 | ((RegVal_R6 + (RegVal_R5) + ((RegVal_R5) >> 1) + (RegVal_R12)) & 0x000000FF)); } /* RegVal_R12 < RegVal_R6 */ } /* for i */ /* rev.0.08 */ if (pdqsr_ctl == 1){}else{ WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000100); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); } WriteReg_32(DBSC_E3_DBPDRGA0,0x00000001); WriteReg_32(DBSC_E3_DBPDRGD0,0x00015001); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000006); while ( (BIT0 & ReadReg_32(DBSC_E3_DBPDRGD0)) == 0 ); /* rev.0.08 */ if (lcdl_ctl == 1){ for (i=0; i< 4; i++) { WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B0 + i*0x20); dqsgd_0c = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0x000000FF); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000B1 + i*0x20); bdlcount_0c = ((ReadReg_32(DBSC_E3_DBPDRGD0) & 0x0000FF00) >> 8); bdlcount_0c_div2 = (bdlcount_0c >> 1); bdlcount_0c_div4 = (bdlcount_0c >> 2); bdlcount_0c_div8 = (bdlcount_0c >> 3); bdlcount_0c_div16 = (bdlcount_0c >> 4); if (ddr_md==0){ /* 1584Mbps */ lcdl_judge1 = bdlcount_0c_div2 + bdlcount_0c_div4 + bdlcount_0c_div8 ; lcdl_judge2 = bdlcount_0c + bdlcount_0c_div4 + bdlcount_0c_div16 ; } else { /* 1856Mbps */ lcdl_judge1 = bdlcount_0c_div2 + bdlcount_0c_div4 ; lcdl_judge2 = bdlcount_0c + bdlcount_0c_div4 ; } /* ddr_md */ if (dqsgd_0c > lcdl_judge1) { if (dqsgd_0c <= lcdl_judge2) { WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000B0 + i * 0x20); RegVal = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFF00); WriteReg_32(DBSC_E3_DBPDRGD0,((dqsgd_0c - bdlcount_0c_div8) | RegVal)); } else { WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000B0 + i * 0x20); RegVal = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFF00); WriteReg_32(DBSC_E3_DBPDRGD0, RegVal); WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000B2 + i * 0x20); gatesl_0c = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0x00000007); WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000B2 + i * 0x20); RegVal = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xFFFFFFF8); WriteReg_32(DBSC_E3_DBPDRGD0, (RegVal|(gatesl_0c + 1))); WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000AF + i * 0x20); RegVal = (ReadReg_32(DBSC_E3_DBPDRGD0)); rdqsd_0c = (RegVal & 0x0000FF00) >> 8; rdqsnd_0c = (RegVal & 0x00FF0000) >> 16; WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000AF + i * 0x20); WriteReg_32(DBSC_E3_DBPDRGD0, ((RegVal & 0xFF0000FF)|((rdqsd_0c + bdlcount_0c_div4) << 8)|((rdqsnd_0c + bdlcount_0c_div4) << 16))); WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000AA + i * 0x20); RegVal = (ReadReg_32(DBSC_E3_DBPDRGD0)); rbd_0c[0] = (RegVal ) & 0x0000001f; rbd_0c[1] = (RegVal >> 8) & 0x0000001f; rbd_0c[2] = (RegVal >> 16) & 0x0000001f; rbd_0c[3] = (RegVal >> 24) & 0x0000001f; WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000AA + i * 0x20); RegVal = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xE0E0E0E0); for (j=0; j< 4; j++) { rbd_0c[j] = (rbd_0c[j] + bdlcount_0c_div4); if (rbd_0c[j] > 0x1F) rbd_0c[j] = 0x1F; RegVal = RegVal | (rbd_0c[j] <<8*j); } WriteReg_32(DBSC_E3_DBPDRGD0, RegVal); WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000AB + i * 0x20); RegVal = (ReadReg_32(DBSC_E3_DBPDRGD0)); rbd_0c[0] = (RegVal ) & 0x0000001f; rbd_0c[1] = (RegVal >> 8) & 0x0000001f; rbd_0c[2] = (RegVal >> 16) & 0x0000001f; rbd_0c[3] = (RegVal >> 24) & 0x0000001f; WriteReg_32(DBSC_E3_DBPDRGA0, 0x000000AB + i * 0x20); RegVal = (ReadReg_32(DBSC_E3_DBPDRGD0) & 0xE0E0E0E0); for (j=0; j< 4; j++) { rbd_0c[j] = (rbd_0c[j] + bdlcount_0c_div4); if (rbd_0c[j] > 0x1F) rbd_0c[j] = 0x1F; RegVal = RegVal | (rbd_0c[j] <<8*j); } WriteReg_32(DBSC_E3_DBPDRGD0, RegVal); } } } WriteReg_32(DBSC_E3_DBPDRGA0,0x00000002); WriteReg_32(DBSC_E3_DBPDRGD0,0x07D81E37); } WriteReg_32(DBSC_E3_DBPDRGA0,0x00000003); WriteReg_32(DBSC_E3_DBPDRGD0,0x0380C700); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000007); while ( (BIT30 & ReadReg_32(DBSC_E3_DBPDRGD0)) != 0 ); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000021); WriteReg_32(DBSC_E3_DBPDRGD0,0x0024643E); /**************************************************************************** * recovery_Step3(DBSC Setting 2) ***************************************************************************/ WriteReg_32(DBSC_E3_DBDFICUPDCNF,0x40100001); WriteReg_32(DBSC_E3_DBACEN,0x00000001); /* rev.0.08 */ if (pdqsr_ctl == 1){ WriteReg_32(0xE67F0018,0x00000001); RegVal = ReadReg_32(0x40000000); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000000); WriteReg_32(DBSC_E3_DBPDRGD0,RegVal); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000A0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000C0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x000000E0); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); WriteReg_32(DBSC_E3_DBPDRGA0,0x00000100); WriteReg_32(DBSC_E3_DBPDRGD0,0x7C0002C5); } WriteReg_32(DBSC_E3_DBPDLK0,0x00000000); WriteReg_32(DBSC_E3_DBSYSCNT0,0x00000000); #ifdef ddr_qos_init_setting /* only for non qos_init */ WriteReg_32(DBSC_E3_DBSYSCNT0,0x00001234); WriteReg_32(DBSC_E3_DBCAM0CNF1,0x00043218); WriteReg_32(DBSC_E3_DBCAM0CNF2,0x000000F4); WriteReg_32(DBSC_E3_DBSCHCNT0,0x000f0037); WriteReg_32(DBSC_E3_DBSCHSZ0,0x00000001); WriteReg_32(DBSC_E3_DBSCHRW0,0x22421111); WriteReg_32(DBSC_E3_SCFCTST2,0x012F1123); WriteReg_32(DBSC_E3_DBSCHQOS00,0x00000F00); WriteReg_32(DBSC_E3_DBSCHQOS01,0x00000B00); WriteReg_32(DBSC_E3_DBSCHQOS02,0x00000000); WriteReg_32(DBSC_E3_DBSCHQOS03,0x00000000); WriteReg_32(DBSC_E3_DBSCHQOS40,0x00000300); WriteReg_32(DBSC_E3_DBSCHQOS41,0x000002F0); WriteReg_32(DBSC_E3_DBSCHQOS42,0x00000200); WriteReg_32(DBSC_E3_DBSCHQOS43,0x00000100); WriteReg_32(DBSC_E3_DBSCHQOS90,0x00000100); WriteReg_32(DBSC_E3_DBSCHQOS91,0x000000F0); WriteReg_32(DBSC_E3_DBSCHQOS92,0x000000A0); WriteReg_32(DBSC_E3_DBSCHQOS93,0x00000040); WriteReg_32(DBSC_E3_DBSCHQOS130,0x00000100); WriteReg_32(DBSC_E3_DBSCHQOS131,0x000000F0); WriteReg_32(DBSC_E3_DBSCHQOS132,0x000000A0); WriteReg_32(DBSC_E3_DBSCHQOS133,0x00000040); WriteReg_32(DBSC_E3_DBSCHQOS140,0x000000C0); WriteReg_32(DBSC_E3_DBSCHQOS141,0x000000B0); WriteReg_32(DBSC_E3_DBSCHQOS142,0x00000080); WriteReg_32(DBSC_E3_DBSCHQOS143,0x00000040); WriteReg_32(DBSC_E3_DBSCHQOS150,0x00000040); WriteReg_32(DBSC_E3_DBSCHQOS151,0x00000030); WriteReg_32(DBSC_E3_DBSCHQOS152,0x00000020); WriteReg_32(DBSC_E3_DBSCHQOS153,0x00000010); /* rev.0.08 */ if (pdqsr_ctl == 1){}else{ WriteReg_32(0xE67F0018,0x00000001); } WriteReg_32(DBSC_E3_DBSYSCNT0,0x00000000); #endif return 1; } /* recovery_from_backup_mode */ /******************************************************************************* * init_ddr : MD19=0,DDR3L,1584Mbps / MD19=1,DDR3L,1856Mbps ******************************************************************************/ /******************************************************************************* * DDR Initialize entry for IPL ******************************************************************************/ int32_t rcar_dram_init(void) { uint32_t dataL; uint32_t failcount; uint32_t md=0; uint32_t ddr=0; md = *((volatile uint32_t*)RST_MODEMR); ddr = (md & 0x00080000) >> 19; if(ddr == 0x0){ NOTICE("BL2: DDR1584(%s)", RCAR_E3_DDR_VERSION); } else if(ddr == 0x1){ NOTICE("BL2: DDR1856(%s)", RCAR_E3_DDR_VERSION); } /* ddr */ rcar_dram_get_boot_status(&ddrBackup); if(ddrBackup==DRAM_BOOT_STATUS_WARM){ dataL=recovery_from_backup_mode(); /* WARM boot */ } else { dataL=init_ddr(); /* COLD boot */ } /* ddrBackup */ if(dataL==1){ failcount =0; } else { failcount =1; } /* dataL */ NOTICE("..%d\n",failcount); /* rev.0.05 */ if(failcount==0){ return INITDRAM_OK; } else { return INITDRAM_NG; } /* failcount */ } /* InitDram */ /******************************************************************************* * END ******************************************************************************/