rcar_gen3: drivers: ddr-a: Fix V3M DDR init coding style

Coding style cleanup, no functional change.

Signed-off-by: Marek Vasut <marek.vasut+renesas@gmail.com>
Change-Id: I4f3e3812ffaa24fec50857756539b563eff33cdd
This commit is contained in:
Marek Vasut 2019-07-14 11:03:21 +02:00
parent d2ee6e01d0
commit 8bfca58bbf
1 changed files with 293 additions and 285 deletions

View File

@ -13,9 +13,7 @@
static uint32_t init_ddr_v3m_1600(void)
{
// last modified 2016.12.16
uint32_t RegVal_R2, RegVal_R5, RegVal_R6, RegVal_R7, RegVal_R12;
uint32_t i, r2, r5, r6, r7, r12;
mmio_write_32(DBSC_DBSYSCNT0, 0x00001234);
mmio_write_32(DBSC_DBKIND, 0x00000007);
@ -83,231 +81,241 @@ static uint32_t init_ddr_v3m_1600(void)
mmio_write_32(DBSC_DBSCHRW1, 0x001a0080);
mmio_write_32(DBSC_DBDFICNT0, 0x00000010);
mmio_write_32(DBSC_DBPDLK0,0X0000A55A);
mmio_write_32(DBSC_DBPDLK0, 0x0000A55A);
mmio_write_32(DBSC_DBCMD, 0x01000001);
mmio_write_32(DBSC_DBCMD, 0x08000000);
mmio_write_32(DBSC_DBPDRGA0,0X00000001);
mmio_write_32(DBSC_DBPDRGD0,0X80010000);
mmio_write_32(DBSC_DBPDRGA0,0X00000006);
while ( (BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0 );
mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x80010000);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0,0X00000008);
mmio_write_32(DBSC_DBPDRGD0,0X000B8000);
mmio_write_32(DBSC_DBPDRGA0,0X00000090);
mmio_write_32(DBSC_DBPDRGD0,0X04058904);
mmio_write_32(DBSC_DBPDRGA0,0X00000091);
mmio_write_32(DBSC_DBPDRGD0,0X0007BB6D);
mmio_write_32(DBSC_DBPDRGA0,0X00000095);
mmio_write_32(DBSC_DBPDRGD0,0X0007BB6B);
mmio_write_32(DBSC_DBPDRGA0,0X00000099);
mmio_write_32(DBSC_DBPDRGD0,0X0007BB6D);
mmio_write_32(DBSC_DBPDRGA0,0X00000090);
mmio_write_32(DBSC_DBPDRGD0,0X04058900);
mmio_write_32(DBSC_DBPDRGA0,0X00000021);
mmio_write_32(DBSC_DBPDRGD0,0X0024641E);
mmio_write_32(DBSC_DBPDRGA0,0X00000001);
mmio_write_32(DBSC_DBPDRGD0,0X00010073);
mmio_write_32(DBSC_DBPDRGA0,0X00000006);
while ( (BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0 );
mmio_write_32(DBSC_DBPDRGA0, 0x00000008);
mmio_write_32(DBSC_DBPDRGD0, 0x000B8000);
mmio_write_32(DBSC_DBPDRGA0, 0x00000090);
mmio_write_32(DBSC_DBPDRGD0, 0x04058904);
mmio_write_32(DBSC_DBPDRGA0, 0x00000091);
mmio_write_32(DBSC_DBPDRGD0, 0x0007BB6D);
mmio_write_32(DBSC_DBPDRGA0, 0x00000095);
mmio_write_32(DBSC_DBPDRGD0, 0x0007BB6B);
mmio_write_32(DBSC_DBPDRGA0, 0x00000099);
mmio_write_32(DBSC_DBPDRGD0, 0x0007BB6D);
mmio_write_32(DBSC_DBPDRGA0, 0x00000090);
mmio_write_32(DBSC_DBPDRGD0, 0x04058900);
mmio_write_32(DBSC_DBPDRGA0, 0x00000021);
mmio_write_32(DBSC_DBPDRGD0, 0x0024641E);
mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00010073);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0,0X00000090);
mmio_write_32(DBSC_DBPDRGD0,0X0C058900);
mmio_write_32(DBSC_DBPDRGA0,0X00000090);
mmio_write_32(DBSC_DBPDRGD0,0X04058900);
mmio_write_32(DBSC_DBPDRGA0,0X00000006);
while ( (BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0 );
mmio_write_32(DBSC_DBPDRGA0, 0x00000090);
mmio_write_32(DBSC_DBPDRGD0, 0x0C058900);
mmio_write_32(DBSC_DBPDRGA0, 0x00000090);
mmio_write_32(DBSC_DBPDRGD0, 0x04058900);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0,0X00000003);
mmio_write_32(DBSC_DBPDRGD0,0X0780C700);
mmio_write_32(DBSC_DBPDRGA0,0X00000007);
while ( (BIT(30)& mmio_read_32(DBSC_DBPDRGD0)) == 0 );
mmio_write_32(DBSC_DBPDRGA0, 0x00000003);
mmio_write_32(DBSC_DBPDRGD0, 0x0780C700);
mmio_write_32(DBSC_DBPDRGA0, 0x00000007);
while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(30)))
;
mmio_write_32(DBSC_DBPDRGA0,0X00000004);
mmio_write_32(DBSC_DBPDRGD0,0X08C0C170);
mmio_write_32(DBSC_DBPDRGA0,0X00000022);
mmio_write_32(DBSC_DBPDRGD0,0X1000040B);
mmio_write_32(DBSC_DBPDRGA0,0X00000023);
mmio_write_32(DBSC_DBPDRGD0,0X2D9C0B66);
mmio_write_32(DBSC_DBPDRGA0,0X00000024);
mmio_write_32(DBSC_DBPDRGD0,0X2A88C400);
mmio_write_32(DBSC_DBPDRGA0,0X00000025);
mmio_write_32(DBSC_DBPDRGD0,0X30005200);
mmio_write_32(DBSC_DBPDRGA0,0X00000026);
mmio_write_32(DBSC_DBPDRGD0,0X0014A9C9);
mmio_write_32(DBSC_DBPDRGA0,0X00000027);
mmio_write_32(DBSC_DBPDRGD0,0X00000D70);
mmio_write_32(DBSC_DBPDRGA0,0X00000028);
mmio_write_32(DBSC_DBPDRGD0,0X00000004);
mmio_write_32(DBSC_DBPDRGA0,0X00000029);
mmio_write_32(DBSC_DBPDRGD0,0X00000018);
mmio_write_32(DBSC_DBPDRGA0,0X0000002C);
mmio_write_32(DBSC_DBPDRGD0,0X81003047);
mmio_write_32(DBSC_DBPDRGA0,0X00000020);
mmio_write_32(DBSC_DBPDRGD0,0X00181884);
mmio_write_32(DBSC_DBPDRGA0,0X0000001A);
mmio_write_32(DBSC_DBPDRGD0,0X13C03C10);
mmio_write_32(DBSC_DBPDRGA0,0X00000006);
while ( (BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0 );
mmio_write_32(DBSC_DBPDRGA0, 0x00000004);
mmio_write_32(DBSC_DBPDRGD0, 0x08C0C170);
mmio_write_32(DBSC_DBPDRGA0, 0x00000022);
mmio_write_32(DBSC_DBPDRGD0, 0x1000040B);
mmio_write_32(DBSC_DBPDRGA0, 0x00000023);
mmio_write_32(DBSC_DBPDRGD0, 0x2D9C0B66);
mmio_write_32(DBSC_DBPDRGA0, 0x00000024);
mmio_write_32(DBSC_DBPDRGD0, 0x2A88C400);
mmio_write_32(DBSC_DBPDRGA0, 0x00000025);
mmio_write_32(DBSC_DBPDRGD0, 0x30005200);
mmio_write_32(DBSC_DBPDRGA0, 0x00000026);
mmio_write_32(DBSC_DBPDRGD0, 0x0014A9C9);
mmio_write_32(DBSC_DBPDRGA0, 0x00000027);
mmio_write_32(DBSC_DBPDRGD0, 0x00000D70);
mmio_write_32(DBSC_DBPDRGA0, 0x00000028);
mmio_write_32(DBSC_DBPDRGD0, 0x00000004);
mmio_write_32(DBSC_DBPDRGA0, 0x00000029);
mmio_write_32(DBSC_DBPDRGD0, 0x00000018);
mmio_write_32(DBSC_DBPDRGA0, 0x0000002C);
mmio_write_32(DBSC_DBPDRGD0, 0x81003047);
mmio_write_32(DBSC_DBPDRGA0, 0x00000020);
mmio_write_32(DBSC_DBPDRGD0, 0x00181884);
mmio_write_32(DBSC_DBPDRGA0, 0x0000001A);
mmio_write_32(DBSC_DBPDRGD0, 0x13C03C10);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0,0X000000A7);
mmio_write_32(DBSC_DBPDRGD0,0X0D0D0D0D);
mmio_write_32(DBSC_DBPDRGA0,0X000000A8);
mmio_write_32(DBSC_DBPDRGD0,0X0D0D0D0D);
mmio_write_32(DBSC_DBPDRGA0,0X000000A9);
mmio_write_32(DBSC_DBPDRGD0,0X000D0D0D);
mmio_write_32(DBSC_DBPDRGA0,0X000000C7);
mmio_write_32(DBSC_DBPDRGD0,0X0D0D0D0D);
mmio_write_32(DBSC_DBPDRGA0,0X000000C8);
mmio_write_32(DBSC_DBPDRGD0,0X0D0D0D0D);
mmio_write_32(DBSC_DBPDRGA0,0X000000C9);
mmio_write_32(DBSC_DBPDRGD0,0X000D0D0D);
mmio_write_32(DBSC_DBPDRGA0,0X000000E7);
mmio_write_32(DBSC_DBPDRGD0,0X0D0D0D0D);
mmio_write_32(DBSC_DBPDRGA0,0X000000E8);
mmio_write_32(DBSC_DBPDRGD0,0X0D0D0D0D);
mmio_write_32(DBSC_DBPDRGA0,0X000000E9);
mmio_write_32(DBSC_DBPDRGD0,0X000D0D0D);
mmio_write_32(DBSC_DBPDRGA0,0X00000107);
mmio_write_32(DBSC_DBPDRGD0,0X0D0D0D0D);
mmio_write_32(DBSC_DBPDRGA0,0X00000108);
mmio_write_32(DBSC_DBPDRGD0,0X0D0D0D0D);
mmio_write_32(DBSC_DBPDRGA0,0X00000109);
mmio_write_32(DBSC_DBPDRGD0,0X000D0D0D);
mmio_write_32(DBSC_DBPDRGA0,0X00000001);
mmio_write_32(DBSC_DBPDRGD0,0X00010181);
mmio_write_32(DBSC_DBPDRGA0, 0x000000A7);
mmio_write_32(DBSC_DBPDRGD0, 0x0D0D0D0D);
mmio_write_32(DBSC_DBPDRGA0, 0x000000A8);
mmio_write_32(DBSC_DBPDRGD0, 0x0D0D0D0D);
mmio_write_32(DBSC_DBPDRGA0, 0x000000A9);
mmio_write_32(DBSC_DBPDRGD0, 0x000D0D0D);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C7);
mmio_write_32(DBSC_DBPDRGD0, 0x0D0D0D0D);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C8);
mmio_write_32(DBSC_DBPDRGD0, 0x0D0D0D0D);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C9);
mmio_write_32(DBSC_DBPDRGD0, 0x000D0D0D);
mmio_write_32(DBSC_DBPDRGA0, 0x000000E7);
mmio_write_32(DBSC_DBPDRGD0, 0x0D0D0D0D);
mmio_write_32(DBSC_DBPDRGA0, 0x000000E8);
mmio_write_32(DBSC_DBPDRGD0, 0x0D0D0D0D);
mmio_write_32(DBSC_DBPDRGA0, 0x000000E9);
mmio_write_32(DBSC_DBPDRGD0, 0x000D0D0D);
mmio_write_32(DBSC_DBPDRGA0, 0x00000107);
mmio_write_32(DBSC_DBPDRGD0, 0x0D0D0D0D);
mmio_write_32(DBSC_DBPDRGA0, 0x00000108);
mmio_write_32(DBSC_DBPDRGD0, 0x0D0D0D0D);
mmio_write_32(DBSC_DBPDRGA0, 0x00000109);
mmio_write_32(DBSC_DBPDRGD0, 0x000D0D0D);
mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00010181);
mmio_write_32(DBSC_DBCMD, 0x08000001);
mmio_write_32(DBSC_DBPDRGA0,0X00000006);
while ( (BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0 );
mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0,0X00000001);
mmio_write_32(DBSC_DBPDRGD0,0X00010601);
mmio_write_32(DBSC_DBPDRGA0,0X00000006);
while ( (BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0 );
mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00010601);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
for (uint32_t i = 0; i<4; i++)
{
mmio_write_32(DBSC_DBPDRGA0,0X000000B1 + i*0x20);
RegVal_R5 = (mmio_read_32(DBSC_DBPDRGD0) & 0x0000FF00 ) >> 8;
mmio_write_32(DBSC_DBPDRGA0,0X000000B4 + i*0x20);
RegVal_R6 = (mmio_read_32(DBSC_DBPDRGD0) & 0x000000FF ) ;
mmio_write_32(DBSC_DBPDRGA0,0X000000B3 + i*0x20);
RegVal_R7 = (mmio_read_32(DBSC_DBPDRGD0) & 0x00000007 ) ;
if ( RegVal_R6 > 0 )
{
mmio_write_32(DBSC_DBPDRGA0,0X000000B2 + i*0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0XFFFFFFF8 ) ;
for (i = 0; i < 4; i++) {
mmio_write_32(DBSC_DBPDRGA0, 0xB1 + i * 0x20);
r5 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFF00) >> 8;
mmio_write_32(DBSC_DBPDRGA0, 0xB4 + i * 0x20);
r6 = mmio_read_32(DBSC_DBPDRGD0) & 0xFF;
mmio_write_32(DBSC_DBPDRGA0, 0xB3 + i * 0x20);
r7 = mmio_read_32(DBSC_DBPDRGD0) & 0x7;
mmio_write_32(DBSC_DBPDRGA0,0X000000B2 + i*0x20);
mmio_write_32(DBSC_DBPDRGD0,((RegVal_R7+1)&0X00000007) | RegVal_R2);
mmio_write_32(DBSC_DBPDRGA0,0X000000B0 + i*0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0XFFFFFF00 ) ;
mmio_write_32(DBSC_DBPDRGA0,0X000000B0 + i*0x20);
mmio_write_32(DBSC_DBPDRGD0,RegVal_R2 | RegVal_R6);
if (r6 > 0) {
mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
r2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8);
mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, ((r7 + 1) & 0x7) | r2);
mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
r2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00);
mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, r2 | r6);
} else {
mmio_write_32(DBSC_DBPDRGA0,0X000000B2 + i*0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0XFFFFFFF8 ) ;
mmio_write_32(DBSC_DBPDRGA0,0X000000B2 + i*0x20);
mmio_write_32(DBSC_DBPDRGD0,RegVal_R2 | RegVal_R7);
mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
r2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8);
mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, r2 | r7);
mmio_write_32(DBSC_DBPDRGA0,0X000000B0 + i*0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0XFFFFFF00 ) ;
mmio_write_32(DBSC_DBPDRGA0,0X000000B0 + i*0x20);
mmio_write_32(DBSC_DBPDRGD0,(((RegVal_R5<<1) + RegVal_R6 ) & 0X000000FF )| RegVal_R2);
mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
r2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00);
mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, r2 |
(((r5 << 1) + r6) & 0xFF));
}
}
mmio_write_32(DBSC_DBPDRGA0,0X00000005);
mmio_write_32(DBSC_DBPDRGD0,0XC1AA00A0);
mmio_write_32(DBSC_DBPDRGA0,0X000000A0);
mmio_write_32(DBSC_DBPDRGD0,0X7C0002C5);
mmio_write_32(DBSC_DBPDRGA0,0X000000C0);
mmio_write_32(DBSC_DBPDRGD0,0X7C0002C5);
mmio_write_32(DBSC_DBPDRGA0,0X000000E0);
mmio_write_32(DBSC_DBPDRGD0,0X7C0002C5);
mmio_write_32(DBSC_DBPDRGA0,0X00000100);
mmio_write_32(DBSC_DBPDRGD0,0X7C0002C5);
mmio_write_32(DBSC_DBPDRGA0,0X00000001);
mmio_write_32(DBSC_DBPDRGD0,0X00010801);
mmio_write_32(DBSC_DBPDRGA0,0X00000006);
while ( (BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0 );
mmio_write_32(DBSC_DBPDRGA0, 0x00000005);
mmio_write_32(DBSC_DBPDRGD0, 0xC1AA00A0);
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x000000E0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x00000100);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00010801);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0,0X00000005);
mmio_write_32(DBSC_DBPDRGD0,0XC1AA00B8);
mmio_write_32(DBSC_DBPDRGA0,0X00000001);
mmio_write_32(DBSC_DBPDRGD0,0X0001F001);
mmio_write_32(DBSC_DBPDRGA0,0X00000006);
while ( (BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0 );
mmio_write_32(DBSC_DBPDRGA0, 0x00000005);
mmio_write_32(DBSC_DBPDRGD0, 0xC1AA00B8);
mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x0001F001);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0,0X000000A0);
mmio_write_32(DBSC_DBPDRGD0,0X7C000285);
mmio_write_32(DBSC_DBPDRGA0,0X000000C0);
mmio_write_32(DBSC_DBPDRGD0,0X7C000285);
mmio_write_32(DBSC_DBPDRGA0,0X000000E0);
mmio_write_32(DBSC_DBPDRGD0,0X7C000285);
mmio_write_32(DBSC_DBPDRGA0,0X00000100);
mmio_write_32(DBSC_DBPDRGD0,0X7C000285);
mmio_write_32(DBSC_DBPDRGA0,0X0000002C);
mmio_write_32(DBSC_DBPDRGD0,0X81003087);
mmio_write_32(DBSC_DBPDRGA0,0X00000001);
mmio_write_32(DBSC_DBPDRGD0,0X00010401);
mmio_write_32(DBSC_DBPDRGA0,0X00000006);
while ( (BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0 );
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C000285);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C000285);
mmio_write_32(DBSC_DBPDRGA0, 0x000000E0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C000285);
mmio_write_32(DBSC_DBPDRGA0, 0x00000100);
mmio_write_32(DBSC_DBPDRGD0, 0x7C000285);
mmio_write_32(DBSC_DBPDRGA0, 0x0000002C);
mmio_write_32(DBSC_DBPDRGD0, 0x81003087);
mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00010401);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
for (uint32_t i = 0; i < 4; i++)
{
mmio_write_32(DBSC_DBPDRGA0, 0X000000B1 + i * 0x20);
RegVal_R5 = (mmio_read_32(DBSC_DBPDRGD0) & 0x0000FF00) >> 8;
mmio_write_32(DBSC_DBPDRGA0, 0X000000B4 + i * 0x20);
RegVal_R6 = (mmio_read_32(DBSC_DBPDRGD0) & 0x000000FF);
for (i = 0; i < 4; i++) {
mmio_write_32(DBSC_DBPDRGA0, 0xB1 + i * 0x20);
r5 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFF00) >> 8;
mmio_write_32(DBSC_DBPDRGA0, 0xB4 + i * 0x20);
r6 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFF);
mmio_write_32(DBSC_DBPDRGA0, 0X000000B3 + i * 0x20);
RegVal_R7 = (mmio_read_32(DBSC_DBPDRGD0) & 0x00000007);
RegVal_R12 = (RegVal_R5 >> 2);
if (RegVal_R6 - RegVal_R12 > 0)
{
mmio_write_32(DBSC_DBPDRGA0, 0X000000B2 + i * 0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0XFFFFFFF8);
mmio_write_32(DBSC_DBPDRGA0, 0xB3 + i * 0x20);
r7 = (mmio_read_32(DBSC_DBPDRGD0) & 0x7);
r12 = (r5 >> 2);
if (r6 - r12 > 0) {
mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
r2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8);
mmio_write_32(DBSC_DBPDRGA0, 0X000000B2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, ((RegVal_R7 + 1) & 0X00000007) | RegVal_R2);
mmio_write_32(DBSC_DBPDRGA0, 0X000000B0 + i * 0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0XFFFFFF00);
mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, ((r7 + 1) & 0x7) | r2);
mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
r2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00);
mmio_write_32(DBSC_DBPDRGA0, 0X000000B0 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, ((RegVal_R6 - RegVal_R12) & 0X000000FF) | RegVal_R2);
}
else
{
mmio_write_32(DBSC_DBPDRGA0, 0X000000B2 + i * 0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0XFFFFFFF8);
mmio_write_32(DBSC_DBPDRGA0, 0X000000B2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, (RegVal_R7 & 0X00000007) | RegVal_R2);
mmio_write_32(DBSC_DBPDRGA0, 0X000000B0 + i * 0x20);
RegVal_R2 = (mmio_read_32(DBSC_DBPDRGD0) & 0XFFFFFF00);
mmio_write_32(DBSC_DBPDRGA0, 0X000000B0 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, ((RegVal_R6 + RegVal_R5 + (RegVal_R5 >> 1) + RegVal_R12) & 0X000000FF) | RegVal_R2);
mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, ((r6 - r12) & 0xFF) | r2);
} else {
mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
r2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFFF8);
mmio_write_32(DBSC_DBPDRGA0, 0xB2 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, (r7 & 0x7) | r2);
mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
r2 = (mmio_read_32(DBSC_DBPDRGD0) & 0xFFFFFF00);
mmio_write_32(DBSC_DBPDRGA0, 0xB0 + i * 0x20);
mmio_write_32(DBSC_DBPDRGD0, r2 |
((r6 + r5 +
(r5 >> 1) + r12) & 0xFF));
}
}
mmio_write_32(DBSC_DBPDRGA0,0X000000A0);
mmio_write_32(DBSC_DBPDRGD0,0X7C0002C5);
mmio_write_32(DBSC_DBPDRGA0,0X000000C0);
mmio_write_32(DBSC_DBPDRGD0,0X7C0002C5);
mmio_write_32(DBSC_DBPDRGA0,0X000000E0);
mmio_write_32(DBSC_DBPDRGD0,0X7C0002C5);
mmio_write_32(DBSC_DBPDRGA0,0X00000100);
mmio_write_32(DBSC_DBPDRGD0,0X7C0002C5);
mmio_write_32(DBSC_DBPDRGA0,0X00000001);
mmio_write_32(DBSC_DBPDRGD0,0X00015001);
mmio_write_32(DBSC_DBPDRGA0,0X00000006);
while ( (BIT(0) & mmio_read_32(DBSC_DBPDRGD0)) == 0 );
mmio_write_32(DBSC_DBPDRGA0, 0x000000A0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x000000C0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x000000E0);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x00000100);
mmio_write_32(DBSC_DBPDRGD0, 0x7C0002C5);
mmio_write_32(DBSC_DBPDRGA0, 0x00000001);
mmio_write_32(DBSC_DBPDRGD0, 0x00015001);
mmio_write_32(DBSC_DBPDRGA0, 0x00000006);
while (!(mmio_read_32(DBSC_DBPDRGD0) & BIT(0)))
;
mmio_write_32(DBSC_DBPDRGA0,0X00000003);
mmio_write_32(DBSC_DBPDRGD0,0X0380C700);
mmio_write_32(DBSC_DBPDRGA0,0X00000007);
while ( (BIT(30)& mmio_read_32(DBSC_DBPDRGD0)) != 0 );
mmio_write_32(DBSC_DBPDRGA0,0X00000021);
mmio_write_32(DBSC_DBPDRGD0,0X0024643E);
mmio_write_32(DBSC_DBPDRGA0, 0x00000003);
mmio_write_32(DBSC_DBPDRGD0, 0x0380C700);
mmio_write_32(DBSC_DBPDRGA0, 0x00000007);
while (mmio_read_32(DBSC_DBPDRGD0) & BIT(30))
;
mmio_write_32(DBSC_DBPDRGA0, 0x00000021);
mmio_write_32(DBSC_DBPDRGD0, 0x0024643E);
mmio_write_32(DBSC_DBBUS0CNF1, 0x00000000);
mmio_write_32(DBSC_DBBUS0CNF0, 0x00010001);
@ -317,14 +325,14 @@ static uint32_t init_ddr_v3m_1600(void)
mmio_write_32(DBSC_DBDFICUPDCNF, 0x40100001);
mmio_write_32(DBSC_DBRFEN, 0x00000001);
mmio_write_32(DBSC_DBACEN, 0x00000001);
mmio_write_32(DBSC_DBPDLK0,0X00000000);
mmio_write_32(DBSC_DBPDLK0, 0x00000000);
mmio_write_32(0xE67F0024, 0x00000001);
mmio_write_32(DBSC_DBSYSCNT0, 0x00000000);
return 1;
return INITDRAM_OK;
}
int32_t rcar_dram_init(void)
{
return init_ddr_v3m_1600() ? INITDRAM_OK : INITDRAM_NG;
return init_ddr_v3m_1600();
}