code cleanup, comments added
git-svn-id: svn://svn.coreboot.org/coreboot/trunk@2284 2b7e53f0-3cfb-0310-b3e9-8179ed1497e1
This commit is contained in:
@@ -9,7 +9,8 @@
|
|||||||
/* **/
|
/* **/
|
||||||
/* ***************************************************************************/
|
/* ***************************************************************************/
|
||||||
static void
|
static void
|
||||||
BIST(void){
|
BIST(void)
|
||||||
|
{
|
||||||
int msrnum;
|
int msrnum;
|
||||||
msr_t msr;
|
msr_t msr;
|
||||||
|
|
||||||
@@ -24,7 +25,7 @@ BIST(void){
|
|||||||
msrnum = CPU_DM_BIST;
|
msrnum = CPU_DM_BIST;
|
||||||
wrmsr(msrnum, msr);
|
wrmsr(msrnum, msr);
|
||||||
|
|
||||||
outb(POST_CPU_DM_BIST_FAILURE , 0x80); /* 0x29*/
|
outb(POST_CPU_DM_BIST_FAILURE, 0x80); /* 0x29*/
|
||||||
msr = rdmsr(msrnum); /* read back for pass fail*/
|
msr = rdmsr(msrnum); /* read back for pass fail*/
|
||||||
msr.lo &= 0x0F3FF0000;
|
msr.lo &= 0x0F3FF0000;
|
||||||
if (msr.lo != 0xfeff0000)
|
if (msr.lo != 0xfeff0000)
|
||||||
@@ -48,39 +49,31 @@ BIST(void){
|
|||||||
msr = rdmsr(msrnum); /* Endless loop if BIST is broken*/
|
msr = rdmsr(msrnum); /* Endless loop if BIST is broken*/
|
||||||
if ((msr.lo&0x642) != 0x642)
|
if ((msr.lo&0x642) != 0x642)
|
||||||
goto BISTFail;
|
goto BISTFail;
|
||||||
|
|
||||||
msr.lo = msr.hi = 0; /* clear FPU BIST bits*/
|
msr.lo = msr.hi = 0; /* clear FPU BIST bits*/
|
||||||
msrnum = CPU_FP_UROM_BIST;
|
msrnum = CPU_FP_UROM_BIST;
|
||||||
wrmsr(msrnum, msr);
|
wrmsr(msrnum, msr);
|
||||||
|
|
||||||
|
|
||||||
/* BTB*/
|
/* BTB*/
|
||||||
msr.lo = 0x000000303;
|
msr.lo = 0x000000303;
|
||||||
msr.hi = 0x000000000;
|
msr.hi = 0x000000000;
|
||||||
msrnum = CPU_PF_BTBRMA_BIST;
|
msrnum = CPU_PF_BTBRMA_BIST;
|
||||||
wrmsr(msrnum, msr);
|
wrmsr(msrnum, msr);
|
||||||
|
|
||||||
outb(POST_CPU_BTB_BIST_FAILURE , 0x80); /* 0x8A*/
|
outb(POST_CPU_BTB_BIST_FAILURE, 0x80); /* 0x8A*/
|
||||||
msr = rdmsr(msrnum); /* read back for pass fail*/
|
msr = rdmsr(msrnum); /* read back for pass fail*/
|
||||||
if ((msr.lo & 0x3030) != 0x3030)
|
if ((msr.lo & 0x3030) != 0x3030)
|
||||||
goto BISTFail;
|
goto BISTFail;
|
||||||
|
|
||||||
return;
|
return;
|
||||||
|
|
||||||
BISTFail:
|
BISTFail:
|
||||||
print_err("BIST failed!\n");
|
print_err("BIST failed!\n");
|
||||||
while(1);
|
while(1);
|
||||||
}
|
}
|
||||||
/* ***************************************************************************/
|
|
||||||
/* * cpuRegInit*/
|
void BTM_enable(void)
|
||||||
/* ***************************************************************************/
|
{
|
||||||
void
|
|
||||||
cpuRegInit (void){
|
|
||||||
int msrnum;
|
int msrnum;
|
||||||
msr_t msr;
|
msr_t msr;
|
||||||
/* Turn on BTM for early debug based on setup. */
|
|
||||||
/*if (getnvram( TOKEN_BTM_DIAG_MODE) & 3) {*/
|
|
||||||
{
|
|
||||||
/* Set Diagnostic Mode */
|
/* Set Diagnostic Mode */
|
||||||
msrnum = CPU_GLD_MSR_DIAG;
|
msrnum = CPU_GLD_MSR_DIAG;
|
||||||
msr.hi = 0;
|
msr.hi = 0;
|
||||||
@@ -107,13 +100,14 @@ cpuRegInit (void){
|
|||||||
|
|
||||||
/* ;Set fifo ctl to BTM bits wide*/
|
/* ;Set fifo ctl to BTM bits wide*/
|
||||||
msrnum = 0x04C00005E; /* FIFO_CTL*/
|
msrnum = 0x04C00005E; /* FIFO_CTL*/
|
||||||
msr.lo = 0x003880000; /* Bit [25:24] are size (11=BTM, 10 = 64 bit, 01= 32 bit, 00 = 16bit)*/
|
msr.lo = 0x003880000; /* Bit [25:24] are size (11=BTM, 10 = 64 bit,
|
||||||
wrmsr(msrnum, msr); /* Bit [23:21] are position (100 = CPU downto0)*/
|
* 01= 32 bit, 00 = 16bit),
|
||||||
|
* Bit [23:21] are position (100 = CPU downto0)*/
|
||||||
|
wrmsr(msrnum, msr); /* */
|
||||||
/* Bit [19] sets it up in slow data mode.*/
|
/* Bit [19] sets it up in slow data mode.*/
|
||||||
|
|
||||||
/* ;enable fifo loading - BTM sizing will constrain*/
|
/* ;enable fifo loading - BTM sizing will constrain*/
|
||||||
/* ; only valid BTM packets to load - this action should always be on*/
|
/* ; only valid BTM packets to load - this action should always be on*/
|
||||||
|
|
||||||
msrnum = 0x04C00006F; /* GLCP ACTION7 - load fifo*/
|
msrnum = 0x04C00006F; /* GLCP ACTION7 - load fifo*/
|
||||||
msr.lo = 0x00000F000; /* Any nibble all 1's will always trigger*/
|
msr.lo = 0x00000F000; /* Any nibble all 1's will always trigger*/
|
||||||
msr.hi = 0x000000000; /* */
|
msr.hi = 0x000000000; /* */
|
||||||
@@ -143,6 +137,20 @@ cpuRegInit (void){
|
|||||||
msr.lo = 0x0; /* reset value (SCOPE_SEL = 0) causes FIFO to shift out,*/
|
msr.lo = 0x0; /* reset value (SCOPE_SEL = 0) causes FIFO to shift out,*/
|
||||||
wrmsr(msrnum, msr);
|
wrmsr(msrnum, msr);
|
||||||
/* end of code for BTM */
|
/* end of code for BTM */
|
||||||
|
}
|
||||||
|
|
||||||
|
/* ***************************************************************************/
|
||||||
|
/* * cpuRegInit*/
|
||||||
|
/* ***************************************************************************/
|
||||||
|
void
|
||||||
|
cpuRegInit (void)
|
||||||
|
{
|
||||||
|
int msrnum;
|
||||||
|
msr_t msr;
|
||||||
|
/* Turn on BTM for early debug based on setup. */
|
||||||
|
/*if (getnvram( TOKEN_BTM_DIAG_MODE) & 3) {*/
|
||||||
|
{
|
||||||
|
BTM_enable();
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Enable Suspend on Halt*/
|
/* Enable Suspend on Halt*/
|
||||||
@@ -164,49 +172,32 @@ cpuRegInit (void){
|
|||||||
msr.lo = 0x00000603C;
|
msr.lo = 0x00000603C;
|
||||||
wrmsr(msrnum, msr);
|
wrmsr(msrnum, msr);
|
||||||
|
|
||||||
|
/* Enable CIS mode C */
|
||||||
/* Only do this if we are building for 5535*/
|
|
||||||
/* */
|
|
||||||
/* FooGlue Setup*/
|
|
||||||
/* */
|
|
||||||
#if 1
|
|
||||||
/* Enable CIS mode B in FooGlue*/
|
|
||||||
msrnum = MSR_FG + 0x10;
|
msrnum = MSR_FG + 0x10;
|
||||||
msr = rdmsr(msrnum);
|
msr = rdmsr(msrnum);
|
||||||
msr.lo &= ~3;
|
msr.lo &= ~3;
|
||||||
msr.lo |= 2; /* ModeB*/
|
msr.lo |= 2;
|
||||||
wrmsr(msrnum, msr);
|
wrmsr(msrnum, msr);
|
||||||
#endif
|
|
||||||
|
|
||||||
/* */
|
/* Disable DOT PLL. Graphics init will enable it if needed.*/
|
||||||
/* Disable DOT PLL. Graphics init will enable it if needed.*/
|
|
||||||
/* */
|
|
||||||
msrnum = GLCP_DOTPLL;
|
msrnum = GLCP_DOTPLL;
|
||||||
msr = rdmsr(msrnum);
|
msr = rdmsr(msrnum);
|
||||||
msr.lo |= DOTPPL_LOWER_PD_SET;
|
msr.lo |= DOTPPL_LOWER_PD_SET;
|
||||||
wrmsr(msrnum, msr);
|
wrmsr(msrnum, msr);
|
||||||
|
|
||||||
/* */
|
/* Enable RSDC and other SMM instructions */
|
||||||
/* Enable RSDC*/
|
|
||||||
/* */
|
|
||||||
msrnum = 0x1301 ;
|
msrnum = 0x1301 ;
|
||||||
msr = rdmsr(msrnum);
|
msr = rdmsr(msrnum);
|
||||||
msr.lo |= 0x08;
|
msr.lo |= 0x08;
|
||||||
wrmsr(msrnum, msr);
|
wrmsr(msrnum, msr);
|
||||||
|
|
||||||
|
/* BIST*/
|
||||||
/* */
|
|
||||||
/* BIST*/
|
|
||||||
/* */
|
|
||||||
/*if (getnvram( TOKEN_BIST_ENABLE) & == TVALUE_DISABLE) {*/
|
/*if (getnvram( TOKEN_BIST_ENABLE) & == TVALUE_DISABLE) {*/
|
||||||
{
|
{
|
||||||
// BIST();
|
//BIST();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/* Enable BTB*/
|
||||||
/* */
|
|
||||||
/* Enable BTB*/
|
|
||||||
/* */
|
|
||||||
/* I hate to put this check here but it doesn't really work in cpubug.asm*/
|
/* I hate to put this check here but it doesn't really work in cpubug.asm*/
|
||||||
msrnum = MSR_GLCP+0x17;
|
msrnum = MSR_GLCP+0x17;
|
||||||
msr = rdmsr(msrnum);
|
msr = rdmsr(msrnum);
|
||||||
@@ -217,9 +208,7 @@ cpuRegInit (void){
|
|||||||
wrmsr(msrnum, msr);
|
wrmsr(msrnum, msr);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* */
|
/* FPU impercise exceptions bit*/
|
||||||
/* FPU impercise exceptions bit*/
|
|
||||||
/* */
|
|
||||||
/*if (getnvram( TOKEN_FPU_IE_ENABLE) != TVALUE_DISABLE) {*/
|
/*if (getnvram( TOKEN_FPU_IE_ENABLE) != TVALUE_DISABLE) {*/
|
||||||
{
|
{
|
||||||
msrnum = CPU_FPU_MSR_MODE;
|
msrnum = CPU_FPU_MSR_MODE;
|
||||||
@@ -228,9 +217,7 @@ cpuRegInit (void){
|
|||||||
wrmsr(msrnum, msr);
|
wrmsr(msrnum, msr);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* */
|
/* Cache Overides*/
|
||||||
/* Cache Overides*/
|
|
||||||
/* */
|
|
||||||
/* Allow NVRam to override DM Setup*/
|
/* Allow NVRam to override DM Setup*/
|
||||||
/*if (getnvram( TOKEN_CACHE_DM_MODE) != 1) {*/
|
/*if (getnvram( TOKEN_CACHE_DM_MODE) != 1) {*/
|
||||||
{
|
{
|
||||||
@@ -250,9 +237,6 @@ cpuRegInit (void){
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
/* ***************************************************************************/
|
/* ***************************************************************************/
|
||||||
/* **/
|
/* **/
|
||||||
/* * MTestPinCheckBX*/
|
/* * MTestPinCheckBX*/
|
||||||
@@ -262,7 +246,8 @@ cpuRegInit (void){
|
|||||||
/* **/
|
/* **/
|
||||||
/* ***************************************************************************/
|
/* ***************************************************************************/
|
||||||
static void
|
static void
|
||||||
MTestPinCheckBX (void){
|
MTestPinCheckBX (void)
|
||||||
|
{
|
||||||
int msrnum;
|
int msrnum;
|
||||||
msr_t msr;
|
msr_t msr;
|
||||||
|
|
||||||
|
@@ -12,6 +12,7 @@ static void vsm_end_post_smi(void)
|
|||||||
__asm__ volatile (
|
__asm__ volatile (
|
||||||
"push %ax\n"
|
"push %ax\n"
|
||||||
"mov $0x5000, %ax\n"
|
"mov $0x5000, %ax\n"
|
||||||
|
/* smint */
|
||||||
".byte 0x0f, 0x38\n"
|
".byte 0x0f, 0x38\n"
|
||||||
"pop %ax\n"
|
"pop %ax\n"
|
||||||
);
|
);
|
||||||
@@ -24,9 +25,7 @@ static void model_gx2_init(device_t dev)
|
|||||||
/* Turn on caching if we haven't already */
|
/* Turn on caching if we haven't already */
|
||||||
x86_enable_cache();
|
x86_enable_cache();
|
||||||
|
|
||||||
/* Enable the local cpu apics */
|
/* send SYS_END_OF_POST to VSM */
|
||||||
//setup_lapic();
|
|
||||||
|
|
||||||
vsm_end_post_smi();
|
vsm_end_post_smi();
|
||||||
|
|
||||||
printk_debug("model_gx2_init DONE\n");
|
printk_debug("model_gx2_init DONE\n");
|
||||||
|
@@ -1,20 +1,13 @@
|
|||||||
/* ***************************************************************************/
|
|
||||||
/* **/
|
|
||||||
/* * StartTimer1*/
|
|
||||||
/* **/
|
|
||||||
/* * Entry: none*/
|
|
||||||
/* * Exit: Starts Timer 1 for port 61 use*/
|
|
||||||
/* * Destroys: Al,*/
|
|
||||||
/* **/
|
|
||||||
/* ***************************************************************************/
|
|
||||||
void
|
void
|
||||||
StartTimer1(void){
|
StartTimer1(void)
|
||||||
|
{
|
||||||
outb(0x56, 0x43);
|
outb(0x56, 0x43);
|
||||||
outb(0x12, 0x41);
|
outb(0x12, 0x41);
|
||||||
}
|
}
|
||||||
|
|
||||||
void
|
void
|
||||||
SystemPreInit(void){
|
SystemPreInit(void)
|
||||||
|
{
|
||||||
|
|
||||||
/* they want a jump ... */
|
/* they want a jump ... */
|
||||||
__asm__("jmp .+2\ninvd\njmp.+2\n");
|
__asm__("jmp .+2\ninvd\njmp.+2\n");
|
||||||
|
@@ -240,7 +240,6 @@ setup_gx2(void)
|
|||||||
|
|
||||||
static void enable_shadow(device_t dev)
|
static void enable_shadow(device_t dev)
|
||||||
{
|
{
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void northbridge_init(device_t dev)
|
static void northbridge_init(device_t dev)
|
||||||
|
@@ -263,11 +263,10 @@ GLIUInit(struct gliutable *gl){
|
|||||||
while (gl->desc_type != GL_END){
|
while (gl->desc_type != GL_END){
|
||||||
switch(gl->desc_type){
|
switch(gl->desc_type){
|
||||||
default:
|
default:
|
||||||
printk_err("%s: name %x, type %x, hi %x, lo %x: unsupported type: ", __FUNCTION__,
|
printk_err("%s: name %x, type %x, hi %x, lo %x: unsupported type: ",
|
||||||
gl->desc_name, gl->desc_type, gl->hi, gl->hi);
|
__FUNCTION__, gl->desc_name, gl->desc_type, gl->hi, gl->hi);
|
||||||
printk_err("Must be %x, %x, %x, %x, %x, or %x\n", SC_SHADOW,R_SYSMEM,BMO_DMM,
|
printk_err("Must be %x, %x, %x, %x, %x, or %x\n",
|
||||||
BM_DMM, BMO_SMM,BM_SMM);
|
SC_SHADOW,R_SYSMEM,BMO_DMM, BM_DMM, BMO_SMM,BM_SMM);
|
||||||
|
|
||||||
case SC_SHADOW: /* Check for a Shadow entry*/
|
case SC_SHADOW: /* Check for a Shadow entry*/
|
||||||
ShadowInit(gl);
|
ShadowInit(gl);
|
||||||
break;
|
break;
|
||||||
|
@@ -32,15 +32,20 @@ static void sdram_set_registers(const struct mem_controller *ctrl)
|
|||||||
#define RRCF_LOW_CD(base) RRCF_LOW(base, CACHE_DISABLE)
|
#define RRCF_LOW_CD(base) RRCF_LOW(base, CACHE_DISABLE)
|
||||||
|
|
||||||
/* build initializer for P2D MSR */
|
/* build initializer for P2D MSR */
|
||||||
#define P2D_BM(msr, pdid1, bizarro, pbase, pmask) {msr, .hi=(pdid1<<29)|(bizarro<<28)|(pbase>>24), .lo=(pbase<<8)|pmask}
|
#define P2D_BM(msr, pdid1, bizarro, pbase, pmask) \
|
||||||
#define P2D_BMO(msr, pdid1, bizarro, poffset, pbase, pmask) {msr, .hi=(pdid1<<29)|(bizarro<<28)|(poffset<<8)|(pbase>>24), .lo=(pbase<<8)|pmask}
|
{msr, .hi=(pdid1<<29)|(bizarro<<28)|(pbase>>24), .lo=(pbase<<8)|pmask}
|
||||||
#define P2D_R(msr, pdid1, bizarro, pmax, pmin) {msr, .hi=(pdid1<<29)|(bizarro<<28)|(pmax>>12), .lo=(pmax<<20)|pmin}
|
#define P2D_BMO(msr, pdid1, bizarro, poffset, pbase, pmask) \
|
||||||
#define P2D_RO(msr, pdid1, bizarro, poffset, pmax, pmin) {msr, .hi=(pdid1<<29)|(bizarro<<28)|(poffset<<8)|(pmax>>12), .lo=(pmax<<20)|pmin}
|
{msr, .hi=(pdid1<<29)|(bizarro<<28)|(poffset<<8)|(pbase>>24), .lo=(pbase<<8)|pmask}
|
||||||
#define P2D_SC(msr, pdid1, bizarro, wen, ren,pscbase) {msr, .hi=(pdid1<<29)|(bizarro<<28)|(wen), .lo=(ren<<16)|(pscbase>>18)}
|
#define P2D_R(msr, pdid1, bizarro, pmax, pmin) \
|
||||||
#define IOD_BM(msr, pdid1, bizarro, ibase, imask) {msr, .hi=(pdid1<<29)|(bizarro<<28)|(ibase>>12), .lo=(ibase<<20)|imask}
|
{msr, .hi=(pdid1<<29)|(bizarro<<28)|(pmax>>12), .lo=(pmax<<20)|pmin}
|
||||||
#define IOD_SC(msr, pdid1, bizarro, en, wen, ren, ibase) {msr, .hi=(pdid1<<29)|(bizarro<<28), .lo=(en<<24)|(wen<<21)|(ren<<20)|(ibase<<3)}
|
#define P2D_RO(msr, pdid1, bizarro, poffset, pmax, pmin) \
|
||||||
|
{msr, .hi=(pdid1<<29)|(bizarro<<28)|(poffset<<8)|(pmax>>12), .lo=(pmax<<20)|pmin}
|
||||||
|
#define P2D_SC(msr, pdid1, bizarro, wen, ren,pscbase) \
|
||||||
|
{msr, .hi=(pdid1<<29)|(bizarro<<28)|(wen), .lo=(ren<<16)|(pscbase>>18)}
|
||||||
|
#define IOD_BM(msr, pdid1, bizarro, ibase, imask) \
|
||||||
|
{msr, .hi=(pdid1<<29)|(bizarro<<28)|(ibase>>12), .lo=(ibase<<20)|imask}
|
||||||
|
#define IOD_SC(msr, pdid1, bizarro, en, wen, ren, ibase) \
|
||||||
|
{msr, .hi=(pdid1<<29)|(bizarro<<28), .lo=(en<<24)|(wen<<21)|(ren<<20)|(ibase<<3)}
|
||||||
|
|
||||||
struct msr_defaults {
|
struct msr_defaults {
|
||||||
int msr_no;
|
int msr_no;
|
||||||
@@ -63,22 +68,37 @@ const struct msr_defaults msr_defaults [] = {
|
|||||||
//{0x1811, .hi = 0xefffb000, .lo = RRCF_LOW_CD(0xefff8000)},
|
//{0x1811, .hi = 0xefffb000, .lo = RRCF_LOW_CD(0xefff8000)},
|
||||||
//{0x1812, .hi = 0xefff7000, .lo = RRCF_LOW_CD(0xefff4000)},
|
//{0x1812, .hi = 0xefff7000, .lo = RRCF_LOW_CD(0xefff4000)},
|
||||||
//{0x1813, .hi = 0xefff3000, .lo = RRCF_LOW_CD(0xefff0000)},
|
//{0x1813, .hi = 0xefff3000, .lo = RRCF_LOW_CD(0xefff0000)},
|
||||||
/* now for GLPCI routing */
|
|
||||||
|
/* GeodeLink Routing */
|
||||||
/* GLIU0 */
|
/* GLIU0 */
|
||||||
P2D_BM(0x10000020, 0x1, 0x0, 0x0, 0xfff80),
|
/* Traditional Memory 0kB-512kB goes to GLIU port 1, Memory Controller */
|
||||||
|
P2D_BM(0x10000020, 0x1, 0x0, 0x00000, 0xfff80),
|
||||||
|
/* Traditional Memory 512kB-1MB goes to GLIU port 1, Memory Controller */
|
||||||
P2D_BM(0x10000021, 0x1, 0x0, 0x80000, 0xfffe0),
|
P2D_BM(0x10000021, 0x1, 0x0, 0x80000, 0xfffe0),
|
||||||
P2D_SC(0x1000002c, 0x1, 0x0, 0x0, 0xff03, 0x3),
|
/* Extended Memory, 0xC0000-0x100000, disable write,
|
||||||
|
* enable read 0xC0000 - 0xC8000, 0xE0000-0xFFFFF ,
|
||||||
|
* goest to GLIU Port 1, Memory Controller */
|
||||||
|
P2D_SC(0x1000002c, 0x1, 0x0, 0x0000, 0xff03, 0x3),
|
||||||
/* GLIU1 */
|
/* GLIU1 */
|
||||||
P2D_BM(0x40000020, 0x1, 0x0, 0x0, 0xfff80),
|
/* Traditional Memory 0kB-512kB goes to GLIU port 1, link to GLIU0 */
|
||||||
|
P2D_BM(0x40000020, 0x1, 0x0, 0x00000, 0xfff80),
|
||||||
|
/* Traditional Memory 512kB-1MB goes to GLIU port 1, link to GLIU0 */
|
||||||
P2D_BM(0x40000021, 0x1, 0x0, 0x80000, 0xfffe0),
|
P2D_BM(0x40000021, 0x1, 0x0, 0x80000, 0xfffe0),
|
||||||
P2D_SC(0x4000002d, 0x1, 0x0, 0x0, 0xff03, 0x3),
|
/* Extended Memory, 0xC0000-0x100000, disable write,
|
||||||
|
* enable read 0xC0000 - 0xC8000, 0xE0000-0xFFFFF ,
|
||||||
|
* goest to GLIU Port 1, Memory Controller */
|
||||||
|
P2D_SC(0x4000002d, 0x1, 0x0, 0x0000, 0xff03, 0x3),
|
||||||
|
/* end of table */
|
||||||
{0}
|
{0}
|
||||||
};
|
};
|
||||||
|
|
||||||
#define SMM_OFFSET 0x40400000
|
#define SMM_OFFSET 0x40400000
|
||||||
#define SMM_SIZE 256
|
#define SMM_SIZE 256
|
||||||
|
|
||||||
/* we have to do this here. We have not found a nicer way to do it */
|
/*
|
||||||
|
* FixME: MSR 0x10000028, 0x40000029 are reprogrammed by SysmemInit()
|
||||||
|
* 0x10000026 and 0x400000023 are reprogrammed by SMMGL0Init() and SMMGL1Init()
|
||||||
|
*/
|
||||||
void
|
void
|
||||||
setup_gx2(void)
|
setup_gx2(void)
|
||||||
{
|
{
|
||||||
@@ -92,7 +112,7 @@ setup_gx2(void)
|
|||||||
membytes = sizem * 1048576;
|
membytes = sizem * 1048576;
|
||||||
|
|
||||||
/* we need to set 0x10000028 and 0x40000029 */
|
/* we need to set 0x10000028 and 0x40000029 */
|
||||||
// print_debug("sizem 0x%x, membytes 0x%x\n", sizem, membytes);
|
//print_debug("sizem 0x%x, membytes 0x%x\n", sizem, membytes);
|
||||||
msr.hi = 0x20000000 | membytes>>24;
|
msr.hi = 0x20000000 | membytes>>24;
|
||||||
msr.lo = 0x100 | ( ((membytes >>12) & 0xfff) << 20);
|
msr.lo = 0x100 | ( ((membytes >>12) & 0xfff) << 20);
|
||||||
wrmsr(0x10000028, msr);
|
wrmsr(0x10000028, msr);
|
||||||
@@ -100,10 +120,9 @@ setup_gx2(void)
|
|||||||
msr.lo = 0x100 | ( ((membytes >>12) & 0xfff) << 20);
|
msr.lo = 0x100 | ( ((membytes >>12) & 0xfff) << 20);
|
||||||
wrmsr(0x40000029, msr);
|
wrmsr(0x40000029, msr);
|
||||||
msr = rdmsr(0x10000028);
|
msr = rdmsr(0x10000028);
|
||||||
// print_debug("MSR 0x%x is now 0x%x:0x%x\n", 0x10000028, msr.hi,msr.lo);
|
//print_debug("MSR 0x%x is now 0x%x:0x%x\n", 0x10000028, msr.hi,msr.lo);
|
||||||
msr = rdmsr(0x40000029);
|
msr = rdmsr(0x40000029);
|
||||||
// print_debug("MSR 0x%x is now 0x%x:0x%x\n", 0x40000029, msr.hi,msr.lo);
|
//print_debug("MSR 0x%x is now 0x%x:0x%x\n", 0x40000029, msr.hi,msr.lo);
|
||||||
|
|
||||||
|
|
||||||
/* fixme: SMM MSR 0x10000026 and 0x400000023 */
|
/* fixme: SMM MSR 0x10000026 and 0x400000023 */
|
||||||
/* calculate the OFFSET field */
|
/* calculate the OFFSET field */
|
||||||
@@ -116,7 +135,7 @@ setup_gx2(void)
|
|||||||
/* calculate the PBASE and PMASK fields */
|
/* calculate the PBASE and PMASK fields */
|
||||||
tmp2 = (SMM_OFFSET << 8) & 0xFFF00000; /* shift right 12 then left 20 == left 8 */
|
tmp2 = (SMM_OFFSET << 8) & 0xFFF00000; /* shift right 12 then left 20 == left 8 */
|
||||||
tmp2 |= (((~(SMM_SIZE * 1024) + 1) >> 12) & 0xfffff);
|
tmp2 |= (((~(SMM_SIZE * 1024) + 1) >> 12) & 0xfffff);
|
||||||
// print_debug("MSR 0x%x is now 0x%x:0x%x\n", 0x10000026, tmp, tmp2);
|
//print_debug("MSR 0x%x is now 0x%x:0x%x\n", 0x10000026, tmp, tmp2);
|
||||||
msr.hi = tmp;
|
msr.hi = tmp;
|
||||||
msr.lo = tmp2;
|
msr.lo = tmp2;
|
||||||
wrmsr(0x10000026, msr);
|
wrmsr(0x10000026, msr);
|
||||||
@@ -125,22 +144,22 @@ setup_gx2(void)
|
|||||||
msr.lo = 0xfbf00100;
|
msr.lo = 0xfbf00100;
|
||||||
wrmsr(0x10000028, msr);
|
wrmsr(0x10000028, msr);
|
||||||
msr = rdmsr(0x10000028);
|
msr = rdmsr(0x10000028);
|
||||||
// print_debug("MSR 0x%x is now 0x%x:0x%x\n", 0x10000028, msr.hi, msr.lo);
|
//print_debug("MSR 0x%x is now 0x%x:0x%x\n", 0x10000028, msr.hi, msr.lo);
|
||||||
wrmsr(0x40000029, msr);
|
wrmsr(0x40000029, msr);
|
||||||
msr = rdmsr(0x40000029);
|
msr = rdmsr(0x40000029);
|
||||||
// print_debug("MSR 0x%x is now 0x%x:0x%x\n", 0x40000029, msr.hi, msr.lo);
|
//print_debug("MSR 0x%x is now 0x%x:0x%x\n", 0x40000029, msr.hi, msr.lo);
|
||||||
|
|
||||||
msr.hi = 0x2cfbc040;
|
msr.hi = 0x2cfbc040;
|
||||||
msr.lo = 0x400fffc0;
|
msr.lo = 0x400fffc0;
|
||||||
wrmsr(0x10000026, msr);
|
wrmsr(0x10000026, msr);
|
||||||
msr = rdmsr(0x10000026);
|
msr = rdmsr(0x10000026);
|
||||||
// print_debug("MSR 0x%x is now 0x%x:0x%x\n", 0x10000026, msr.hi, msr.lo);
|
//print_debug("MSR 0x%x is now 0x%x:0x%x\n", 0x10000026, msr.hi, msr.lo);
|
||||||
|
|
||||||
msr.hi = 0x22fffc02;
|
msr.hi = 0x22fffc02;
|
||||||
msr.lo = 0x10ffbf00;
|
msr.lo = 0x10ffbf00;
|
||||||
wrmsr(0x1808, msr);
|
wrmsr(0x1808, msr);
|
||||||
msr = rdmsr(0x1808);
|
msr = rdmsr(0x1808);
|
||||||
// print_debug("MSR 0x%x is now 0x%x:0x%x\n", 0x1808, msr.hi, msr.lo);
|
//print_debug("MSR 0x%x is now 0x%x:0x%x\n", 0x1808, msr.hi, msr.lo);
|
||||||
#endif
|
#endif
|
||||||
/* now do the default MSR values */
|
/* now do the default MSR values */
|
||||||
|
|
||||||
|
@@ -165,7 +165,7 @@ static int cs5536_setup_onchipuart(void)
|
|||||||
* MSR 0x51400014 bit 18:16
|
* MSR 0x51400014 bit 18:16
|
||||||
* 3. Enable UART controller
|
* 3. Enable UART controller
|
||||||
* MSR 0x5140003A bit 0, 1
|
* MSR 0x5140003A bit 0, 1
|
||||||
* 4. IRQ routing on IRQ Mapper
|
* 4. IRQ routing on IRQ Mapper (before loading OS)
|
||||||
* MSR 0x51400021 bit [27:24]
|
* MSR 0x51400021 bit [27:24]
|
||||||
*/
|
*/
|
||||||
msr_t msr;
|
msr_t msr;
|
||||||
|
Reference in New Issue
Block a user