This code is pretty old and we want to support only 32-bit systems now. Signed-off-by: Simon Glass <sjg@chromium.org> Acked-by: Graeme Russ <graeme.russ@gmail.com>master
Simon Glass
13 years ago
parent
588a13f742
commit
96dfc0633a
@ -1,36 +0,0 @@ |
|||||||
/*
|
|
||||||
* (C) Copyright 2002 |
|
||||||
* Daniel Engström, Omicron Ceti AB, daniel@omicron.se |
|
||||||
* |
|
||||||
* See file CREDITS for list of people who contributed to this |
|
||||||
* project. |
|
||||||
* |
|
||||||
* This program is free software; you can redistribute it and/or |
|
||||||
* modify it under the terms of the GNU General Public License as |
|
||||||
* published by the Free Software Foundation; either version 2 of |
|
||||||
* the License, or (at your option) any later version. |
|
||||||
* |
|
||||||
* This program is distributed in the hope that it will be useful, |
|
||||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
||||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
||||||
* GNU General Public License for more details. |
|
||||||
* |
|
||||||
* You should have received a copy of the GNU General Public License |
|
||||||
* along with this program; if not, write to the Free Software |
|
||||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
|
||||||
* MA 02111-1307 USA |
|
||||||
*/ |
|
||||||
|
|
||||||
#ifndef __ASM_REALMODE_H_ |
|
||||||
#define __ASM_REALMODE_H_ |
|
||||||
#include <asm/ptrace.h> |
|
||||||
|
|
||||||
extern ulong __realmode_start; |
|
||||||
extern ulong __realmode_size; |
|
||||||
extern char realmode_enter; |
|
||||||
|
|
||||||
int bios_setup(void); |
|
||||||
int enter_realmode(u16 seg, u16 off, struct pt_regs *in, struct pt_regs *out); |
|
||||||
int enter_realmode_int(u8 lvl, struct pt_regs *in, struct pt_regs *out); |
|
||||||
|
|
||||||
#endif |
|
||||||
@ -1,569 +0,0 @@ |
|||||||
/* |
|
||||||
* (C) Copyright 2002 |
|
||||||
* Daniel Engström, Omicron Ceti AB, <daniel@omicron.se>
|
|
||||||
* |
|
||||||
* See file CREDITS for list of people who contributed to this |
|
||||||
* project. |
|
||||||
* |
|
||||||
* This program is free software; you can redistribute it and/or
|
|
||||||
* modify it under the terms of the GNU General Public License as |
|
||||||
* published by the Free Software Foundation; either version 2 of
|
|
||||||
* the License, or (at your option) any later version. |
|
||||||
* |
|
||||||
* This program is distributed in the hope that it will be useful, |
|
||||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
||||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
||||||
* GNU General Public License for more details. |
|
||||||
* |
|
||||||
* You should have received a copy of the GNU General Public License |
|
||||||
* along with this program; if not, write to the Free Software
|
|
||||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
|
||||||
* MA 02111-1307 USA |
|
||||||
*/ |
|
||||||
|
|
||||||
/* |
|
||||||
* Based on msbios.c from rolo 1.6: |
|
||||||
*---------------------------------------------------------------------- |
|
||||||
* (C) Copyright 2000 |
|
||||||
* Sysgo Real-Time Solutions GmbH |
|
||||||
* Klein-Winternheim, Germany |
|
||||||
*---------------------------------------------------------------------- |
|
||||||
*/ |
|
||||||
|
|
||||||
#include "bios.h" |
|
||||||
|
|
||||||
/* |
|
||||||
* During it's initialization phase, before switching to protected |
|
||||||
* mode, the Linux Kernel makes a few BIOS calls. This won't work |
|
||||||
* if the board does not have a BIOS. |
|
||||||
* |
|
||||||
* This is a very minimalisic BIOS that supplies just enough |
|
||||||
* functionality to keep the Linux Kernel happy. It is NOT |
|
||||||
* a general purpose replacement for a real BIOS !! |
|
||||||
*/ |
|
||||||
|
|
||||||
.section .bios, "ax" |
|
||||||
.code16 |
|
||||||
.org 0
|
|
||||||
/* a call to f000:0 should warmboot */ |
|
||||||
jmp realmode_reset |
|
||||||
|
|
||||||
.globl rm_int00
|
|
||||||
.hidden rm_int00
|
|
||||||
.type rm_int00, @function
|
|
||||||
rm_int00: |
|
||||||
pushw $0 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int01
|
|
||||||
.hidden rm_int01
|
|
||||||
.type rm_int01, @function
|
|
||||||
rm_int01: |
|
||||||
pushw $1 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int02
|
|
||||||
.hidden rm_int02
|
|
||||||
.type rm_int02, @function
|
|
||||||
rm_int02: |
|
||||||
pushw $2 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int03
|
|
||||||
.hidden rm_int03
|
|
||||||
.type rm_int03, @function
|
|
||||||
rm_int03: |
|
||||||
pushw $3 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int04
|
|
||||||
.hidden rm_int04
|
|
||||||
.type rm_int04, @function
|
|
||||||
rm_int04: |
|
||||||
pushw $4 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int05
|
|
||||||
.hidden rm_int05
|
|
||||||
.type rm_int05, @function
|
|
||||||
rm_int05: |
|
||||||
pushw $5 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int06
|
|
||||||
.hidden rm_int06
|
|
||||||
.type rm_int06, @function
|
|
||||||
rm_int06: |
|
||||||
pushw $6 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int07
|
|
||||||
.hidden rm_int07
|
|
||||||
.type rm_int07, @function
|
|
||||||
rm_int07: |
|
||||||
pushw $7 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int08
|
|
||||||
.hidden rm_int08
|
|
||||||
.type rm_int08, @function
|
|
||||||
rm_int08: |
|
||||||
pushw $8 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int09
|
|
||||||
.hidden rm_int09
|
|
||||||
.type rm_int09, @function
|
|
||||||
rm_int09: |
|
||||||
pushw $9 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int0a
|
|
||||||
.hidden rm_int0a
|
|
||||||
.type rm_int0a, @function
|
|
||||||
rm_int0a: |
|
||||||
pushw $10 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int0b
|
|
||||||
.hidden rm_int0b
|
|
||||||
.type rm_int0b, @function
|
|
||||||
rm_int0b: |
|
||||||
pushw $11 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int0c
|
|
||||||
.hidden rm_int0c
|
|
||||||
.type rm_int0c, @function
|
|
||||||
rm_int0c: |
|
||||||
pushw $12 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int0d
|
|
||||||
.hidden rm_int0d
|
|
||||||
.type rm_int0d, @function
|
|
||||||
rm_int0d: |
|
||||||
pushw $13 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int0e
|
|
||||||
.hidden rm_int0e
|
|
||||||
.type rm_int0e, @function
|
|
||||||
rm_int0e: |
|
||||||
pushw $14 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int0f
|
|
||||||
.hidden rm_int0f
|
|
||||||
.type rm_int0f, @function
|
|
||||||
rm_int0f: |
|
||||||
pushw $15 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int10
|
|
||||||
.hidden rm_int10
|
|
||||||
.type rm_int10, @function
|
|
||||||
rm_int10: |
|
||||||
pushw $16 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int11
|
|
||||||
.hidden rm_int11
|
|
||||||
.type rm_int11, @function
|
|
||||||
rm_int11: |
|
||||||
pushw $17 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int12
|
|
||||||
.hidden rm_int12
|
|
||||||
.type rm_int12, @function
|
|
||||||
rm_int12: |
|
||||||
pushw $18 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int13
|
|
||||||
.hidden rm_int13
|
|
||||||
.type rm_int13, @function
|
|
||||||
rm_int13: |
|
||||||
pushw $19 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int14
|
|
||||||
.hidden rm_int14
|
|
||||||
.type rm_int14, @function
|
|
||||||
rm_int14: |
|
||||||
pushw $20 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int15
|
|
||||||
.hidden rm_int15
|
|
||||||
.type rm_int15, @function
|
|
||||||
rm_int15: |
|
||||||
pushw $21 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int16
|
|
||||||
.hidden rm_int16
|
|
||||||
.type rm_int16, @function
|
|
||||||
rm_int16: |
|
||||||
pushw $22 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int17
|
|
||||||
.hidden rm_int17
|
|
||||||
.type rm_int17, @function
|
|
||||||
rm_int17: |
|
||||||
pushw $23 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int18
|
|
||||||
.hidden rm_int18
|
|
||||||
.type rm_int18, @function
|
|
||||||
rm_int18: |
|
||||||
pushw $24 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int19
|
|
||||||
.hidden rm_int19
|
|
||||||
.type rm_int19, @function
|
|
||||||
rm_int19: |
|
||||||
pushw $25 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int1a
|
|
||||||
.hidden rm_int1a
|
|
||||||
.type rm_int1a, @function
|
|
||||||
rm_int1a: |
|
||||||
pushw $26 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int1b
|
|
||||||
.hidden rm_int1b
|
|
||||||
.type rm_int1b, @function
|
|
||||||
rm_int1b: |
|
||||||
pushw $27 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int1c
|
|
||||||
.hidden rm_int1c
|
|
||||||
.type rm_int1c, @function
|
|
||||||
rm_int1c: |
|
||||||
pushw $28 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int1d
|
|
||||||
.hidden rm_int1d
|
|
||||||
.type rm_int1d, @function
|
|
||||||
rm_int1d: |
|
||||||
pushw $29 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int1e
|
|
||||||
.hidden rm_int1e
|
|
||||||
.type rm_int1e, @function
|
|
||||||
rm_int1e: |
|
||||||
pushw $30 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_int1f
|
|
||||||
.hidden rm_int1f
|
|
||||||
.type rm_int1f, @function
|
|
||||||
rm_int1f: |
|
||||||
pushw $31 |
|
||||||
jmp any_interrupt16 |
|
||||||
.globl rm_def_int
|
|
||||||
.hidden rm_def_int
|
|
||||||
.type rm_def_int, @function
|
|
||||||
rm_def_int: |
|
||||||
iret |
|
||||||
|
|
||||||
/* |
|
||||||
* All interrupt jumptable entries jump to here after pushing the |
|
||||||
* interrupt vector number onto the stack. |
|
||||||
*/ |
|
||||||
any_interrupt16: |
|
||||||
MAKE_BIOS_STACK |
|
||||||
|
|
||||||
gs movw OFFS_VECTOR(%bp), %ax |
|
||||||
cmpw $0x10, %ax |
|
||||||
je Lint_10h |
|
||||||
cmpw $0x11, %ax |
|
||||||
je Lint_11h |
|
||||||
cmpw $0x12, %ax |
|
||||||
je Lint_12h |
|
||||||
cmpw $0x13, %ax |
|
||||||
je Lint_13h |
|
||||||
cmpw $0x15, %ax |
|
||||||
je Lint_15h |
|
||||||
cmpw $0x16, %ax |
|
||||||
je Lint_16h |
|
||||||
cmpw $0x1a, %ax |
|
||||||
je Lint_1ah |
|
||||||
movw $0xffff, %ax |
|
||||||
jmp Lout |
|
||||||
Lint_10h: |
|
||||||
/* VGA BIOS services */ |
|
||||||
call bios_10h |
|
||||||
jmp Lout |
|
||||||
Lint_11h: |
|
||||||
call bios_11h |
|
||||||
jmp Lout |
|
||||||
Lint_12h: |
|
||||||
call bios_12h |
|
||||||
jmp Lout |
|
||||||
Lint_13h: |
|
||||||
/* BIOS disk services */ |
|
||||||
call bios_13h |
|
||||||
jmp Lout |
|
||||||
Lint_15h: |
|
||||||
/* Misc. BIOS services */ |
|
||||||
call bios_15h |
|
||||||
jmp Lout |
|
||||||
Lint_16h: |
|
||||||
/* keyboard services */ |
|
||||||
call bios_16h |
|
||||||
jmp Lout |
|
||||||
Lint_1ah: |
|
||||||
/* PCI bios */ |
|
||||||
call bios_1ah |
|
||||||
jmp Lout |
|
||||||
Lout: |
|
||||||
cmpw $0, %ax |
|
||||||
je Lhandeled |
|
||||||
|
|
||||||
/* |
|
||||||
* Insert code for unhandeled INTs here. |
|
||||||
* |
|
||||||
* ROLO prints a message to the console we could do that but then |
|
||||||
* we're in 16bit mode so we'll have to get back into 32bit mode |
|
||||||
* to use the console I/O routines (if we do this we should make |
|
||||||
* int 0x10 and int 0x16 work as well) |
|
||||||
*/ |
|
||||||
Lhandeled: |
|
||||||
RESTORE_CALLERS_STACK |
|
||||||
|
|
||||||
/* dump vector number */ |
|
||||||
addw $2,%sp |
|
||||||
|
|
||||||
/* return from interrupt */ |
|
||||||
iret |
|
||||||
|
|
||||||
/* |
|
||||||
************************************************************ |
|
||||||
* BIOS interrupt 10h -- VGA services |
|
||||||
************************************************************ |
|
||||||
*/ |
|
||||||
bios_10h: |
|
||||||
gs movw OFFS_AX(%bp), %ax |
|
||||||
shrw $8, %ax |
|
||||||
cmpw $0x3, %ax |
|
||||||
je Lcur_pos |
|
||||||
cmpw $0xf, %ax |
|
||||||
je Lvid_state |
|
||||||
cmpw $0x12, %ax |
|
||||||
je Lvid_cfg |
|
||||||
movw $0xffff, %ax |
|
||||||
ret |
|
||||||
Lcur_pos: |
|
||||||
/* Read Cursor Position and Size */ |
|
||||||
gs movw $0, OFFS_CX(%bp) |
|
||||||
gs movw $0, OFFS_DX(%bp) |
|
||||||
xorw %ax, %ax |
|
||||||
ret |
|
||||||
Lvid_state: |
|
||||||
/* Get Video State - 80 columns, 80x25, 16 colors */ |
|
||||||
gs movw $(80 << 8|0x03), OFFS_AX(%bp) |
|
||||||
gs movw $0, OFFS_BX(%bp) |
|
||||||
xorw %ax, %ax |
|
||||||
ret |
|
||||||
Lvid_cfg: |
|
||||||
/* Video Subsystem Configuration (EGA/VGA) - indicate CGA/MDA/HGA */ |
|
||||||
gs movw $0x10, OFFS_BX(%bp) |
|
||||||
xorw %ax, %ax |
|
||||||
ret |
|
||||||
|
|
||||||
/* |
|
||||||
************************************************************ |
|
||||||
* BIOS interrupt 11h -- Equipment determination |
|
||||||
************************************************************ |
|
||||||
*/ |
|
||||||
|
|
||||||
bios_11h: |
|
||||||
cs movw bios_equipment, %ax |
|
||||||
gs movw %ax, OFFS_AX(%bp) |
|
||||||
xorw %ax, %ax |
|
||||||
ret |
|
||||||
|
|
||||||
/* |
|
||||||
************************************************************ |
|
||||||
* BIOS interrupt 12h -- Get Memory Size |
|
||||||
************************************************************ |
|
||||||
*/ |
|
||||||
bios_12h: |
|
||||||
cs movw ram_in_64kb_chunks, %ax |
|
||||||
cmpw $0xa, %ax |
|
||||||
ja b12_more_than_640k |
|
||||||
shlw $6, %ax |
|
||||||
jmp b12_return |
|
||||||
b12_more_than_640k: |
|
||||||
movw $0x280, %ax |
|
||||||
b12_return: |
|
||||||
/* return number of kilobytes in ax */ |
|
||||||
gs movw %ax, OFFS_AX(%bp) |
|
||||||
|
|
||||||
gs movw OFFS_FLAGS(%bp), %ax |
|
||||||
|
|
||||||
/* clear carry -- function succeeded */ |
|
||||||
andw $0xfffe, %ax |
|
||||||
gs movw %ax, OFFS_FLAGS(%bp) |
|
||||||
|
|
||||||
xorw %ax, %ax |
|
||||||
ret |
|
||||||
|
|
||||||
/* |
|
||||||
************************************************************ |
|
||||||
* BIOS interrupt 13h -- Disk services |
|
||||||
************************************************************ |
|
||||||
*/ |
|
||||||
bios_13h: |
|
||||||
gs movw OFFS_AX(%bp), %ax |
|
||||||
shrw $8, %ax |
|
||||||
cmpw $0x15, %ax |
|
||||||
je Lfunc_15h |
|
||||||
movw $0xffff, %ax |
|
||||||
ret |
|
||||||
Lfunc_15h: |
|
||||||
gs movw OFFS_AX(%bp), %ax |
|
||||||
|
|
||||||
/* return AH=0->drive not present */ |
|
||||||
andw $0x00ff, %ax |
|
||||||
gs movw %ax, OFFS_AX(%bp) |
|
||||||
xorw %ax, %ax |
|
||||||
ret |
|
||||||
|
|
||||||
/* |
|
||||||
*********************************************************** |
|
||||||
* BIOS interrupt 15h -- Miscellaneous services |
|
||||||
*********************************************************** |
|
||||||
*/ |
|
||||||
bios_15h: |
|
||||||
gs movw OFFS_AX(%bp), %ax |
|
||||||
shrw $8, %ax |
|
||||||
cmpw $0xc0, %ax |
|
||||||
je Lfunc_c0h |
|
||||||
cmpw $0xe8, %ax |
|
||||||
je Lfunc_e8h |
|
||||||
cmpw $0x88, %ax |
|
||||||
je Lfunc_88h |
|
||||||
movw $0xffff, %ax |
|
||||||
ret |
|
||||||
|
|
||||||
Lfunc_c0h: |
|
||||||
/* Return System Configuration Parameters (PS2 only) */ |
|
||||||
gs movw OFFS_FLAGS(%bp), %ax |
|
||||||
|
|
||||||
/* return carry -- function not supported */ |
|
||||||
orw $1, %ax |
|
||||||
gs movw %ax, OFFS_FLAGS(%bp) |
|
||||||
xorw %ax, %ax |
|
||||||
ret |
|
||||||
|
|
||||||
Lfunc_e8h: |
|
||||||
gs movw OFFS_AX(%bp), %ax |
|
||||||
andw $0xff, %ax |
|
||||||
cmpw $1, %ax |
|
||||||
je Lfunc_e801h |
|
||||||
gs movw OFFS_FLAGS(%bp), %ax |
|
||||||
|
|
||||||
/* return carry -- function not supported */ |
|
||||||
orw $1, %ax |
|
||||||
gs movw %ax, OFFS_FLAGS(%bp) |
|
||||||
xorw %ax, %ax |
|
||||||
ret |
|
||||||
|
|
||||||
Lfunc_e801h: |
|
||||||
/* Get memory size for >64M Configurations */ |
|
||||||
cs movw ram_in_64kb_chunks, %ax |
|
||||||
cmpw $0x100, %ax |
|
||||||
ja e801_more_than_16mb |
|
||||||
|
|
||||||
/* multiply by 64 */ |
|
||||||
shlw $6, %ax |
|
||||||
|
|
||||||
/* 1st meg does not count */ |
|
||||||
subw $0x400, %ax |
|
||||||
|
|
||||||
/* return memory size between 1M and 16M in 1kb chunks in AX and CX */ |
|
||||||
gs movw %ax, OFFS_AX(%bp) |
|
||||||
gs movw %ax, OFFS_CX(%bp) |
|
||||||
|
|
||||||
/* set BX and DX to 0*/ |
|
||||||
gs movw $0, OFFS_BX(%bp) |
|
||||||
gs movw $0, OFFS_DX(%bp) |
|
||||||
gs movw OFFS_FLAGS(%bp), %ax |
|
||||||
|
|
||||||
/* clear carry -- function succeeded */ |
|
||||||
andw $0xfffe, %ax |
|
||||||
gs movw %ax, OFFS_FLAGS(%bp) |
|
||||||
xorw %ax, %ax |
|
||||||
ret |
|
||||||
|
|
||||||
e801_more_than_16mb: |
|
||||||
/* subtract 16MB */ |
|
||||||
subw $0x100, %ax |
|
||||||
|
|
||||||
/* return 0x3c00 (16MB-1MB) in AX and CX */ |
|
||||||
gs movw $0x3c00, OFFS_AX(%bp) |
|
||||||
gs movw $0x3c00, OFFS_CX(%bp) |
|
||||||
|
|
||||||
/* set BX and DX to number of 64kb chunks above 16MB */ |
|
||||||
gs movw %ax, OFFS_BX(%bp) |
|
||||||
gs movw %ax, OFFS_DX(%bp) |
|
||||||
|
|
||||||
gs movw OFFS_FLAGS(%bp), %ax |
|
||||||
|
|
||||||
/* clear carry -- function succeeded */ |
|
||||||
andw $0xfffe, %ax |
|
||||||
gs movw %ax, OFFS_FLAGS(%bp) |
|
||||||
xorw %ax, %ax |
|
||||||
ret |
|
||||||
|
|
||||||
Lfunc_88h: |
|
||||||
cs movw ram_in_64kb_chunks, %ax |
|
||||||
cmpw $0x100, %ax |
|
||||||
jna b88_not_more_than16 |
|
||||||
movw $0x100, %ax |
|
||||||
b88_not_more_than16: |
|
||||||
shlw $6, %ax |
|
||||||
|
|
||||||
/* 1st meg does not count */ |
|
||||||
subw $0x400, %ax |
|
||||||
|
|
||||||
/* return number of kilobytes between 16MB and 16MB in ax */ |
|
||||||
gs movw %ax, OFFS_AX(%bp) |
|
||||||
|
|
||||||
gs movw OFFS_FLAGS(%bp), %ax |
|
||||||
|
|
||||||
/* clear carry -- function succeeded */ |
|
||||||
andw $0xfffe, %ax |
|
||||||
gs movw %ax, OFFS_FLAGS(%bp) |
|
||||||
|
|
||||||
xorw %ax, %ax |
|
||||||
ret |
|
||||||
|
|
||||||
/* |
|
||||||
************************************************************ |
|
||||||
* BIOS interrupt 16h -- keyboard services |
|
||||||
************************************************************ |
|
||||||
*/ |
|
||||||
bios_16h: |
|
||||||
gs movw OFFS_AX(%bp), %ax |
|
||||||
shrw $8, %ax |
|
||||||
cmpw $0x03, %ax |
|
||||||
je Lfunc_03h |
|
||||||
movw $0xffff, %ax |
|
||||||
ret |
|
||||||
Lfunc_03h: |
|
||||||
/* do nothing -- function not supported */ |
|
||||||
xorw %ax, %ax |
|
||||||
ret |
|
||||||
|
|
||||||
/* |
|
||||||
************************************************************ |
|
||||||
* BIOS interrupt 1ah -- PCI bios |
|
||||||
************************************************************ |
|
||||||
*/ |
|
||||||
bios_1ah: |
|
||||||
gs movw OFFS_AX(%bp), %ax |
|
||||||
cmpb $0xb1, %ah |
|
||||||
je Lfunc_b1h |
|
||||||
movw $0xffff, %ax |
|
||||||
ret |
|
||||||
Lfunc_b1h: |
|
||||||
call realmode_pci_bios |
|
||||||
|
|
||||||
/* do nothing -- function not supported */ |
|
||||||
xorw %ax, %ax |
|
||||||
ret |
|
||||||
|
|
||||||
|
|
||||||
.globl ram_in_64kb_chunks
|
|
||||||
.hidden ram_in_64kb_chunks
|
|
||||||
.type ram_in_64kb_chunks, @function
|
|
||||||
ram_in_64kb_chunks: |
|
||||||
.word 0
|
|
||||||
|
|
||||||
.globl bios_equipment
|
|
||||||
.hidden bios_equipment
|
|
||||||
.type bios_equipment, @function
|
|
||||||
bios_equipment: |
|
||||||
.word 0
|
|
||||||
@ -1,447 +0,0 @@ |
|||||||
/* |
|
||||||
* (C) Copyright 2002 |
|
||||||
* Daniel Engström, Omicron Ceti AB, daniel@omicron.se
|
|
||||||
* |
|
||||||
* See file CREDITS for list of people who contributed to this |
|
||||||
* project. |
|
||||||
* |
|
||||||
* This program is free software; you can redistribute it and/or
|
|
||||||
* modify it under the terms of the GNU General Public License as |
|
||||||
* published by the Free Software Foundation; either version 2 of
|
|
||||||
* the License, or (at your option) any later version. |
|
||||||
* |
|
||||||
* This program is distributed in the hope that it will be useful, |
|
||||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
||||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
||||||
* GNU General Public License for more details. |
|
||||||
* |
|
||||||
* You should have received a copy of the GNU General Public License |
|
||||||
* along with this program; if not, write to the Free Software
|
|
||||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
|
||||||
* MA 02111-1307 USA |
|
||||||
*/ |
|
||||||
|
|
||||||
/* |
|
||||||
* x86 realmode assembly implementation of a PCI BIOS |
|
||||||
* for platforms that use one PCI hose and configuration |
|
||||||
* access type 1. (The common case for low-end PC's) |
|
||||||
*/ |
|
||||||
|
|
||||||
#include "bios.h" |
|
||||||
|
|
||||||
#define PCI_BIOS_DEBUG |
|
||||||
|
|
||||||
.section .bios, "ax" |
|
||||||
.code16 |
|
||||||
.globl realmode_pci_bios_call_entry
|
|
||||||
.hidden realmode_pci_bios_call_entry
|
|
||||||
.type realmode_pci_bios_call_entry, @function
|
|
||||||
realmode_pci_bios_call_entry: |
|
||||||
MAKE_BIOS_STACK |
|
||||||
call realmode_pci_bios |
|
||||||
RESTORE_CALLERS_STACK |
|
||||||
ret |
|
||||||
|
|
||||||
|
|
||||||
.globl realmode_pci_bios
|
|
||||||
realmode_pci_bios: |
|
||||||
gs movw OFFS_AX(%bp), %ax |
|
||||||
cmpb $1, %al |
|
||||||
je pci_bios_present |
|
||||||
cmpb $2, %al |
|
||||||
je pci_bios_find_device |
|
||||||
cmpb $3, %al |
|
||||||
je pci_bios_find_class |
|
||||||
cmpb $6, %al |
|
||||||
je pci_bios_generate_special_cycle |
|
||||||
cmpb $8, %al |
|
||||||
je pci_bios_read_cfg_byte |
|
||||||
cmpb $9, %al |
|
||||||
je pci_bios_read_cfg_word |
|
||||||
cmpb $10, %al |
|
||||||
je pci_bios_read_cfg_dword |
|
||||||
cmpb $11, %al |
|
||||||
je pci_bios_write_cfg_byte |
|
||||||
cmpb $12, %al |
|
||||||
je pci_bios_write_cfg_word |
|
||||||
cmpb $13, %al |
|
||||||
je pci_bios_write_cfg_dword |
|
||||||
cmpb $14, %al |
|
||||||
je pci_bios_get_irq_routing |
|
||||||
cmpb $15, %al |
|
||||||
je pci_bios_set_irq |
|
||||||
jmp unknown_function |
|
||||||
|
|
||||||
/*****************************************************************************/ |
|
||||||
|
|
||||||
pci_bios_present: |
|
||||||
#ifdef PCI_BIOS_DEBUG |
|
||||||
cs incl num_pci_bios_present |
|
||||||
#endif |
|
||||||
movl $0x20494350, %eax |
|
||||||
gs movl %eax, OFFS_EDX(%bp) |
|
||||||
|
|
||||||
/* We support cfg type 1 version 2.10 */ |
|
||||||
movb $0x01, %al |
|
||||||
gs movb %al, OFFS_AL(%bp) |
|
||||||
movw $0x0210, %ax |
|
||||||
gs movw %ax, OFFS_BX(%bp) |
|
||||||
|
|
||||||
/* last bus number */ |
|
||||||
cs movb pci_last_bus, %al |
|
||||||
gs movb %al, OFFS_CL(%bp) |
|
||||||
jmp clear_carry |
|
||||||
|
|
||||||
/*****************************************************************************/ |
|
||||||
|
|
||||||
/* device 0-31, function 0-7 */ |
|
||||||
pci_bios_find_device: |
|
||||||
#ifdef PCI_BIOS_DEBUG |
|
||||||
cs incl num_pci_bios_find_device |
|
||||||
#endif |
|
||||||
gs movw OFFS_CX(%bp), %di |
|
||||||
shll $16, %edi |
|
||||||
gs movw OFFS_DX(%bp), %di |
|
||||||
/* edi now holds device in upper 16 bits and vendor in lower 16 bits */ |
|
||||||
|
|
||||||
gs movw OFFS_SI(%bp), %si |
|
||||||
|
|
||||||
/* start at bus 0 dev 0 function 0 */ |
|
||||||
xorw %bx, %bx |
|
||||||
pfd_loop: |
|
||||||
/* dword 0 is vendor/device */ |
|
||||||
xorw %ax, %ax |
|
||||||
call __pci_bios_select_register |
|
||||||
movw $0xcfc, %dx |
|
||||||
inl %dx, %eax |
|
||||||
|
|
||||||
/* our device ? */ |
|
||||||
cmpl %edi, %eax |
|
||||||
je pfd_found_one |
|
||||||
pfd_next_dev: |
|
||||||
/* check for multi function devices */ |
|
||||||
movw %bx, %ax |
|
||||||
andw $3, %ax |
|
||||||
jnz pfd_function_not_zero |
|
||||||
movw $0x000c, %ax |
|
||||||
call __pci_bios_select_register |
|
||||||
movw $0xcfe, %dx |
|
||||||
inb %dx, %al |
|
||||||
andb $0x80, %al |
|
||||||
jz pfd_not_multi_function |
|
||||||
pfd_function_not_zero: |
|
||||||
/* next function, overflows in to device number, then bus number */ |
|
||||||
incw %bx |
|
||||||
jmp pfd_check_bus |
|
||||||
|
|
||||||
pfd_not_multi_function: |
|
||||||
/* remove function bits */ |
|
||||||
andw $0xfff8, %bx |
|
||||||
|
|
||||||
/* next device, overflows in to bus number */ |
|
||||||
addw $0x0008, %bx |
|
||||||
pfd_check_bus: |
|
||||||
cs movb pci_last_bus, %ah |
|
||||||
cmpb %ah, %bh |
|
||||||
ja pfd_not_found |
|
||||||
jmp pfd_loop |
|
||||||
pfd_found_one: |
|
||||||
decw %si |
|
||||||
js pfd_done |
|
||||||
jmp pfd_next_dev |
|
||||||
|
|
||||||
pfd_done: |
|
||||||
gs movw %bx, OFFS_BX(%bp) |
|
||||||
jmp clear_carry |
|
||||||
|
|
||||||
pfd_not_found: |
|
||||||
/* device not found */ |
|
||||||
movb $0x86, %ah |
|
||||||
jmp set_carry |
|
||||||
|
|
||||||
/*****************************************************************************/ |
|
||||||
|
|
||||||
pci_bios_find_class: |
|
||||||
#ifdef PCI_BIOS_DEBUG |
|
||||||
cs incl num_pci_bios_find_class |
|
||||||
#endif |
|
||||||
gs movl OFFS_ECX(%bp), %edi |
|
||||||
|
|
||||||
/* edi now holds class-code in lower 24 bits */ |
|
||||||
andl $0x00ffffff, %edi |
|
||||||
gs movw OFFS_SI(%bp), %si |
|
||||||
|
|
||||||
/* start at bus 0 dev 0 function 0 */ |
|
||||||
xorw %bx, %bx |
|
||||||
pfc_loop: |
|
||||||
/* dword 8 is class-code high 24bits */ |
|
||||||
movw $8, %ax |
|
||||||
call __pci_bios_select_register |
|
||||||
movw $0xcfc, %dx |
|
||||||
inl %dx, %eax |
|
||||||
shrl $8, %eax |
|
||||||
andl $0x00ffffff, %eax |
|
||||||
|
|
||||||
/* our device ? */ |
|
||||||
cmpl %edi, %eax |
|
||||||
je pfc_found_one |
|
||||||
pfc_next_dev: |
|
||||||
/* check for multi function devices */ |
|
||||||
andw $3, %bx |
|
||||||
jnz pfc_function_not_zero |
|
||||||
movw $0x000c, %ax |
|
||||||
call __pci_bios_select_register |
|
||||||
movw $0xcfe, %dx |
|
||||||
inb %dx, %al |
|
||||||
andb $0x80, %al |
|
||||||
jz pfc_not_multi_function |
|
||||||
pfc_function_not_zero: |
|
||||||
/* next function, overflows in to device number, then bus number */ |
|
||||||
incw %bx |
|
||||||
jmp pfc_check_bus |
|
||||||
|
|
||||||
pfc_not_multi_function: |
|
||||||
/* remove function bits */ |
|
||||||
andw $0xfff8, %bx |
|
||||||
|
|
||||||
/* next device, overflows in to bus number */ |
|
||||||
addw $0x0008, %bx |
|
||||||
pfc_check_bus: |
|
||||||
cs movb pci_last_bus, %ah |
|
||||||
cmpb %ah, %bh |
|
||||||
ja pfc_not_found |
|
||||||
jmp pfc_loop |
|
||||||
pfc_found_one: |
|
||||||
decw %si |
|
||||||
js pfc_done |
|
||||||
jmp pfc_next_dev |
|
||||||
|
|
||||||
pfc_done: |
|
||||||
gs movw %bx, OFFS_BX(%bp) |
|
||||||
jmp clear_carry |
|
||||||
|
|
||||||
pfc_not_found: |
|
||||||
/* device not found */ |
|
||||||
movb $0x86, %ah |
|
||||||
jmp set_carry |
|
||||||
|
|
||||||
/*****************************************************************************/ |
|
||||||
|
|
||||||
pci_bios_generate_special_cycle: |
|
||||||
#ifdef PCI_BIOS_DEBUG |
|
||||||
cs incl num_pci_bios_generate_special_cycle |
|
||||||
#endif |
|
||||||
/* function not supported */ |
|
||||||
movb $0x81, %ah |
|
||||||
jmp set_carry |
|
||||||
|
|
||||||
/*****************************************************************************/ |
|
||||||
|
|
||||||
pci_bios_read_cfg_byte: |
|
||||||
#ifdef PCI_BIOS_DEBUG |
|
||||||
cs incl num_pci_bios_read_cfg_byte |
|
||||||
#endif |
|
||||||
call pci_bios_select_register |
|
||||||
gs movw OFFS_DI(%bp), %dx |
|
||||||
andw $3, %dx |
|
||||||
addw $0xcfc, %dx |
|
||||||
inb %dx, %al |
|
||||||
gs movb %al, OFFS_CL(%bp) |
|
||||||
jmp clear_carry |
|
||||||
|
|
||||||
/*****************************************************************************/ |
|
||||||
|
|
||||||
pci_bios_read_cfg_word: |
|
||||||
#ifdef PCI_BIOS_DEBUG |
|
||||||
cs incl num_pci_bios_read_cfg_word |
|
||||||
#endif |
|
||||||
call pci_bios_select_register |
|
||||||
gs movw OFFS_DI(%bp), %dx |
|
||||||
andw $2, %dx |
|
||||||
addw $0xcfc, %dx |
|
||||||
inw %dx, %ax |
|
||||||
gs movw %ax, OFFS_CX(%bp) |
|
||||||
jmp clear_carry |
|
||||||
|
|
||||||
|
|
||||||
/*****************************************************************************/ |
|
||||||
|
|
||||||
pci_bios_read_cfg_dword: |
|
||||||
#ifdef PCI_BIOS_DEBUG |
|
||||||
cs incl num_pci_bios_read_cfg_dword |
|
||||||
#endif |
|
||||||
call pci_bios_select_register |
|
||||||
movw $0xcfc, %dx |
|
||||||
inl %dx, %eax |
|
||||||
gs movl %eax, OFFS_ECX(%bp) |
|
||||||
jmp clear_carry |
|
||||||
|
|
||||||
/*****************************************************************************/ |
|
||||||
|
|
||||||
pci_bios_write_cfg_byte: |
|
||||||
#ifdef PCI_BIOS_DEBUG |
|
||||||
cs incl num_pci_bios_write_cfg_byte |
|
||||||
#endif |
|
||||||
call pci_bios_select_register |
|
||||||
gs movw OFFS_DI(%bp), %dx |
|
||||||
gs movb OFFS_CL(%bp), %al |
|
||||||
andw $3, %dx |
|
||||||
addw $0xcfc, %dx |
|
||||||
outb %al, %dx |
|
||||||
jmp clear_carry |
|
||||||
|
|
||||||
/*****************************************************************************/ |
|
||||||
|
|
||||||
pci_bios_write_cfg_word: |
|
||||||
#ifdef PCI_BIOS_DEBUG |
|
||||||
cs incl num_pci_bios_write_cfg_word |
|
||||||
#endif |
|
||||||
call pci_bios_select_register |
|
||||||
gs movw OFFS_DI(%bp), %dx |
|
||||||
gs movw OFFS_CX(%bp), %ax |
|
||||||
andw $2, %dx |
|
||||||
addw $0xcfc, %dx |
|
||||||
outw %ax, %dx |
|
||||||
jmp clear_carry |
|
||||||
|
|
||||||
/*****************************************************************************/ |
|
||||||
|
|
||||||
pci_bios_write_cfg_dword: |
|
||||||
#ifdef PCI_BIOS_DEBUG |
|
||||||
cs incl num_pci_bios_write_cfg_dword |
|
||||||
#endif |
|
||||||
call pci_bios_select_register |
|
||||||
gs movl OFFS_ECX(%bp), %eax |
|
||||||
movw $0xcfc, %dx |
|
||||||
outl %eax, %dx |
|
||||||
jmp clear_carry |
|
||||||
|
|
||||||
/*****************************************************************************/ |
|
||||||
|
|
||||||
pci_bios_get_irq_routing: |
|
||||||
#ifdef PCI_BIOS_DEBUG |
|
||||||
cs incl num_pci_bios_get_irq_routing |
|
||||||
#endif |
|
||||||
/* function not supported */ |
|
||||||
movb $0x81, %ah |
|
||||||
jmp set_carry |
|
||||||
|
|
||||||
/*****************************************************************************/ |
|
||||||
|
|
||||||
pci_bios_set_irq: |
|
||||||
#ifdef PCI_BIOS_DEBUG |
|
||||||
cs incl num_pci_bios_set_irq |
|
||||||
#endif |
|
||||||
/* function not supported */ |
|
||||||
movb $0x81, %ah |
|
||||||
jmp set_carry |
|
||||||
|
|
||||||
/*****************************************************************************/ |
|
||||||
|
|
||||||
unknown_function: |
|
||||||
#ifdef PCI_BIOS_DEBUG |
|
||||||
cs incl num_pci_bios_unknown_function |
|
||||||
#endif |
|
||||||
/* function not supported */ |
|
||||||
movb $0x81, %ah |
|
||||||
jmp set_carry |
|
||||||
|
|
||||||
/*****************************************************************************/ |
|
||||||
|
|
||||||
pci_bios_select_register: |
|
||||||
gs movw OFFS_BX(%bp), %bx |
|
||||||
gs movw OFFS_DI(%bp), %ax |
|
||||||
/* destroys eax, dx */ |
|
||||||
__pci_bios_select_register: |
|
||||||
/* BX holds device id, AX holds register index */ |
|
||||||
pushl %ebx |
|
||||||
andl $0xfc, %eax |
|
||||||
andl $0xffff, %ebx |
|
||||||
shll $8, %ebx |
|
||||||
orl %ebx, %eax |
|
||||||
orl $0x80000000, %eax |
|
||||||
movw $0xcf8, %dx |
|
||||||
outl %eax, %dx |
|
||||||
popl %ebx |
|
||||||
ret |
|
||||||
|
|
||||||
|
|
||||||
clear_carry: |
|
||||||
gs movw OFFS_FLAGS(%bp), %ax |
|
||||||
|
|
||||||
/* clear carry -- function succeeded */ |
|
||||||
andw $0xfffe, %ax |
|
||||||
gs movw %ax, OFFS_FLAGS(%bp) |
|
||||||
xorw %ax, %ax |
|
||||||
gs movb %ah, OFFS_AH(%bp) |
|
||||||
ret |
|
||||||
|
|
||||||
set_carry: |
|
||||||
gs movb %ah, OFFS_AH(%bp) |
|
||||||
gs movw OFFS_FLAGS(%bp), %ax |
|
||||||
|
|
||||||
/* return carry -- function not supported */ |
|
||||||
orw $1, %ax |
|
||||||
gs movw %ax, OFFS_FLAGS(%bp) |
|
||||||
movw $-1, %ax |
|
||||||
ret |
|
||||||
|
|
||||||
/*****************************************************************************/ |
|
||||||
|
|
||||||
.globl pci_last_bus
|
|
||||||
pci_last_bus: |
|
||||||
.byte 0
|
|
||||||
|
|
||||||
#ifdef PCI_BIOS_DEBUG |
|
||||||
.globl num_pci_bios_present
|
|
||||||
num_pci_bios_present: |
|
||||||
.long 0
|
|
||||||
|
|
||||||
.globl num_pci_bios_find_device
|
|
||||||
num_pci_bios_find_device: |
|
||||||
.long 0
|
|
||||||
|
|
||||||
.globl num_pci_bios_find_class
|
|
||||||
num_pci_bios_find_class: |
|
||||||
.long 0
|
|
||||||
|
|
||||||
.globl num_pci_bios_generate_special_cycle
|
|
||||||
num_pci_bios_generate_special_cycle: |
|
||||||
.long 0
|
|
||||||
|
|
||||||
.globl num_pci_bios_read_cfg_byte
|
|
||||||
num_pci_bios_read_cfg_byte: |
|
||||||
.long 0
|
|
||||||
|
|
||||||
.globl num_pci_bios_read_cfg_word
|
|
||||||
num_pci_bios_read_cfg_word: |
|
||||||
.long 0
|
|
||||||
|
|
||||||
.globl num_pci_bios_read_cfg_dword
|
|
||||||
num_pci_bios_read_cfg_dword: |
|
||||||
.long 0
|
|
||||||
|
|
||||||
.globl num_pci_bios_write_cfg_byte
|
|
||||||
num_pci_bios_write_cfg_byte: |
|
||||||
.long 0
|
|
||||||
|
|
||||||
.globl num_pci_bios_write_cfg_word
|
|
||||||
num_pci_bios_write_cfg_word: |
|
||||||
.long 0
|
|
||||||
|
|
||||||
.globl num_pci_bios_write_cfg_dword
|
|
||||||
num_pci_bios_write_cfg_dword: |
|
||||||
.long 0
|
|
||||||
|
|
||||||
.globl num_pci_bios_get_irq_routing
|
|
||||||
num_pci_bios_get_irq_routing: |
|
||||||
.long 0
|
|
||||||
|
|
||||||
.globl num_pci_bios_set_irq
|
|
||||||
num_pci_bios_set_irq: |
|
||||||
.long 0
|
|
||||||
|
|
||||||
.globl num_pci_bios_unknown_function
|
|
||||||
num_pci_bios_unknown_function: |
|
||||||
.long 0
|
|
||||||
#endif |
|
||||||
@ -1,179 +0,0 @@ |
|||||||
/*
|
|
||||||
* (C) Copyright 2002 |
|
||||||
* Daniel Engström, Omicron Ceti AB, <daniel@omicron.se> |
|
||||||
* |
|
||||||
* See file CREDITS for list of people who contributed to this |
|
||||||
* project. |
|
||||||
* |
|
||||||
* This program is free software; you can redistribute it and/or |
|
||||||
* modify it under the terms of the GNU General Public License as |
|
||||||
* published by the Free Software Foundation; either version 2 of |
|
||||||
* the License, or (at your option) any later version. |
|
||||||
* |
|
||||||
* This program is distributed in the hope that it will be useful, |
|
||||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
||||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
||||||
* GNU General Public License for more details. |
|
||||||
* |
|
||||||
* You should have received a copy of the GNU General Public License |
|
||||||
* along with this program; if not, write to the Free Software |
|
||||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
|
||||||
* MA 02111-1307 USA |
|
||||||
*/ |
|
||||||
|
|
||||||
/*
|
|
||||||
* Partly based on msbios.c from rolo 1.6: |
|
||||||
*---------------------------------------------------------------------- |
|
||||||
* (C) Copyright 2000 |
|
||||||
* Sysgo Real-Time Solutions GmbH |
|
||||||
* Klein-Winternheim, Germany |
|
||||||
*---------------------------------------------------------------------- |
|
||||||
*/ |
|
||||||
|
|
||||||
#include <common.h> |
|
||||||
#include <pci.h> |
|
||||||
#include <asm/realmode.h> |
|
||||||
#include <asm/io.h> |
|
||||||
#include "bios.h" |
|
||||||
|
|
||||||
DECLARE_GLOBAL_DATA_PTR; |
|
||||||
|
|
||||||
#define NUMVECTS 256 |
|
||||||
|
|
||||||
static int set_jmp_vector(int entry_point, void *target) |
|
||||||
{ |
|
||||||
if (entry_point & ~0xffff) |
|
||||||
return -1; |
|
||||||
|
|
||||||
if (((u32)target - 0xf0000) & ~0xffff) |
|
||||||
return -1; |
|
||||||
|
|
||||||
printf("set_jmp_vector: 0xf000:%04x -> %p\n", |
|
||||||
entry_point, target); |
|
||||||
|
|
||||||
/* jmp opcode */ |
|
||||||
writeb(0xea, 0xf0000 + entry_point); |
|
||||||
|
|
||||||
/* offset */ |
|
||||||
writew(((u32)target-0xf0000), 0xf0000 + entry_point + 1); |
|
||||||
|
|
||||||
/* segment */ |
|
||||||
writew(0xf000, 0xf0000 + entry_point + 3); |
|
||||||
|
|
||||||
return 0; |
|
||||||
} |
|
||||||
|
|
||||||
/* Install an interrupt vector */ |
|
||||||
static void setvector(int vector, u16 segment, void *handler) |
|
||||||
{ |
|
||||||
u16 *ptr = (u16 *)(vector * 4); |
|
||||||
ptr[0] = ((u32)handler - (segment << 4)) & 0xffff; |
|
||||||
ptr[1] = segment; |
|
||||||
|
|
||||||
#if 0 |
|
||||||
printf("setvector: int%02x -> %04x:%04x\n", |
|
||||||
vector, ptr[1], ptr[0]); |
|
||||||
#endif |
|
||||||
} |
|
||||||
|
|
||||||
int bios_setup(void) |
|
||||||
{ |
|
||||||
/* The BIOS section is not relocated and still in the ROM. */ |
|
||||||
ulong bios_start = (ulong)&__bios_start; |
|
||||||
ulong bios_size = (ulong)&__bios_size; |
|
||||||
|
|
||||||
static int done; |
|
||||||
int vector; |
|
||||||
#ifdef CONFIG_PCI |
|
||||||
struct pci_controller *pri_hose; |
|
||||||
#endif |
|
||||||
if (done) |
|
||||||
return 0; |
|
||||||
|
|
||||||
done = 1; |
|
||||||
|
|
||||||
if (bios_size > 65536) { |
|
||||||
printf("BIOS too large (%ld bytes, max is 65536)\n", |
|
||||||
bios_size); |
|
||||||
return -1; |
|
||||||
} |
|
||||||
|
|
||||||
memcpy(BIOS_BASE, (void *)bios_start, bios_size); |
|
||||||
|
|
||||||
/* clear bda */ |
|
||||||
memset(BIOS_DATA, 0, BIOS_DATA_SIZE); |
|
||||||
|
|
||||||
/* enter some values to the bda */ |
|
||||||
writew(0x3f8, BIOS_DATA); /* com1 addr */ |
|
||||||
writew(0x2f8, BIOS_DATA+2); /* com2 addr */ |
|
||||||
writew(0x3e8, BIOS_DATA+4); /* com3 addr */ |
|
||||||
writew(0x2e8, BIOS_DATA+6); /* com4 addr */ |
|
||||||
writew(0x278, BIOS_DATA+8); /* lpt1 addr */ |
|
||||||
/*
|
|
||||||
* The kernel wants to read the base memory size |
|
||||||
* from 40:13. Put a zero there to avoid an error message |
|
||||||
*/ |
|
||||||
writew(0, BIOS_DATA+0x13); /* base memory size */ |
|
||||||
|
|
||||||
|
|
||||||
/* setup realmode interrupt vectors */ |
|
||||||
for (vector = 0; vector < NUMVECTS; vector++) |
|
||||||
setvector(vector, BIOS_CS, &rm_def_int); |
|
||||||
|
|
||||||
setvector(0x00, BIOS_CS, &rm_int00); |
|
||||||
setvector(0x01, BIOS_CS, &rm_int01); |
|
||||||
setvector(0x02, BIOS_CS, &rm_int02); |
|
||||||
setvector(0x03, BIOS_CS, &rm_int03); |
|
||||||
setvector(0x04, BIOS_CS, &rm_int04); |
|
||||||
setvector(0x05, BIOS_CS, &rm_int05); |
|
||||||
setvector(0x06, BIOS_CS, &rm_int06); |
|
||||||
setvector(0x07, BIOS_CS, &rm_int07); |
|
||||||
setvector(0x08, BIOS_CS, &rm_int08); |
|
||||||
setvector(0x09, BIOS_CS, &rm_int09); |
|
||||||
setvector(0x0a, BIOS_CS, &rm_int0a); |
|
||||||
setvector(0x0b, BIOS_CS, &rm_int0b); |
|
||||||
setvector(0x0c, BIOS_CS, &rm_int0c); |
|
||||||
setvector(0x0d, BIOS_CS, &rm_int0d); |
|
||||||
setvector(0x0e, BIOS_CS, &rm_int0e); |
|
||||||
setvector(0x0f, BIOS_CS, &rm_int0f); |
|
||||||
setvector(0x10, BIOS_CS, &rm_int10); |
|
||||||
setvector(0x11, BIOS_CS, &rm_int11); |
|
||||||
setvector(0x12, BIOS_CS, &rm_int12); |
|
||||||
setvector(0x13, BIOS_CS, &rm_int13); |
|
||||||
setvector(0x14, BIOS_CS, &rm_int14); |
|
||||||
setvector(0x15, BIOS_CS, &rm_int15); |
|
||||||
setvector(0x16, BIOS_CS, &rm_int16); |
|
||||||
setvector(0x17, BIOS_CS, &rm_int17); |
|
||||||
setvector(0x18, BIOS_CS, &rm_int18); |
|
||||||
setvector(0x19, BIOS_CS, &rm_int19); |
|
||||||
setvector(0x1a, BIOS_CS, &rm_int1a); |
|
||||||
setvector(0x1b, BIOS_CS, &rm_int1b); |
|
||||||
setvector(0x1c, BIOS_CS, &rm_int1c); |
|
||||||
setvector(0x1d, BIOS_CS, &rm_int1d); |
|
||||||
setvector(0x1e, BIOS_CS, &rm_int1e); |
|
||||||
setvector(0x1f, BIOS_CS, &rm_int1f); |
|
||||||
|
|
||||||
set_jmp_vector(0xfff0, &realmode_reset); |
|
||||||
set_jmp_vector(0xfe6e, &realmode_pci_bios_call_entry); |
|
||||||
|
|
||||||
/* fill in data area */ |
|
||||||
RELOC_16_WORD(0xf000, ram_in_64kb_chunks) = gd->ram_size >> 16; |
|
||||||
RELOC_16_WORD(0xf000, bios_equipment) = 0; /* FixMe */ |
|
||||||
|
|
||||||
/* If we assume only one PCI hose, this PCI hose
|
|
||||||
* will own PCI bus #0, and the last PCI bus of |
|
||||||
* that PCI hose will be the last PCI bus in the |
|
||||||
* system. |
|
||||||
* (This, ofcause break on multi hose systems, |
|
||||||
* but our PCI BIOS only support one hose anyway) |
|
||||||
*/ |
|
||||||
#ifdef CONFIG_PCI |
|
||||||
pri_hose = pci_bus_to_hose(0); |
|
||||||
if (NULL != pri_hose) { |
|
||||||
/* fill in last pci bus number for use by the realmode
|
|
||||||
* PCI BIOS */ |
|
||||||
RELOC_16_BYTE(0xf000, pci_last_bus) = pri_hose->last_busno; |
|
||||||
} |
|
||||||
#endif |
|
||||||
return 0; |
|
||||||
} |
|
||||||
@ -1,93 +0,0 @@ |
|||||||
/*
|
|
||||||
* (C) Copyright 2002 |
|
||||||
* Daniel Engström, Omicron Ceti AB, <daniel@omicron.se> |
|
||||||
* |
|
||||||
* See file CREDITS for list of people who contributed to this |
|
||||||
* project. |
|
||||||
* |
|
||||||
* This program is free software; you can redistribute it and/or |
|
||||||
* modify it under the terms of the GNU General Public License as |
|
||||||
* published by the Free Software Foundation; either version 2 of |
|
||||||
* the License, or (at your option) any later version. |
|
||||||
* |
|
||||||
* This program is distributed in the hope that it will be useful, |
|
||||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
||||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
||||||
* GNU General Public License for more details. |
|
||||||
* |
|
||||||
* You should have received a copy of the GNU General Public License |
|
||||||
* along with this program; if not, write to the Free Software |
|
||||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
|
||||||
* MA 02111-1307 USA |
|
||||||
*/ |
|
||||||
|
|
||||||
#include <common.h> |
|
||||||
#include <asm/io.h> |
|
||||||
#include <asm/ptrace.h> |
|
||||||
#include <asm/realmode.h> |
|
||||||
|
|
||||||
#define REALMODE_MAILBOX ((char *)0xe00) |
|
||||||
|
|
||||||
int realmode_setup(void) |
|
||||||
{ |
|
||||||
/* The realmode section is not relocated and still in the ROM. */ |
|
||||||
ulong realmode_start = (ulong)&__realmode_start; |
|
||||||
ulong realmode_size = (ulong)&__realmode_size; |
|
||||||
|
|
||||||
/* copy the realmode switch code */ |
|
||||||
if (realmode_size > (REALMODE_MAILBOX - (char *)REALMODE_BASE)) { |
|
||||||
printf("realmode switch too large (%ld bytes, max is %d)\n", |
|
||||||
realmode_size, |
|
||||||
(int)(REALMODE_MAILBOX - (char *)REALMODE_BASE)); |
|
||||||
return -1; |
|
||||||
} |
|
||||||
|
|
||||||
memcpy((char *)REALMODE_BASE, (void *)realmode_start, realmode_size); |
|
||||||
asm("wbinvd\n"); |
|
||||||
|
|
||||||
return 0; |
|
||||||
} |
|
||||||
|
|
||||||
int enter_realmode(u16 seg, u16 off, struct pt_regs *in, struct pt_regs *out) |
|
||||||
{ |
|
||||||
|
|
||||||
/* setup out thin bios emulation */ |
|
||||||
if (bios_setup()) |
|
||||||
return -1; |
|
||||||
|
|
||||||
if (realmode_setup()) |
|
||||||
return -1; |
|
||||||
|
|
||||||
in->eip = off; |
|
||||||
in->xcs = seg; |
|
||||||
if ((in->esp & 0xffff) < 4) |
|
||||||
printf("Warning: entering realmode with sp < 4 will fail\n"); |
|
||||||
|
|
||||||
memcpy(REALMODE_MAILBOX, in, sizeof(struct pt_regs)); |
|
||||||
asm("wbinvd\n"); |
|
||||||
|
|
||||||
__asm__ volatile ( |
|
||||||
"lcall $0x20,%0\n" : : "i" (&realmode_enter)); |
|
||||||
|
|
||||||
asm("wbinvd\n"); |
|
||||||
memcpy(out, REALMODE_MAILBOX, sizeof(struct pt_regs)); |
|
||||||
|
|
||||||
return out->eax; |
|
||||||
} |
|
||||||
|
|
||||||
/*
|
|
||||||
* This code is supposed to access a realmode interrupt |
|
||||||
* it does currently not work for me |
|
||||||
*/ |
|
||||||
int enter_realmode_int(u8 lvl, struct pt_regs *in, struct pt_regs *out) |
|
||||||
{ |
|
||||||
/* place two instructions at 0x700 */ |
|
||||||
writeb(0xcd, 0x700); /* int $lvl */ |
|
||||||
writeb(lvl, 0x701); |
|
||||||
writeb(0xcb, 0x702); /* lret */ |
|
||||||
asm("wbinvd\n"); |
|
||||||
|
|
||||||
enter_realmode(0x00, 0x700, in, out); |
|
||||||
|
|
||||||
return out->eflags & 0x00000001; |
|
||||||
} |
|
||||||
@ -1,232 +0,0 @@ |
|||||||
/* |
|
||||||
* (C) Copyright 2002 |
|
||||||
* Daniel Engström, Omicron Ceti AB, daniel@omicron.se
|
|
||||||
* |
|
||||||
* See file CREDITS for list of people who contributed to this |
|
||||||
* project. |
|
||||||
* |
|
||||||
* This program is free software; you can redistribute it and/or
|
|
||||||
* modify it under the terms of the GNU General Public License as |
|
||||||
* published by the Free Software Foundation; either version 2 of
|
|
||||||
* the License, or (at your option) any later version. |
|
||||||
* |
|
||||||
* This program is distributed in the hope that it will be useful, |
|
||||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
||||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
||||||
* GNU General Public License for more details. |
|
||||||
* |
|
||||||
* You should have received a copy of the GNU General Public License |
|
||||||
* along with this program; if not, write to the Free Software
|
|
||||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
|
||||||
* MA 02111-1307 USA |
|
||||||
*/ |
|
||||||
|
|
||||||
/* 32bit -> 16bit -> 32bit mode switch code */ |
|
||||||
|
|
||||||
/* |
|
||||||
* Stack frame at 0xe00 |
|
||||||
* e00 ebx;
|
|
||||||
* e04 ecx;
|
|
||||||
* e08 edx;
|
|
||||||
* e0c esi;
|
|
||||||
* e10 edi;
|
|
||||||
* e14 ebp;
|
|
||||||
* e18 eax;
|
|
||||||
* e1c ds;
|
|
||||||
* e20 es;
|
|
||||||
* e24 fs;
|
|
||||||
* e28 gs;
|
|
||||||
* e2c orig_eax;
|
|
||||||
* e30 eip;
|
|
||||||
* e34 cs;
|
|
||||||
* e38 eflags;
|
|
||||||
* e3c esp;
|
|
||||||
* e40 ss;
|
|
||||||
*/ |
|
||||||
|
|
||||||
#define a32 .byte 0x67; /* address size prefix 32 */
|
|
||||||
#define o32 .byte 0x66; /* operand size prefix 32 */
|
|
||||||
|
|
||||||
.section .realmode, "ax" |
|
||||||
.code16 |
|
||||||
|
|
||||||
/* 16bit protected mode code here */ |
|
||||||
.globl realmode_enter
|
|
||||||
realmode_enter: |
|
||||||
o32 pusha |
|
||||||
o32 pushf |
|
||||||
cli |
|
||||||
sidt saved_idt |
|
||||||
sgdt saved_gdt |
|
||||||
movl %esp, %eax |
|
||||||
movl %eax, saved_protected_mode_esp |
|
||||||
|
|
||||||
movl $0x10, %eax |
|
||||||
movl %eax, %esp |
|
||||||
movw $0x28, %ax |
|
||||||
movw %ax, %ds |
|
||||||
movw %ax, %es |
|
||||||
movw %ax, %fs |
|
||||||
movw %ax, %gs |
|
||||||
|
|
||||||
lidt realmode_idt_ptr |
|
||||||
/* Go back into real mode by clearing PE to 0 */ |
|
||||||
movl %cr0, %eax |
|
||||||
andl $0x7ffffffe, %eax |
|
||||||
movl %eax, %cr0 |
|
||||||
|
|
||||||
/* switch to real mode */ |
|
||||||
ljmp $0x0,$do_realmode |
|
||||||
|
|
||||||
do_realmode: |
|
||||||
/* realmode code from here */ |
|
||||||
movw %cs,%ax |
|
||||||
movw %ax,%ds |
|
||||||
movw %ax,%es |
|
||||||
movw %ax,%fs |
|
||||||
movw %ax,%gs |
|
||||||
|
|
||||||
/* create a temporary stack */ |
|
||||||
movw $0xc0, %ax |
|
||||||
movw %ax, %ss |
|
||||||
movw $0x200, %ax |
|
||||||
movw %ax, %sp |
|
||||||
|
|
||||||
popl %ebx |
|
||||||
popl %ecx |
|
||||||
popl %edx |
|
||||||
popl %esi |
|
||||||
popl %edi |
|
||||||
popl %ebp |
|
||||||
popl %eax |
|
||||||
movl %eax, temp_eax |
|
||||||
popl %eax |
|
||||||
movw %ax, %ds |
|
||||||
popl %eax |
|
||||||
movw %ax, %es |
|
||||||
popl %eax |
|
||||||
movw %ax, %fs |
|
||||||
popl %eax |
|
||||||
movw %ax, %gs |
|
||||||
popl %eax /* orig_eax */ |
|
||||||
popl %eax |
|
||||||
cs movw %ax, temp_ip |
|
||||||
popl %eax |
|
||||||
cs movw %ax, temp_cs |
|
||||||
o32 popf |
|
||||||
popl %eax |
|
||||||
popw %ss |
|
||||||
movl %eax, %esp |
|
||||||
cs movl temp_eax, %eax |
|
||||||
|
|
||||||
/* self-modifying code, better flush the cache */ |
|
||||||
wbinvd |
|
||||||
|
|
||||||
.byte 0x9a /* lcall */ |
|
||||||
temp_ip: |
|
||||||
.word 0 /* new ip */ |
|
||||||
temp_cs: |
|
||||||
.word 0 /* new cs */ |
|
||||||
|
|
||||||
realmode_ret: |
|
||||||
/* save eax, esp and ss */ |
|
||||||
cs movl %eax, saved_eax |
|
||||||
movl %esp, %eax |
|
||||||
cs movl %eax, saved_esp |
|
||||||
movw %ss, %ax |
|
||||||
cs movw %ax, saved_ss |
|
||||||
|
|
||||||
/* |
|
||||||
* restore the stack, note that we set sp to 0x244;
|
|
||||||
* pt_regs is 0x44 bytes long and we push the structure |
|
||||||
* backwards on to the stack, bottom first |
|
||||||
*/ |
|
||||||
movw $0xc0, %ax |
|
||||||
movw %ax, %ss |
|
||||||
movw $0x244, %ax |
|
||||||
movw %ax, %sp |
|
||||||
|
|
||||||
xorl %eax,%eax |
|
||||||
cs movw saved_ss, %ax |
|
||||||
pushl %eax |
|
||||||
cs movl saved_esp, %eax |
|
||||||
pushl %eax |
|
||||||
o32 pushf |
|
||||||
xorl %eax,%eax |
|
||||||
cs movw temp_cs, %ax |
|
||||||
pushl %eax |
|
||||||
cs movw temp_ip, %ax |
|
||||||
pushl %eax |
|
||||||
pushl $0 |
|
||||||
movw %gs, %ax |
|
||||||
pushl %eax |
|
||||||
movw %fs, %ax |
|
||||||
pushl %eax |
|
||||||
movw %es, %ax |
|
||||||
pushl %eax |
|
||||||
movw %ds, %ax |
|
||||||
pushl %eax |
|
||||||
movl saved_eax, %eax |
|
||||||
pushl %eax |
|
||||||
pushl %ebp |
|
||||||
pushl %edi |
|
||||||
pushl %esi |
|
||||||
pushl %edx |
|
||||||
pushl %ecx |
|
||||||
pushl %ebx |
|
||||||
|
|
||||||
o32 cs lidt saved_idt |
|
||||||
o32 cs lgdt saved_gdt |
|
||||||
|
|
||||||
/* Go back into protected mode reset PE to 1 */ |
|
||||||
movl %cr0, %eax |
|
||||||
orl $1,%eax |
|
||||||
movl %eax, %cr0 |
|
||||||
|
|
||||||
/* flush prefetch queue */ |
|
||||||
jmp next_line |
|
||||||
next_line: |
|
||||||
movw $return_ptr, %ax |
|
||||||
movw %ax,%bp |
|
||||||
o32 cs ljmp *(%bp) |
|
||||||
|
|
||||||
.code32 |
|
||||||
protected_mode: |
|
||||||
/* Reload segment registers */ |
|
||||||
movl $0x18, %eax |
|
||||||
movw %ax, %fs |
|
||||||
movw %ax, %ds |
|
||||||
movw %ax, %gs |
|
||||||
movw %ax, %es |
|
||||||
movw %ax, %ss |
|
||||||
movl saved_protected_mode_esp, %eax |
|
||||||
movl %eax, %esp |
|
||||||
popf |
|
||||||
popa |
|
||||||
ret |
|
||||||
|
|
||||||
temp_eax: |
|
||||||
.long 0
|
|
||||||
|
|
||||||
saved_ss: |
|
||||||
.word 0
|
|
||||||
saved_esp: |
|
||||||
.long 0
|
|
||||||
saved_eax: |
|
||||||
.long 0
|
|
||||||
|
|
||||||
realmode_idt_ptr: |
|
||||||
.word 0x400
|
|
||||||
.word 0x0, 0x0 |
|
||||||
|
|
||||||
saved_gdt: |
|
||||||
.word 0, 0, 0, 0 |
|
||||||
saved_idt: |
|
||||||
.word 0, 0, 0, 0 |
|
||||||
|
|
||||||
saved_protected_mode_esp: |
|
||||||
.long 0
|
|
||||||
|
|
||||||
return_ptr: |
|
||||||
.long protected_mode
|
|
||||||
.word 0x10
|
|
||||||
@ -1,196 +0,0 @@ |
|||||||
/*
|
|
||||||
* (C) Copyright 2002 |
|
||||||
* Daniel Engström, Omicron Ceti AB, <daniel@omicron.se> |
|
||||||
* |
|
||||||
* See file CREDITS for list of people who contributed to this |
|
||||||
* project. |
|
||||||
* |
|
||||||
* This program is free software; you can redistribute it and/or |
|
||||||
* modify it under the terms of the GNU General Public License as |
|
||||||
* published by the Free Software Foundation; either version 2 of |
|
||||||
* the License, or (at your option) any later version. |
|
||||||
* |
|
||||||
* This program is distributed in the hope that it will be useful, |
|
||||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
||||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
||||||
* GNU General Public License for more details. |
|
||||||
* |
|
||||||
* You should have received a copy of the GNU General Public License |
|
||||||
* along with this program; if not, write to the Free Software |
|
||||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
|
||||||
* MA 02111-1307 USA |
|
||||||
*/ |
|
||||||
|
|
||||||
#include <common.h> |
|
||||||
#include <pci.h> |
|
||||||
#include <malloc.h> |
|
||||||
#include <asm/ptrace.h> |
|
||||||
#include <asm/realmode.h> |
|
||||||
#include <asm/io.h> |
|
||||||
#include <asm/pci.h> |
|
||||||
#include "bios.h" |
|
||||||
|
|
||||||
#undef PCI_BIOS_DEBUG |
|
||||||
#undef VGA_BIOS_DEBUG |
|
||||||
|
|
||||||
#ifdef VGA_BIOS_DEBUG |
|
||||||
#define PRINTF(fmt, args...) printf(fmt, ##args) |
|
||||||
#else |
|
||||||
#define PRINTF(fmt, args...) |
|
||||||
#endif |
|
||||||
|
|
||||||
#define PCI_CLASS_VIDEO 3 |
|
||||||
#define PCI_CLASS_VIDEO_STD 0 |
|
||||||
#define PCI_CLASS_VIDEO_PROG_IF_VGA 0 |
|
||||||
|
|
||||||
DEFINE_PCI_DEVICE_TABLE(supported) = { |
|
||||||
{PCI_VIDEO_VENDOR_ID, PCI_VIDEO_DEVICE_ID}, |
|
||||||
{} |
|
||||||
}; |
|
||||||
|
|
||||||
static u32 probe_pci_video(void) |
|
||||||
{ |
|
||||||
struct pci_controller *hose; |
|
||||||
pci_dev_t devbusfn = pci_find_devices(supported, 0); |
|
||||||
|
|
||||||
if ((devbusfn != -1)) { |
|
||||||
u32 old; |
|
||||||
u32 addr; |
|
||||||
|
|
||||||
/* PCI video device detected */ |
|
||||||
printf("Found PCI VGA device at %02x.%02x.%x\n", |
|
||||||
PCI_BUS(devbusfn), |
|
||||||
PCI_DEV(devbusfn), |
|
||||||
PCI_FUNC(devbusfn)); |
|
||||||
|
|
||||||
/* Enable I/O decoding as well, PCI viudeo boards
|
|
||||||
* support I/O accesses, but they provide no |
|
||||||
* bar register for this since the ports are fixed. |
|
||||||
*/ |
|
||||||
pci_write_config_word(devbusfn, |
|
||||||
PCI_COMMAND, |
|
||||||
PCI_COMMAND_MEMORY | |
|
||||||
PCI_COMMAND_IO | |
|
||||||
PCI_COMMAND_MASTER); |
|
||||||
|
|
||||||
/* Test the ROM decoder, do the device support a rom? */ |
|
||||||
pci_read_config_dword(devbusfn, PCI_ROM_ADDRESS, &old); |
|
||||||
pci_write_config_dword(devbusfn, PCI_ROM_ADDRESS, |
|
||||||
(u32)PCI_ROM_ADDRESS_MASK); |
|
||||||
pci_read_config_dword(devbusfn, PCI_ROM_ADDRESS, &addr); |
|
||||||
pci_write_config_dword(devbusfn, PCI_ROM_ADDRESS, old); |
|
||||||
|
|
||||||
if (!addr) { |
|
||||||
printf("PCI VGA have no ROM?\n"); |
|
||||||
return 0; |
|
||||||
} |
|
||||||
|
|
||||||
/* device have a rom */ |
|
||||||
if (pci_shadow_rom(devbusfn, (void *)0xc0000)) { |
|
||||||
printf("Shadowing of PCI VGA BIOS failed\n"); |
|
||||||
return 0; |
|
||||||
} |
|
||||||
|
|
||||||
/* Now enable lagacy VGA port access */ |
|
||||||
hose = pci_bus_to_hose(PCI_BUS(devbusfn)); |
|
||||||
if (pci_enable_legacy_video_ports(hose)) { |
|
||||||
printf("PCI VGA enable failed\n"); |
|
||||||
return 0; |
|
||||||
} |
|
||||||
|
|
||||||
|
|
||||||
/* return the pci device info, that we'll need later */ |
|
||||||
return PCI_BUS(devbusfn) << 8 | |
|
||||||
PCI_DEV(devbusfn) << 3 | (PCI_FUNC(devbusfn) & 7); |
|
||||||
} |
|
||||||
|
|
||||||
return 0; |
|
||||||
} |
|
||||||
|
|
||||||
static int probe_isa_video(void) |
|
||||||
{ |
|
||||||
u32 ptr; |
|
||||||
char *buf; |
|
||||||
|
|
||||||
ptr = isa_map_rom(0xc0000, 0x8000); |
|
||||||
|
|
||||||
if (!ptr) |
|
||||||
return -1; |
|
||||||
|
|
||||||
buf = malloc(0x8000); |
|
||||||
if (!buf) { |
|
||||||
isa_unmap_rom(ptr); |
|
||||||
return -1; |
|
||||||
} |
|
||||||
|
|
||||||
if (readw(ptr) != 0xaa55) { |
|
||||||
free(buf); |
|
||||||
isa_unmap_rom(ptr); |
|
||||||
return -1; |
|
||||||
} |
|
||||||
|
|
||||||
/* shadow the rom */ |
|
||||||
memcpy(buf, (void *)ptr, 0x8000); |
|
||||||
isa_unmap_rom(ptr); |
|
||||||
memcpy((void *)0xc0000, buf, 0x8000); |
|
||||||
|
|
||||||
free(buf); |
|
||||||
|
|
||||||
return 0; |
|
||||||
} |
|
||||||
|
|
||||||
int video_bios_init(void) |
|
||||||
{ |
|
||||||
struct pt_regs regs; |
|
||||||
int size; |
|
||||||
int i; |
|
||||||
u8 sum; |
|
||||||
|
|
||||||
/* clear the video bios area in case we warmbooted */ |
|
||||||
memset((void *)0xc0000, 0, 0x8000); |
|
||||||
memset(®s, 0, sizeof(struct pt_regs)); |
|
||||||
|
|
||||||
if (probe_isa_video()) |
|
||||||
/* No ISA board found, try the PCI bus */ |
|
||||||
regs.eax = probe_pci_video(); |
|
||||||
|
|
||||||
/* Did we succeed in mapping any video bios */ |
|
||||||
if (readw(0xc0000) == 0xaa55) { |
|
||||||
PRINTF("Found video bios signature\n"); |
|
||||||
size = readb(0xc0002) * 512; |
|
||||||
PRINTF("size %d\n", size); |
|
||||||
sum = 0; |
|
||||||
|
|
||||||
for (i = 0; i < size; i++) |
|
||||||
sum += readb(0xc0000 + i); |
|
||||||
|
|
||||||
PRINTF("Checksum is %sOK\n", sum ? "NOT " : ""); |
|
||||||
|
|
||||||
if (sum) |
|
||||||
return 1; |
|
||||||
|
|
||||||
/*
|
|
||||||
* Some video bioses (ATI Mach64) seem to think that |
|
||||||
* the original int 10 handler is always at |
|
||||||
* 0xf000:0xf065 , place an iret instruction there |
|
||||||
*/ |
|
||||||
writeb(0xcf, 0xff065); |
|
||||||
|
|
||||||
regs.esp = 0x8000; |
|
||||||
regs.xss = 0x2000; |
|
||||||
enter_realmode(0xc000, 3, ®s, ®s); |
|
||||||
|
|
||||||
PRINTF("INT 0x10 vector after: %04x:%04x\n", |
|
||||||
readw(0x42), readw(0x40)); |
|
||||||
PRINTF("BIOS returned %scarry\n", |
|
||||||
regs.eflags & 0x00000001 ? "" : "NOT "); |
|
||||||
#ifdef PCI_BIOS_DEBUG |
|
||||||
print_bios_bios_stat(); |
|
||||||
#endif |
|
||||||
return regs.eflags & 0x00000001; |
|
||||||
|
|
||||||
} |
|
||||||
|
|
||||||
return 1; |
|
||||||
|
|
||||||
} |
|
||||||
Loading…
Reference in new issue