add extended regs support in bios_interrupt

This commit is contained in:
Vladimir 'phcoder' Serbinenko 2010-01-17 21:16:05 +01:00
parent eb3f57d3c4
commit 1453b2ec7f
3 changed files with 97 additions and 72 deletions

View file

@ -33,29 +33,29 @@ static int grub_biosdisk_rw_int13_extensions (int ah, int drive, void *dap);
static int grub_biosdisk_get_num_floppies (void) static int grub_biosdisk_get_num_floppies (void)
{ {
struct grub_cpu_int_registers regs; struct grub_bios_int_registers regs;
int drive; int drive;
/* reset the disk system first */ /* reset the disk system first */
regs.ax = 0; regs.eax = 0;
regs.dx = 0; regs.edx = 0;
regs.flags = GRUB_CPU_INT_FLAGS_DEFAULT; regs.flags = GRUB_CPU_INT_FLAGS_DEFAULT;
grub_cpu_interrupt (0x13, &regs); grub_bios_interrupt (0x13, &regs);
for (drive = 0; drive < 2; drive++) for (drive = 0; drive < 2; drive++)
{ {
regs.flags = GRUB_CPU_INT_FLAGS_DEFAULT | GRUB_CPU_INT_FLAGS_CARRY; regs.flags = GRUB_CPU_INT_FLAGS_DEFAULT | GRUB_CPU_INT_FLAGS_CARRY;
regs.dx = drive; regs.edx = drive;
/* call GET DISK TYPE */ /* call GET DISK TYPE */
regs.ax = 0x1500; regs.eax = 0x1500;
grub_cpu_interrupt (0x13, &regs); grub_bios_interrupt (0x13, &regs);
if (regs.flags & GRUB_CPU_INT_FLAGS_CARRY) if (regs.flags & GRUB_CPU_INT_FLAGS_CARRY)
break; break;
/* check if this drive exists */ /* check if this drive exists */
if (!(regs.ax & 0x300)) if (!(regs.eax & 0x300))
break; break;
} }
@ -71,16 +71,16 @@ static int grub_biosdisk_get_num_floppies (void)
static int static int
grub_biosdisk_rw_int13_extensions (int ah, int drive, void *dap) grub_biosdisk_rw_int13_extensions (int ah, int drive, void *dap)
{ {
struct grub_cpu_int_registers regs; struct grub_bios_int_registers regs;
regs.ax = ah << 8; regs.eax = ah << 8;
/* compute the address of disk_address_packet */ /* compute the address of disk_address_packet */
regs.ds = (((grub_addr_t) dap) & 0xffff0000) >> 4; regs.ds = (((grub_addr_t) dap) & 0xffff0000) >> 4;
regs.si = (((grub_addr_t) dap) & 0xffff); regs.esi = (((grub_addr_t) dap) & 0xffff);
regs.dx = drive; regs.edx = drive;
regs.flags = GRUB_CPU_INT_FLAGS_DEFAULT; regs.flags = GRUB_CPU_INT_FLAGS_DEFAULT;
grub_cpu_interrupt (0x13, &regs); grub_bios_interrupt (0x13, &regs);
return regs.ax >> 8; return (regs.eax >> 8) & 0xff;
} }
static int static int

View file

@ -21,17 +21,18 @@
#include <grub/symbol.h> #include <grub/symbol.h>
struct grub_cpu_int_registers struct grub_bios_int_registers
{ {
grub_uint16_t bx; grub_uint32_t eax;
grub_uint16_t es; grub_uint16_t es;
grub_uint16_t cx;
grub_uint16_t ax;
grub_uint16_t dx;
grub_uint16_t ds; grub_uint16_t ds;
grub_uint16_t di;
grub_uint16_t flags; grub_uint16_t flags;
grub_uint16_t si; grub_uint16_t dummy;
grub_uint32_t ebx;
grub_uint32_t ecx;
grub_uint32_t edi;
grub_uint32_t esi;
grub_uint32_t edx;
}; };
#define GRUB_CPU_INT_FLAGS_CARRY 0x1 #define GRUB_CPU_INT_FLAGS_CARRY 0x1
@ -45,6 +46,7 @@ struct grub_cpu_int_registers
#define GRUB_CPU_INT_FLAGS_OVERFLOW 0x800 #define GRUB_CPU_INT_FLAGS_OVERFLOW 0x800
#define GRUB_CPU_INT_FLAGS_DEFAULT GRUB_CPU_INT_FLAGS_INTERRUPT #define GRUB_CPU_INT_FLAGS_DEFAULT GRUB_CPU_INT_FLAGS_INTERRUPT
void EXPORT_FUNC (grub_cpu_interrupt) (grub_uint8_t intno, struct grub_cpu_int_registers *regs); void EXPORT_FUNC (grub_bios_interrupt) (grub_uint8_t intno,
struct grub_bios_int_registers *regs);
#endif #endif

View file

@ -2068,73 +2068,96 @@ FUNCTION(grub_pxe_call)
popl %ebp popl %ebp
ret ret
FUNCTION(grub_cpu_interrupt) FUNCTION(grub_bios_interrupt)
pushl %ebp pushl %ebp
pushl %esi pushl %ecx
pushl %edi pushl %eax
pushl %ebx
pushl %edx pushl %edx
movb %al, intno
movl %edx, %esi
movl 0(%esi), %ebx movb %al, intno
movl 4(%esi), %ecx movl (%edx), %eax
movl 8(%esi), %edx movl %eax, LOCAL(bios_register_eax)
movl 12(%esi), %edi movw 4(%edx), %ax
movw 16(%esi), %si movw %ax, LOCAL(bios_register_es)
movw 6(%edx), %ax
movw %ax, LOCAL(bios_register_ds)
movw 8(%edx), %ax
movw %ax, LOCAL(bios_register_flags)
movl 12(%edx), %ebx
movl 16(%edx), %ecx
movl 20(%edx), %edi
movl 24(%edx), %esi
movl 28(%edx), %edx
call prot_to_real call prot_to_real
.code16 .code16
movl %edi, %eax
shrl $16, %eax
push %ax
movl %ebx, %eax mov %ds, %ax
shrl $16, %eax push %ax
movw %ax, %es
movl %edx, %eax /* movw imm16, %ax*/
shrl $16, %eax .byte 0xb8
movw %ax, %ds LOCAL(bios_register_es):
.short 0
movl %ecx, %eax movw %ax, %es
shrl $16, %eax /* movw imm16, %ax*/
.byte 0xb8
LOCAL(bios_register_ds):
.short 0
movw %ax, %ds
/* movw imm16, %ax*/
.byte 0xb8
LOCAL(bios_register_flags):
.short 0
push %ax
popf popf
/* movl imm32, %eax*/
.byte 0x66, 0xb8
LOCAL(bios_register_eax):
.long 0
/* int imm8. */
.byte 0xcd .byte 0xcd
intno: intno:
.byte 0 .byte 0
movl %eax, %cs:LOCAL(bios_register_eax)
movw %ds, %ax
movw %ax, %cs:LOCAL(bios_register_ds)
pop %ax
mov %ax, %ds
pushf pushf
andl $0xffff, %ebx pop %ax
andl $0xffff, %ecx movw %ax, LOCAL(bios_register_flags)
andl $0xffff, %edx mov %es, %ax
andl $0xffff, %edi movw %ax, LOCAL(bios_register_es)
shll $16, %eax
orl %eax, %ecx
movw %ds, %ax
shll $16, %eax
orl %eax, %edx
pop %ax
shll $16, %eax
orl %eax, %edi
DATA32 call real_to_prot DATA32 call real_to_prot
.code32 .code32
pushl %esi
movl 4(%esp), %esi popl %eax
movl %ebx, 0(%esi)
movl %ecx, 4(%esi) movl %ebx, 12(%eax)
movl %edx, 8(%esi) movl %ecx, 16(%eax)
movl %edi, 12(%esi) movl %edi, 20(%eax)
popl %eax movl %esi, 24(%eax)
movw %ax, 16(%esi) movl %edx, 28(%eax)
popl %eax
popl %ebx movl %eax, %edx
popl %edi
popl %esi movl LOCAL(bios_register_eax), %eax
popl %ebp movl %eax, (%edx)
movw LOCAL(bios_register_es), %ax
movw %ax, 4(%edx)
movw LOCAL(bios_register_ds), %ax
movw %ax, 6(%edx)
movw LOCAL(bios_register_flags), %ax
movw %ax, 8(%edx)
popl %eax
popl %ecx
popl %ebp
ret ret