mirror of
https://github.com/fail0verflow/switch-coreboot.git
synced 2025-05-04 01:39:18 -04:00
Fix the indent and whitespace to match LinuxBIOS standards
Signed-off-by: Jordan Crouse <jordan.crouse@amd.com> Acked-by: Stefan Reinauer <stepan@coresystems.de> git-svn-id: svn://svn.coreboot.org/coreboot/trunk@2650 2b7e53f0-3cfb-0310-b3e9-8179ed1497e1
This commit is contained in:
Jordan Crouse
Stefan Reinauer
parent
f8030bd924
commit
9934b813da
5 changed files with 388 additions and 449 deletions
|
|
@ -30,7 +30,6 @@
|
|||
#include <cpu/x86/msr.h>
|
||||
#include <cpu/amd/lxdef.h>
|
||||
|
||||
|
||||
/**************************************************************************
|
||||
*
|
||||
* pcideadlock
|
||||
|
|
@ -40,7 +39,8 @@
|
|||
* There is also fix code in cache and PCI functions. This bug is very is pervasive.
|
||||
*
|
||||
**************************************************************************/
|
||||
static void pcideadlock(void){
|
||||
static void pcideadlock(void)
|
||||
{
|
||||
msr_t msr;
|
||||
|
||||
/*
|
||||
|
|
@ -52,15 +52,14 @@ static void pcideadlock(void){
|
|||
msr.lo |= DM_CONFIG0_LOWER_MISSER_SET;
|
||||
wrmsr(CPU_DM_CONFIG0, msr);
|
||||
|
||||
|
||||
/* write serialize memory hole to PCI. Need to unWS when something is
|
||||
* shadowed regardless of cachablility.
|
||||
*/
|
||||
msr.lo = 0x021212121;
|
||||
msr.hi = 0x021212121;
|
||||
wrmsr( CPU_RCONF_A0_BF, msr);
|
||||
wrmsr( CPU_RCONF_C0_DF, msr);
|
||||
wrmsr( CPU_RCONF_E0_FF, msr);
|
||||
wrmsr(CPU_RCONF_A0_BF, msr);
|
||||
wrmsr(CPU_RCONF_C0_DF, msr);
|
||||
wrmsr(CPU_RCONF_E0_FF, msr);
|
||||
}
|
||||
|
||||
/****************************************************************************/
|
||||
|
|
@ -74,7 +73,8 @@ static void pcideadlock(void){
|
|||
/** to maintain coherency with and the cache is not enabled yet.*/
|
||||
/***/
|
||||
/****************************************************************************/
|
||||
static void disablememoryreadorder(void){
|
||||
static void disablememoryreadorder(void)
|
||||
{
|
||||
msr_t msr;
|
||||
|
||||
msr = rdmsr(MC_CF8F_DATA);
|
||||
|
|
@ -83,7 +83,8 @@ static void disablememoryreadorder(void){
|
|||
}
|
||||
|
||||
/* For cpu version C3. Should be the only released version */
|
||||
void cpubug(void) {
|
||||
void cpubug(void)
|
||||
{
|
||||
pcideadlock();
|
||||
disablememoryreadorder();
|
||||
printk_debug("Done cpubug fixes \n");
|
||||
|
|
|
|||
|
|
@ -25,7 +25,8 @@
|
|||
;* SetDelayControl
|
||||
;*
|
||||
;*************************************************************************/
|
||||
void SetDelayControl(void){
|
||||
void SetDelayControl(void)
|
||||
{
|
||||
unsigned int msrnum, glspeed;
|
||||
unsigned char spdbyte0, spdbyte1;
|
||||
msr_t msr;
|
||||
|
|
@ -46,7 +47,7 @@ void SetDelayControl(void){
|
|||
msrnum = CPU_BC_MSS_ARRAY_CTL2;
|
||||
msr.hi = 0x00000106;
|
||||
msr.lo = 0x83104104;
|
||||
wrmsr(msrnum,msr);
|
||||
wrmsr(msrnum, msr);
|
||||
|
||||
msrnum = GLCP_FIFOCTL;
|
||||
msr = rdmsr(msrnum);
|
||||
|
|
@ -59,38 +60,34 @@ void SetDelayControl(void){
|
|||
msr.lo = 0x00000001;
|
||||
wrmsr(msrnum, msr);
|
||||
|
||||
|
||||
/* Debug Delay Control Setup Check
|
||||
Leave it alone if it has been setup. FS2 or something is here.*/
|
||||
Leave it alone if it has been setup. FS2 or something is here. */
|
||||
msrnum = GLCP_DELAY_CONTROLS;
|
||||
msr = rdmsr(msrnum);
|
||||
if (msr.lo & ~(0x7C0)){
|
||||
if (msr.lo & ~(0x7C0)) {
|
||||
return;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
; Delay Controls based on DIMM loading. UGH!
|
||||
; # of Devices = Module Width (SPD6) / Device Width(SPD13) * Physical Banks(SPD5)
|
||||
; Note - We only support module width of 64.
|
||||
* Delay Controls based on DIMM loading. UGH!
|
||||
* # of Devices = Module Width (SPD6) / Device Width(SPD13) * Physical Banks(SPD5)
|
||||
* Note - We only support module width of 64.
|
||||
*/
|
||||
spdbyte0 = spd_read_byte(DIMM0, SPD_PRIMARY_SDRAM_WIDTH);
|
||||
if (spdbyte0 !=0xFF){
|
||||
spdbyte0 = (unsigned char) 64/spdbyte0 * (unsigned char) (spd_read_byte(DIMM0, SPD_NUM_DIMM_BANKS));
|
||||
}
|
||||
else{
|
||||
spdbyte0=0;
|
||||
if (spdbyte0 != 0xFF) {
|
||||
spdbyte0 = (unsigned char)64 / spdbyte0 *
|
||||
(unsigned char)(spd_read_byte(DIMM0, SPD_NUM_DIMM_BANKS));
|
||||
} else {
|
||||
spdbyte0 = 0;
|
||||
}
|
||||
|
||||
spdbyte1 = spd_read_byte(DIMM1, SPD_PRIMARY_SDRAM_WIDTH);
|
||||
if (spdbyte1 !=0xFF){
|
||||
spdbyte1 = (unsigned char) 64/spdbyte1 * (unsigned char) (spd_read_byte(DIMM1, SPD_NUM_DIMM_BANKS));
|
||||
if (spdbyte1 != 0xFF) {
|
||||
spdbyte1 = (unsigned char)64 / spdbyte1 *
|
||||
(unsigned char)(spd_read_byte(DIMM1, SPD_NUM_DIMM_BANKS));
|
||||
} else {
|
||||
spdbyte1 = 0;
|
||||
}
|
||||
else{
|
||||
spdbyte1=0;
|
||||
}
|
||||
|
||||
|
||||
|
||||
/* The current thinking. Subject to change...
|
||||
|
||||
|
|
@ -141,103 +138,90 @@ void SetDelayControl(void){
|
|||
*/
|
||||
msr.hi = msr.lo = 0;
|
||||
|
||||
if (spdbyte0 == 0 || spdbyte1 == 0){
|
||||
if (spdbyte0 == 0 || spdbyte1 == 0) {
|
||||
/* one dimm solution */
|
||||
if (spdbyte1 == 0){
|
||||
if (spdbyte1 == 0) {
|
||||
msr.hi |= 0x000800000;
|
||||
}
|
||||
spdbyte0 += spdbyte1;
|
||||
if (spdbyte0 > 8){
|
||||
if (spdbyte0 > 8) {
|
||||
/* large dimm */
|
||||
if (glspeed < 334){
|
||||
if (glspeed < 334) {
|
||||
msr.hi |= 0x0837100AA;
|
||||
msr.lo |= 0x056960004;
|
||||
}
|
||||
else{
|
||||
} else {
|
||||
msr.hi |= 0x082710055;
|
||||
msr.lo |= 0x056960004;
|
||||
}
|
||||
}
|
||||
else if (spdbyte0 > 4){
|
||||
} else if (spdbyte0 > 4) {
|
||||
/* medium dimm */
|
||||
if (glspeed < 334){
|
||||
if (glspeed < 334) {
|
||||
msr.hi |= 0x0837100AA;
|
||||
msr.lo |= 0x056960004;
|
||||
}
|
||||
else{
|
||||
} else {
|
||||
msr.hi |= 0x0827100AA;
|
||||
msr.lo |= 0x056960004;
|
||||
}
|
||||
}
|
||||
else{
|
||||
} else {
|
||||
/* small dimm */
|
||||
if (glspeed < 334){
|
||||
if (glspeed < 334) {
|
||||
msr.hi |= 0x0837100FF;
|
||||
msr.lo |= 0x056960004;
|
||||
}
|
||||
else{
|
||||
} else {
|
||||
msr.hi |= 0x0827100FF;
|
||||
msr.lo |= 0x056960004;
|
||||
}
|
||||
}
|
||||
}
|
||||
else{
|
||||
} else {
|
||||
/* two dimm solution */
|
||||
spdbyte0 += spdbyte1;
|
||||
if (spdbyte0 > 24){
|
||||
if (spdbyte0 > 24) {
|
||||
/* huge dimms */
|
||||
if (glspeed < 334){
|
||||
if (glspeed < 334) {
|
||||
msr.hi |= 0x0B37100A5;
|
||||
msr.lo |= 0x056960004;
|
||||
}
|
||||
else{
|
||||
} else {
|
||||
msr.hi |= 0x0B2710000;
|
||||
msr.lo |= 0x056960004;
|
||||
}
|
||||
}
|
||||
else if (spdbyte0 > 16){
|
||||
} else if (spdbyte0 > 16) {
|
||||
/* large dimms */
|
||||
if (glspeed < 334){
|
||||
if (glspeed < 334) {
|
||||
msr.hi |= 0x0B37100A5;
|
||||
msr.lo |= 0x056960004;
|
||||
}
|
||||
else{
|
||||
} else {
|
||||
msr.hi |= 0x0B27100A5;
|
||||
msr.lo |= 0x056960004;
|
||||
}
|
||||
}
|
||||
else if (spdbyte0 >= 8){
|
||||
} else if (spdbyte0 >= 8) {
|
||||
/* medium dimms */
|
||||
if (glspeed < 334){
|
||||
if (glspeed < 334) {
|
||||
msr.hi |= 0x0937100A5;
|
||||
msr.lo |= 0x056960004;
|
||||
}
|
||||
else{
|
||||
} else {
|
||||
msr.hi |= 0x0C27100A5;
|
||||
msr.lo |= 0x056960004;
|
||||
}
|
||||
}
|
||||
else{
|
||||
} else {
|
||||
/* small dimms */
|
||||
if (glspeed < 334){
|
||||
if (glspeed < 334) {
|
||||
msr.hi |= 0x0837100A5;
|
||||
msr.lo |= 0x056960004;
|
||||
}
|
||||
else{
|
||||
} else {
|
||||
msr.hi |= 0x082710000;
|
||||
msr.lo |= 0x056960004;
|
||||
}
|
||||
}
|
||||
}
|
||||
wrmsr(GLCP_DELAY_CONTROLS,msr);
|
||||
wrmsr(GLCP_DELAY_CONTROLS, msr);
|
||||
return;
|
||||
}
|
||||
|
||||
/* ***************************************************************************/
|
||||
/* * cpuRegInit*/
|
||||
/* ***************************************************************************/
|
||||
void
|
||||
cpuRegInit (void){
|
||||
void cpuRegInit(void)
|
||||
{
|
||||
int msrnum;
|
||||
msr_t msr;
|
||||
|
||||
|
|
@ -273,22 +257,20 @@ cpuRegInit (void){
|
|||
/* Set the Delay Control in GLCP */
|
||||
SetDelayControl();
|
||||
|
||||
/* Enable RSDC*/
|
||||
/* Enable RSDC */
|
||||
msrnum = CPU_AC_SMM_CTL;
|
||||
msr = rdmsr(msrnum);
|
||||
msr.lo |= SMM_INST_EN_SET;
|
||||
wrmsr(msrnum, msr);
|
||||
|
||||
|
||||
/* FPU imprecise exceptions bit */
|
||||
msrnum = CPU_FPU_MSR_MODE;
|
||||
msr = rdmsr(msrnum);
|
||||
msr.lo |= FPU_IE_SET;
|
||||
wrmsr(msrnum, msr);
|
||||
|
||||
|
||||
/* Power Savers (Do after BIST) */
|
||||
/* Enable Suspend on HLT & PAUSE instructions*/
|
||||
/* Enable Suspend on HLT & PAUSE instructions */
|
||||
msrnum = CPU_XC_CONFIG;
|
||||
msr = rdmsr(msrnum);
|
||||
msr.lo |= XC_CONFIG_SUSP_ON_HLT | XC_CONFIG_SUSP_ON_PAUSE;
|
||||
|
|
@ -302,17 +284,18 @@ cpuRegInit (void){
|
|||
msr.lo |= 0x002000000; /* PBZ213: Set PAUSEDLY = 2 */
|
||||
wrmsr(msrnum, msr);
|
||||
|
||||
/* Disable the debug clock to save power.*/
|
||||
/* Disable the debug clock to save power. */
|
||||
/* NOTE: leave it enabled for fs2 debug */
|
||||
/* msrnum = GLCP_DBGCLKCTL;
|
||||
#if 0
|
||||
msrnum = GLCP_DBGCLKCTL;
|
||||
msr.hi = 0;
|
||||
msr.lo = 0;
|
||||
wrmsr(msrnum, msr);
|
||||
*/
|
||||
#endif
|
||||
|
||||
/* Setup throttling delays to proper mode if it is ever enabled. */
|
||||
msrnum = GLCP_TH_OD;
|
||||
msr.hi = 0;
|
||||
msr.lo = 0x00000603C;
|
||||
wrmsr(msrnum, msr);
|
||||
}
|
||||
}
|
||||
|
|
|
|||
|
|
@ -33,12 +33,9 @@
|
|||
|
||||
static void vsm_end_post_smi(void)
|
||||
{
|
||||
__asm__ volatile (
|
||||
"push %ax\n"
|
||||
__asm__ volatile ("push %ax\n"
|
||||
"mov $0x5000, %ax\n"
|
||||
".byte 0x0f, 0x38\n"
|
||||
"pop %ax\n"
|
||||
);
|
||||
".byte 0x0f, 0x38\n" "pop %ax\n");
|
||||
}
|
||||
|
||||
static void model_lx_init(device_t dev)
|
||||
|
|
@ -55,9 +52,9 @@ static void model_lx_init(device_t dev)
|
|||
vsm_end_post_smi();
|
||||
|
||||
// Set gate A20 (legacy vsm disables it in late init)
|
||||
printk_debug("A20 (0x92): %d\n",inb(0x92));
|
||||
outb(0x02,0x92);
|
||||
printk_debug("A20 (0x92): %d\n",inb(0x92));
|
||||
printk_debug("A20 (0x92): %d\n", inb(0x92));
|
||||
outb(0x02, 0x92);
|
||||
printk_debug("A20 (0x92): %d\n", inb(0x92));
|
||||
|
||||
printk_debug("CPU model_lx_init DONE\n");
|
||||
};
|
||||
|
|
@ -67,8 +64,8 @@ static struct device_operations cpu_dev_ops = {
|
|||
};
|
||||
|
||||
static struct cpu_device_id cpu_table[] = {
|
||||
{ X86_VENDOR_AMD, 0x05A2 },
|
||||
{ 0, 0 },
|
||||
{X86_VENDOR_AMD, 0x05A2},
|
||||
{0, 0},
|
||||
};
|
||||
|
||||
static struct cpu_driver driver __cpu_driver = {
|
||||
|
|
|
|||
|
|
@ -29,14 +29,14 @@
|
|||
/* * Destroys: Al,*/
|
||||
/* **/
|
||||
/* ***************************************************************************/
|
||||
void
|
||||
StartTimer1(void){
|
||||
void StartTimer1(void)
|
||||
{
|
||||
outb(0x56, 0x43);
|
||||
outb(0x12, 0x41);
|
||||
}
|
||||
|
||||
void
|
||||
SystemPreInit(void){
|
||||
void SystemPreInit(void)
|
||||
{
|
||||
|
||||
/* they want a jump ... */
|
||||
#ifndef USE_DCACHE_RAM
|
||||
|
|
|
|||
|
|
@ -69,9 +69,9 @@
|
|||
* software, even if advised of the possibility of such damage.
|
||||
*
|
||||
* $Id: vsmsetup.c,v 1.8 2006/09/08 12:47:57 andrei Exp $
|
||||
*
|
||||
* Copyright (C) 2007 Advanced Micro Devices
|
||||
*
|
||||
*
|
||||
* Copyright (C) 2007 Advanced Micro Devices
|
||||
*
|
||||
*--------------------------------------------------------------------*/
|
||||
|
||||
/* Modified to be a self sufficient plug in so that it can be used
|
||||
|
|
@ -84,53 +84,44 @@
|
|||
|
||||
/* Declare a temporary global descriptor table - necessary because the
|
||||
Core part of the bios no longer sets up any 16 bit segments */
|
||||
__asm__ (
|
||||
__asm__(
|
||||
/* pointer to original gdt */
|
||||
"gdtarg: \n"
|
||||
" .word gdt_limit \n"
|
||||
" .long gdt \n"
|
||||
|
||||
/* compute the table limit */
|
||||
"__mygdt_limit = __mygdt_end - __mygdt - 1 \n"
|
||||
|
||||
"__mygdtaddr: \n"
|
||||
" .word __mygdt_limit \n"
|
||||
" .long __mygdt \n"
|
||||
|
||||
"__mygdt: \n"
|
||||
/* selgdt 0, unused */
|
||||
" .word 0x0000, 0x0000 \n"
|
||||
" .byte 0x00, 0x00, 0x00, 0x00 \n"
|
||||
|
||||
/* selgdt 8, unused */
|
||||
" .word 0x0000, 0x0000 \n"
|
||||
" .byte 0x00, 0x00, 0x00, 0x00 \n"
|
||||
|
||||
/* selgdt 0x10, flat code segment */
|
||||
" .word 0xffff, 0x0000 \n"
|
||||
" .byte 0x00, 0x9b, 0xcf, 0x00 \n"
|
||||
|
||||
/* selgdt 0x18, flat data segment */
|
||||
" .word 0xffff, 0x0000 \n"
|
||||
" .byte 0x00, 0x93, 0xcf, 0x00 \n"
|
||||
|
||||
/* selgdt 0x20, unused */
|
||||
" .word 0x0000, 0x0000 \n"
|
||||
" .byte 0x00, 0x00, 0x00, 0x00 \n"
|
||||
|
||||
/* selgdt 0x28 16-bit 64k code at 0x00000000 */
|
||||
" .word 0xffff, 0x0000 \n"
|
||||
" .byte 0, 0x9a, 0, 0 \n"
|
||||
|
||||
/* selgdt 0x30 16-bit 64k data at 0x00000000 */
|
||||
" .word 0xffff, 0x0000 \n"
|
||||
" .byte 0, 0x92, 0, 0 \n"
|
||||
|
||||
"__mygdt_end: \n"
|
||||
);
|
||||
|
||||
/* Declare a pointer to where our idt is going to be i.e. at mem zero */
|
||||
__asm__ ("__myidt: \n"
|
||||
__asm__(
|
||||
"__myidt: \n"
|
||||
/* 16-bit limit */
|
||||
" .word 1023 \n"
|
||||
/* 24-bit base */
|
||||
|
|
@ -144,36 +135,32 @@ static void real_mode_switch_call_vsm(unsigned long smm, unsigned long sysm)
|
|||
uint16_t entryHi = (VSA2_ENTRY_POINT & 0xffff0000) >> 4;
|
||||
uint16_t entryLo = (VSA2_ENTRY_POINT & 0xffff);
|
||||
|
||||
__asm__ __volatile__ (
|
||||
__asm__ __volatile__(
|
||||
// paranoia -- does ecx get saved? not sure. This is
|
||||
// the easiest safe thing to do.
|
||||
" pushal \n"
|
||||
/* save the stack */
|
||||
" mov %%esp, __stack \n"
|
||||
" jmp 1f \n"
|
||||
"__stack: .long 0 \n"
|
||||
"1:\n"
|
||||
"__stack: .long 0 \n" "1:\n"
|
||||
/* get devfn into %%ecx */
|
||||
" movl %%esp, %%ebp \n"
|
||||
#if 0
|
||||
/* I'm not happy about that pushal followed by esp-relative references.
|
||||
* just do hard-codes for now
|
||||
/* I'm not happy about that pushal followed by esp-relative
|
||||
* references. Just do hard-codes for now
|
||||
*/
|
||||
" movl 8(%%ebp), %%ecx \n"
|
||||
" movl 12(%%ebp), %%edx \n"
|
||||
#endif
|
||||
" movl %0, %%ecx \n"
|
||||
" movl %1, %%edx \n"
|
||||
|
||||
/* load 'our' gdt */
|
||||
" lgdt %%cs:__mygdtaddr \n"
|
||||
|
||||
/* This configures CS properly for real mode. */
|
||||
" ljmp $0x28, $__rms_16bit\n"
|
||||
"__rms_16bit: \n"
|
||||
" .code16 \n"
|
||||
/* 16 bit code from here on... */
|
||||
|
||||
/* Load the segment registers w/ properly configured segment
|
||||
* descriptors. They will retain these configurations (limits,
|
||||
* writability, etc.) once protected mode is turned off. */
|
||||
|
|
@ -183,30 +170,28 @@ static void real_mode_switch_call_vsm(unsigned long smm, unsigned long sysm)
|
|||
" mov %%ax, %%fs \n"
|
||||
" mov %%ax, %%gs \n"
|
||||
" mov %%ax, %%ss \n"
|
||||
|
||||
/* Turn off protection (bit 0 in CR0) */
|
||||
" movl %%cr0, %%eax \n"
|
||||
" andl $0xFFFFFFFE, %%eax \n"
|
||||
" movl %%eax, %%cr0 \n"
|
||||
|
||||
/* Now really going into real mode */
|
||||
" ljmp $0, $__rms_real\n"
|
||||
"__rms_real: \n"
|
||||
|
||||
/* put the stack at the end of page zero.
|
||||
* that way we can easily share it between real and protected,
|
||||
* since the 16-bit ESP at segment 0 will work for any case. */
|
||||
* since the 16-bit ESP at segment 0 will work for any case.
|
||||
*/
|
||||
|
||||
/* Setup a stack */
|
||||
" mov $0x0, %%ax \n"
|
||||
" mov %%ax, %%ss \n"
|
||||
" movl $0x1000, %%eax \n"
|
||||
" movl %%eax, %%esp \n"
|
||||
|
||||
/* Load our 16 it idt */
|
||||
" xor %%ax, %%ax \n"
|
||||
" mov %%ax, %%ds \n"
|
||||
" lidt __myidt \n"
|
||||
|
||||
/* Dump zeros in the other segregs */
|
||||
" mov %%ax, %%es \n"
|
||||
/* FixMe: Big real mode for gs, fs? */
|
||||
|
|
@ -217,16 +202,13 @@ static void real_mode_switch_call_vsm(unsigned long smm, unsigned long sysm)
|
|||
//" mov %%cx, %%ax \n"
|
||||
" movl %0, %%ecx \n"
|
||||
" movl %1, %%edx \n"
|
||||
|
||||
/* call the VSA2 entry point address */
|
||||
" lcall %2, %3\n"
|
||||
|
||||
/* if we got here, just about done.
|
||||
* Need to get back to protected mode */
|
||||
" movl %%cr0, %%eax \n"
|
||||
" orl $0x0000001, %%eax\n" /* PE = 1 */
|
||||
" movl %%eax, %%cr0 \n"
|
||||
|
||||
/* Now that we are in protected mode jump to a 32 bit code segment. */
|
||||
" data32 ljmp $0x10, $vsmrestart\n"
|
||||
"vsmrestart:\n"
|
||||
|
|
@ -237,19 +219,18 @@ static void real_mode_switch_call_vsm(unsigned long smm, unsigned long sysm)
|
|||
" mov %%ax, %%fs \n"
|
||||
" mov %%ax, %%gs \n"
|
||||
" mov %%ax, %%ss \n"
|
||||
|
||||
/* restore proper gdt and idt */
|
||||
" lgdt %%cs:gdtarg \n"
|
||||
" lidt idtarg \n"
|
||||
|
||||
".globl vsm_exit \n"
|
||||
"vsm_exit: \n"
|
||||
" mov __stack, %%esp \n"
|
||||
" popal \n"
|
||||
:: "g" (smm), "g" (sysm), "g" (entryHi), "g" (entryLo));
|
||||
" popal \n"::
|
||||
"g" (smm), "g"(sysm), "g"(entryHi), "g"(entryLo)
|
||||
);
|
||||
}
|
||||
|
||||
__asm__ (".text\n""real_mode_switch_end:\n");
|
||||
__asm__(".text\n" "real_mode_switch_end:\n");
|
||||
extern char real_mode_switch_end[];
|
||||
|
||||
// andrei: some VSA virtual register helpers: raw read and MSR read
|
||||
|
|
@ -257,16 +238,14 @@ extern char real_mode_switch_end[];
|
|||
uint32_t VSA_vrRead(uint16_t classIndex)
|
||||
{
|
||||
unsigned eax, ebx, ecx, edx;
|
||||
asm volatile(
|
||||
|
||||
asm volatile (
|
||||
"movw $0x0AC1C, %%dx \n"
|
||||
"orl $0x0FC530000, %%eax \n"
|
||||
"outl %%eax, %%dx \n"
|
||||
"addb $2, %%dl \n"
|
||||
"inw %%dx, %%ax \n"
|
||||
|
||||
: "=a" (eax), "=b" (ebx), "=c" (ecx), "=d" (edx)
|
||||
: "a" (classIndex)
|
||||
: "=a" (eax), "=b"(ebx), "=c"(ecx), "=d"(edx)
|
||||
: "a"(classIndex)
|
||||
);
|
||||
|
||||
return eax;
|
||||
|
|
@ -275,16 +254,14 @@ uint32_t VSA_vrRead(uint16_t classIndex)
|
|||
uint32_t VSA_msrRead(uint32_t msrAddr)
|
||||
{
|
||||
unsigned eax, ebx, ecx, edx;
|
||||
asm volatile(
|
||||
|
||||
asm volatile (
|
||||
"movw $0x0AC1C, %%dx \n"
|
||||
"movl $0x0FC530007, %%eax \n"
|
||||
"outl %%eax, %%dx \n"
|
||||
"addb $2, %%dl \n"
|
||||
"inw %%dx, %%ax \n"
|
||||
|
||||
: "=a" (eax), "=b" (ebx), "=c" (ecx), "=d" (edx)
|
||||
: "c" (msrAddr)
|
||||
: "=a" (eax), "=b"(ebx), "=c"(ecx), "=d"(edx)
|
||||
: "c"(msrAddr)
|
||||
);
|
||||
|
||||
return eax;
|
||||
|
|
@ -296,14 +273,14 @@ void do_vsmbios(void)
|
|||
unsigned long busdevfn;
|
||||
unsigned int rom = 0;
|
||||
unsigned char *buf;
|
||||
unsigned int size = SMM_SIZE*1024;
|
||||
unsigned int size = SMM_SIZE * 1024;
|
||||
int i;
|
||||
unsigned long ilen, olen;
|
||||
|
||||
printk_err("do_vsmbios\n");
|
||||
/* clear vsm bios data area */
|
||||
for (i = 0x400; i < 0x500; i++) {
|
||||
*(volatile unsigned char *) i = 0;
|
||||
*(volatile unsigned char *)i = 0;
|
||||
}
|
||||
|
||||
/* declare rom address here - keep any config data out of the way
|
||||
|
|
@ -312,22 +289,17 @@ void do_vsmbios(void)
|
|||
/* this is the base of rom on the LX at present. At some point, this has to be
|
||||
* much better parameterized
|
||||
*/
|
||||
//rom = 0xfff80000;
|
||||
//rom = 0xfffc0000;
|
||||
/* the VSA starts at the base of rom - 64 */
|
||||
//rom = ((unsigned long) 0) - (ROM_SIZE + 64*1024);
|
||||
|
||||
//rom = 0xfffc8000;
|
||||
|
||||
//VSA is cat onto the end after LB builds
|
||||
rom = ((unsigned long) 0) - (ROM_SIZE + 36 * 1024);
|
||||
buf = (unsigned char *) VSA2_BUFFER;
|
||||
olen = unrv2b((uint8_t *)rom, buf, &ilen);
|
||||
rom = ((unsigned long)0) - (ROM_SIZE + 36 * 1024);
|
||||
buf = (unsigned char *)VSA2_BUFFER;
|
||||
olen = unrv2b((uint8_t *) rom, buf, &ilen);
|
||||
printk_debug("buf ilen %d olen%d\n", ilen, olen);
|
||||
printk_debug("buf %p *buf %d buf[256k] %d\n",
|
||||
buf, buf[0], buf[SMM_SIZE*1024]);
|
||||
buf, buf[0], buf[SMM_SIZE * 1024]);
|
||||
printk_debug("buf[0x20] signature is %x:%x:%x:%x\n",
|
||||
buf[0x20] ,buf[0x21] ,buf[0x22],buf[0x23]);
|
||||
buf[0x20], buf[0x21], buf[0x22], buf[0x23]);
|
||||
/* check for post code at start of vsainit.bin. If you don't see it,
|
||||
don't bother. */
|
||||
if ((buf[0x20] != 0xb0) || (buf[0x21] != 0x10) ||
|
||||
|
|
@ -336,11 +308,6 @@ void do_vsmbios(void)
|
|||
return;
|
||||
}
|
||||
|
||||
//memcpy((void *) VSA2_BUFFER, buf, size);
|
||||
|
||||
//for (i = 0; i < 0x800000; i++)
|
||||
// outb(0xaa, 0x80);
|
||||
|
||||
/* ecx gets smm, edx gets sysm */
|
||||
printk_err("Call real_mode_switch_call_vsm\n");
|
||||
real_mode_switch_call_vsm(MSR_GLIU0_SMM, MSR_GLIU0_SYSMEM);
|
||||
|
|
@ -350,12 +317,13 @@ void do_vsmbios(void)
|
|||
outb(0x12, 0x41);
|
||||
|
||||
// check that VSA is running OK
|
||||
if(VSA_vrRead(SIGNATURE) == VSA2_SIGNATURE)
|
||||
if (VSA_vrRead(SIGNATURE) == VSA2_SIGNATURE)
|
||||
printk_debug("do_vsmbios: VSA2 VR signature verified\n");
|
||||
else printk_err("do_vsmbios: VSA2 VR signature not valid, install failed!\n");
|
||||
else
|
||||
printk_err
|
||||
("do_vsmbios: VSA2 VR signature not valid, install failed!\n");
|
||||
}
|
||||
|
||||
|
||||
// we had hoped to avoid this.
|
||||
// this is a stub IDT only. It's main purpose is to ignore calls
|
||||
// to the BIOS.
|
||||
|
|
@ -381,7 +349,7 @@ struct realidt {
|
|||
// so the handler is relocatable.
|
||||
void handler(void)
|
||||
{
|
||||
__asm__ __volatile__ (
|
||||
__asm__ __volatile__(
|
||||
" .code16 \n"
|
||||
"idthandle: \n"
|
||||
" pushal \n"
|
||||
|
|
@ -394,7 +362,7 @@ void handler(void)
|
|||
|
||||
void debughandler(void)
|
||||
{
|
||||
__asm__ __volatile__ (
|
||||
__asm__ __volatile__(
|
||||
" .code16 \n"
|
||||
"debughandle: \n"
|
||||
" pushw %cx \n"
|
||||
|
|
@ -416,13 +384,12 @@ void debughandler(void)
|
|||
// returns back to the INTx caller (i.e. vgabios)
|
||||
void callbiosint(void)
|
||||
{
|
||||
__asm__ __volatile__ (
|
||||
__asm__ __volatile__(
|
||||
" .code16 \n"
|
||||
"callbiosint16: \n"
|
||||
" push %ds \n"
|
||||
" push %es \n"
|
||||
" push %fs \n"
|
||||
" push %gs \n"
|
||||
" push %fs \n" " push %gs \n"
|
||||
// clean up the int #. To save space we put it in the lower
|
||||
// byte. But the top 24 bits are junk.
|
||||
" andl $0xff, %eax\n"
|
||||
|
|
@ -439,12 +406,12 @@ void callbiosint(void)
|
|||
" data32 ljmp $0x10, $biosprotect\n"
|
||||
"biosprotect: \n"
|
||||
" .code32 \n"
|
||||
" movw $0x18, %ax \n"
|
||||
" mov %ax, %ds \n"
|
||||
" mov %ax, %es \n"
|
||||
" mov %ax, %fs \n"
|
||||
" mov %ax, %gs \n"
|
||||
" mov %ax, %ss \n"
|
||||
" movw $0x18, %ax\n"
|
||||
" mov %ax, %ds\n"
|
||||
" mov %ax, %es\n"
|
||||
" mov %ax, %fs\n"
|
||||
" mov %ax, %gs\n"
|
||||
" mov %ax, %ss\n"
|
||||
" lidt idtarg \n"
|
||||
" call biosint \n"
|
||||
// back to real mode ...
|
||||
|
|
@ -455,22 +422,19 @@ void callbiosint(void)
|
|||
/* Load the segment registers w/ properly configured segment
|
||||
* descriptors. They will retain these configurations (limits,
|
||||
* writability, etc.) once protected mode is turned off. */
|
||||
" mov $0x30, %ax \n"
|
||||
" mov %ax, %ds \n"
|
||||
" mov %ax, %es \n"
|
||||
" mov %ax, %fs \n"
|
||||
" mov %ax, %gs \n"
|
||||
" mov %ax, %ss \n"
|
||||
|
||||
" mov $0x30, %ax\n"
|
||||
" mov %ax, %ds\n"
|
||||
" mov %ax, %es\n"
|
||||
" mov %ax, %fs\n"
|
||||
" mov %ax, %gs\n"
|
||||
" mov %ax, %ss\n"
|
||||
/* Turn off protection (bit 0 in CR0) */
|
||||
" movl %cr0, %eax \n"
|
||||
" andl $0xFFFFFFFE, %eax \n"
|
||||
" movl %eax, %cr0 \n"
|
||||
|
||||
/* Now really going into real mode */
|
||||
" ljmp $0, $__rms_real2 \n"
|
||||
"__rms_real2: \n"
|
||||
|
||||
/* Setup a stack
|
||||
* FixME: where is esp? */
|
||||
/* no need for a fix here. The esp is shared from 32-bit and 16-bit mode.
|
||||
|
|
@ -479,23 +443,19 @@ void callbiosint(void)
|
|||
*/
|
||||
" mov $0x0, %ax \n"
|
||||
" mov %ax, %ss \n"
|
||||
|
||||
/* debugging for RGM */
|
||||
" mov $0x11, %al \n"
|
||||
" outb %al, $0x80 \n"
|
||||
|
||||
/* Load our 16 bit idt */
|
||||
" xor %ax, %ax \n"
|
||||
" mov %ax, %ds \n"
|
||||
" lidt __myidt \n"
|
||||
|
||||
/* Dump zeros in the other segregs */
|
||||
" mov %ax, %es \n"
|
||||
" mov %ax, %fs \n"
|
||||
" mov %ax, %gs \n"
|
||||
" mov $0x40, %ax \n"
|
||||
" mov %ax, %ds \n"
|
||||
|
||||
/* pop the INT # that you pushed earlier */
|
||||
" popl %eax \n"
|
||||
" pop %gs \n"
|
||||
|
|
@ -504,8 +464,7 @@ void callbiosint(void)
|
|||
" pop %ds \n"
|
||||
" popal \n"
|
||||
" iret \n"
|
||||
" .code32 \n"
|
||||
);
|
||||
" .code32 \n");
|
||||
}
|
||||
|
||||
enum {
|
||||
|
|
@ -519,8 +478,8 @@ int pcibios(unsigned long *pedi, unsigned long *pesi, unsigned long *pebp,
|
|||
|
||||
int handleint21(unsigned long *pedi, unsigned long *pesi, unsigned long *pebp,
|
||||
unsigned long *pesp, unsigned long *pebx, unsigned long *pedx,
|
||||
unsigned long *pecx, unsigned long *peax, unsigned long *pflags
|
||||
);
|
||||
unsigned long *pecx, unsigned long *peax,
|
||||
unsigned long *pflags);
|
||||
|
||||
int biosint(unsigned long intnumber,
|
||||
unsigned long gsfs, unsigned long dses,
|
||||
|
|
@ -551,13 +510,13 @@ int biosint(unsigned long intnumber,
|
|||
|
||||
// cases in a good compiler are just as good as your own tables.
|
||||
switch (intnumber) {
|
||||
case 0 ... 15:
|
||||
case 0...15:
|
||||
// These are not BIOS service, but the CPU-generated exceptions
|
||||
printk_info("biosint: Oops, exception %u\n", intnumber);
|
||||
if (esp < 0x1000) {
|
||||
printk_debug("Stack contents: ");
|
||||
while (esp < 0x1000) {
|
||||
printk_debug("0x%04x ", *(unsigned short *) esp);
|
||||
printk_debug("0x%04x ", *(unsigned short *)esp);
|
||||
esp += 2;
|
||||
}
|
||||
printk_debug("\n");
|
||||
|
|
@ -568,7 +527,7 @@ int biosint(unsigned long intnumber,
|
|||
break;
|
||||
|
||||
case PCIBIOS:
|
||||
ret = pcibios( &edi, &esi, &ebp, &esp,
|
||||
ret = pcibios(&edi, &esi, &ebp, &esp,
|
||||
&ebx, &edx, &ecx, &eax, &flags);
|
||||
break;
|
||||
case MEMSIZE:
|
||||
|
|
@ -577,12 +536,11 @@ int biosint(unsigned long intnumber,
|
|||
ret = 0;
|
||||
break;
|
||||
case 0x15:
|
||||
ret=handleint21( &edi, &esi, &ebp, &esp,
|
||||
ret = handleint21(&edi, &esi, &ebp, &esp,
|
||||
&ebx, &edx, &ecx, &eax, &flags);
|
||||
break;
|
||||
default:
|
||||
printk_info("BIOSINT: Unsupport int #0x%x\n",
|
||||
intnumber);
|
||||
printk_info("BIOSINT: Unsupport int #0x%x\n", intnumber);
|
||||
break;
|
||||
}
|
||||
if (ret)
|
||||
|
|
@ -593,14 +551,13 @@ int biosint(unsigned long intnumber,
|
|||
return ret;
|
||||
}
|
||||
|
||||
|
||||
void setup_realmode_idt(void)
|
||||
{
|
||||
extern unsigned char idthandle, end_idthandle;
|
||||
extern unsigned char debughandle, end_debughandle;
|
||||
|
||||
int i;
|
||||
struct realidt *idts = (struct realidt *) 0;
|
||||
struct realidt *idts = (struct realidt *)0;
|
||||
int codesize = &end_idthandle - &idthandle;
|
||||
unsigned char *intbyte, *codeptr;
|
||||
|
||||
|
|
@ -615,8 +572,8 @@ void setup_realmode_idt(void)
|
|||
// and get it that way. But that's really disgusting.
|
||||
for (i = 0; i < 256; i++) {
|
||||
idts[i].cs = 0;
|
||||
codeptr = (unsigned char*) 4096 + i * codesize;
|
||||
idts[i].offset = (unsigned) codeptr;
|
||||
codeptr = (unsigned char *)4096 + i * codesize;
|
||||
idts[i].offset = (unsigned)codeptr;
|
||||
memcpy(codeptr, &idthandle, codesize);
|
||||
intbyte = codeptr + 3;
|
||||
*intbyte = i;
|
||||
|
|
@ -628,7 +585,7 @@ void setup_realmode_idt(void)
|
|||
// int10.
|
||||
// calling convention here is the same as INTs, we can reuse
|
||||
// the int entry code.
|
||||
codeptr = (unsigned char*) 0xff065;
|
||||
codeptr = (unsigned char *)0xff065;
|
||||
memcpy(codeptr, &idthandle, codesize);
|
||||
intbyte = codeptr + 3;
|
||||
*intbyte = 0x42; /* int42 is the relocated int10 */
|
||||
|
|
@ -637,11 +594,9 @@ void setup_realmode_idt(void)
|
|||
TF bit is set upon call to real mode */
|
||||
idts[1].cs = 0;
|
||||
idts[1].offset = 16384;
|
||||
memcpy((void*)16384, &debughandle, &end_debughandle - &debughandle);
|
||||
memcpy((void *)16384, &debughandle, &end_debughandle - &debughandle);
|
||||
}
|
||||
|
||||
|
||||
|
||||
enum {
|
||||
CHECK = 0xb001,
|
||||
FINDDEV = 0xb102,
|
||||
|
|
@ -674,14 +629,14 @@ pcibios(unsigned long *pedi, unsigned long *pesi, unsigned long *pebp,
|
|||
unsigned long ecx = *pecx;
|
||||
unsigned long eax = *peax;
|
||||
unsigned long flags = *pflags;
|
||||
unsigned short func = (unsigned short) eax;
|
||||
unsigned short func = (unsigned short)eax;
|
||||
int retval = 0;
|
||||
unsigned short devid, vendorid, devfn;
|
||||
short devindex; /* Use short to get rid of gabage in upper half of 32-bit register */
|
||||
unsigned char bus;
|
||||
device_t dev;
|
||||
|
||||
switch(func) {
|
||||
switch (func) {
|
||||
case CHECK:
|
||||
*pedx = 0x4350;
|
||||
*pecx = 0x2049;
|
||||
|
|
@ -705,7 +660,8 @@ pcibios(unsigned long *pedi, unsigned long *pesi, unsigned long *pebp,
|
|||
// devfn is an int, so we mask it off.
|
||||
busdevfn = (dev->bus->secondary << 8)
|
||||
| (dev->path.u.pci.devfn & 0xff);
|
||||
printk_debug("0x%x: return 0x%x\n", func, busdevfn);
|
||||
printk_debug("0x%x: return 0x%x\n", func,
|
||||
busdevfn);
|
||||
*pebx = busdevfn;
|
||||
retval = 0;
|
||||
} else {
|
||||
|
|
@ -730,13 +686,15 @@ pcibios(unsigned long *pedi, unsigned long *pesi, unsigned long *pebp,
|
|||
bus = *pebx >> 8;
|
||||
reg = *pedi;
|
||||
dev = dev_find_slot(bus, devfn);
|
||||
if (! dev) {
|
||||
printk_debug("0x%x: BAD DEVICE bus %d devfn 0x%x\n", func, bus, devfn);
|
||||
if (!dev) {
|
||||
printk_debug
|
||||
("0x%x: BAD DEVICE bus %d devfn 0x%x\n",
|
||||
func, bus, devfn);
|
||||
// idiots. the pcibios guys assumed you'd never pass a bad bus/devfn!
|
||||
*peax = PCIBIOS_BADREG;
|
||||
retval = -1;
|
||||
}
|
||||
switch(func) {
|
||||
switch (func) {
|
||||
case READCONFBYTE:
|
||||
byte = pci_read_config8(dev, reg);
|
||||
*pecx = byte;
|
||||
|
|
@ -765,7 +723,8 @@ pcibios(unsigned long *pedi, unsigned long *pesi, unsigned long *pebp,
|
|||
|
||||
if (retval)
|
||||
retval = PCIBIOS_BADREG;
|
||||
printk_debug("0x%x: bus %d devfn 0x%x reg 0x%x val 0x%lx\n",
|
||||
printk_debug
|
||||
("0x%x: bus %d devfn 0x%x reg 0x%x val 0x%lx\n",
|
||||
func, bus, devfn, reg, *pecx);
|
||||
*peax = 0;
|
||||
retval = 0;
|
||||
|
|
@ -783,41 +742,40 @@ int handleint21(unsigned long *edi, unsigned long *esi, unsigned long *ebp,
|
|||
unsigned long *esp, unsigned long *ebx, unsigned long *edx,
|
||||
unsigned long *ecx, unsigned long *eax, unsigned long *flags)
|
||||
{
|
||||
int res=-1;
|
||||
int res = -1;
|
||||
printk_debug("handleint21, eax 0x%x\n", *eax);
|
||||
switch(*eax&0xffff)
|
||||
{
|
||||
switch (*eax & 0xffff) {
|
||||
case 0x5f19:
|
||||
break;
|
||||
case 0x5f18:
|
||||
*eax=0x5f;
|
||||
*ebx=0x545; // MCLK = 133, 32M frame buffer, 256 M main memory
|
||||
*ecx=0x060;
|
||||
res=0;
|
||||
*eax = 0x5f;
|
||||
*ebx = 0x545; // MCLK = 133, 32M frame buffer, 256 M main memory
|
||||
*ecx = 0x060;
|
||||
res = 0;
|
||||
break;
|
||||
case 0x5f00:
|
||||
*eax = 0x8600;
|
||||
break;
|
||||
case 0x5f01:
|
||||
*eax = 0x5f;
|
||||
*ecx = (*ecx & 0xffffff00 ) | 2; // panel type = 2 = 1024 * 768
|
||||
*ecx = (*ecx & 0xffffff00) | 2; // panel type = 2 = 1024 * 768
|
||||
res = 0;
|
||||
break;
|
||||
case 0x5f02:
|
||||
*eax=0x5f;
|
||||
*ebx= (*ebx & 0xffff0000) | 2;
|
||||
*ecx= (*ecx & 0xffff0000) | 0x401; // PAL + crt only
|
||||
*edx= (*edx & 0xffff0000) | 0; // TV Layout - default
|
||||
res=0;
|
||||
*eax = 0x5f;
|
||||
*ebx = (*ebx & 0xffff0000) | 2;
|
||||
*ecx = (*ecx & 0xffff0000) | 0x401; // PAL + crt only
|
||||
*edx = (*edx & 0xffff0000) | 0; // TV Layout - default
|
||||
res = 0;
|
||||
break;
|
||||
case 0x5f0f:
|
||||
*eax=0x860f;
|
||||
*eax = 0x860f;
|
||||
break;
|
||||
case 0xBEA7:
|
||||
*eax=66;
|
||||
*eax = 66;
|
||||
break;
|
||||
case 0xBEA4:
|
||||
*eax=500;
|
||||
*eax = 500;
|
||||
break;
|
||||
}
|
||||
return res;
|
||||
|
|
|
|||
Loading…
Add table
Reference in a new issue