Unify and macroify some code in x86 relocators
This commit is contained in:
parent
2a1d16154d
commit
a797a26ee8
4 changed files with 114 additions and 154 deletions
|
@ -15,18 +15,7 @@
|
||||||
* You should have received a copy of the GNU General Public License
|
* You should have received a copy of the GNU General Public License
|
||||||
* along with GRUB. If not, see <http://www.gnu.org/licenses/>.
|
* along with GRUB. If not, see <http://www.gnu.org/licenses/>.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <grub/symbol.h>
|
|
||||||
#include <grub/i386/memory.h>
|
|
||||||
|
|
||||||
#ifdef __x86_64__
|
|
||||||
#define RAX %rax
|
|
||||||
#define RSI %rsi
|
|
||||||
#else
|
|
||||||
#define RAX %eax
|
|
||||||
#define RSI %esi
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/* The code segment of the protected mode. */
|
/* The code segment of the protected mode. */
|
||||||
#define CODE_SEGMENT 0x08
|
#define CODE_SEGMENT 0x08
|
||||||
|
|
||||||
|
@ -37,50 +26,41 @@
|
||||||
|
|
||||||
#define PSEUDO_REAL_DSEG 0x20
|
#define PSEUDO_REAL_DSEG 0x20
|
||||||
|
|
||||||
|
#include "relocator_common.S"
|
||||||
|
|
||||||
.p2align 4 /* force 16-byte alignment */
|
.p2align 4 /* force 16-byte alignment */
|
||||||
|
|
||||||
VARIABLE(grub_relocator16_start)
|
VARIABLE(grub_relocator16_start)
|
||||||
LOCAL(base):
|
PREAMBLE
|
||||||
/* %rax contains now our new 'base'. */
|
|
||||||
mov RAX, RSI
|
|
||||||
add $(LOCAL(cont0) - LOCAL(base)), RAX
|
|
||||||
jmp *RAX
|
|
||||||
LOCAL(cont0):
|
|
||||||
lea (LOCAL(cont1) - LOCAL(base)) (RSI, 1), RAX
|
|
||||||
movl %eax, (LOCAL(jump_vector) - LOCAL(base)) (RSI, 1)
|
|
||||||
|
|
||||||
lea (LOCAL(gdt) - LOCAL(base)) (RSI, 1), RAX
|
|
||||||
mov RAX, (LOCAL(gdt_addr) - LOCAL(base)) (RSI, 1)
|
|
||||||
|
|
||||||
movl %esi, %eax
|
movl %esi, %eax
|
||||||
movw %ax, (LOCAL (cs_base_bytes12) - LOCAL (base)) (RSI, 1)
|
movw %ax, (LOCAL (cs_base_bytes12) - LOCAL (base)) (RSI, 1)
|
||||||
shrl $16, %eax
|
shrl $16, %eax
|
||||||
movb %al, (LOCAL (cs_base_byte3) - LOCAL (base)) (RSI, 1)
|
movb %al, (LOCAL (cs_base_byte3) - LOCAL (base)) (RSI, 1)
|
||||||
|
|
||||||
/* Switch to compatibility mode. */
|
RELOAD_GDT
|
||||||
|
|
||||||
lgdt (LOCAL(gdtdesc) - LOCAL(base)) (RSI, 1)
|
|
||||||
|
|
||||||
/* Update %cs. */
|
|
||||||
ljmp *(LOCAL(jump_vector) - LOCAL(base)) (RSI, 1)
|
|
||||||
|
|
||||||
LOCAL(cont1):
|
|
||||||
.code32
|
.code32
|
||||||
|
/* Update other registers. */
|
||||||
|
movl $DATA_SEGMENT, %eax
|
||||||
|
movl %eax, %ds
|
||||||
|
movl %eax, %es
|
||||||
|
movl %eax, %fs
|
||||||
|
movl %eax, %gs
|
||||||
|
movl %eax, %ss
|
||||||
|
|
||||||
/* Disable paging. */
|
DISABLE_PAGING
|
||||||
movl %cr0, %eax
|
|
||||||
andl $(~GRUB_MEMORY_CPU_CR0_PAGING_ON), %eax
|
|
||||||
movl %eax, %cr0
|
|
||||||
|
|
||||||
|
#ifdef __x86_64__
|
||||||
/* Disable amd64. */
|
/* Disable amd64. */
|
||||||
movl $GRUB_MEMORY_CPU_AMD64_MSR, %ecx
|
movl $GRUB_MEMORY_CPU_AMD64_MSR, %ecx
|
||||||
rdmsr
|
rdmsr
|
||||||
andl $(~GRUB_MEMORY_CPU_AMD64_MSR_ON), %eax
|
andl $(~GRUB_MEMORY_CPU_AMD64_MSR_ON), %eax
|
||||||
wrmsr
|
wrmsr
|
||||||
|
#endif
|
||||||
|
|
||||||
/* Turn off PAE. */
|
/* Turn off PAE. */
|
||||||
movl %cr4, %eax
|
movl %cr4, %eax
|
||||||
andl $GRUB_MEMORY_CPU_CR4_PAE_ON, %eax
|
andl $(~GRUB_MEMORY_CPU_CR4_PAE_ON), %eax
|
||||||
movl %eax, %cr4
|
movl %eax, %cr4
|
||||||
|
|
||||||
/* Update other registers. */
|
/* Update other registers. */
|
||||||
|
@ -208,23 +188,6 @@ LOCAL(cs_base_byte3):
|
||||||
*/
|
*/
|
||||||
.word 0xFFFF, 0
|
.word 0xFFFF, 0
|
||||||
.byte 0, 0x92, 0, 0
|
.byte 0, 0x92, 0, 0
|
||||||
|
LOCAL(gdt_end):
|
||||||
.p2align 4
|
|
||||||
LOCAL(gdtdesc):
|
|
||||||
.word 0x27
|
|
||||||
LOCAL(gdt_addr):
|
|
||||||
#ifdef __x86_64__
|
|
||||||
/* Filled by the code. */
|
|
||||||
.quad 0
|
|
||||||
#else
|
|
||||||
/* Filled by the code. */
|
|
||||||
.long 0
|
|
||||||
#endif
|
|
||||||
|
|
||||||
.p2align 4
|
|
||||||
LOCAL(jump_vector):
|
|
||||||
/* Jump location. Is filled by the code */
|
|
||||||
.long 0
|
|
||||||
.long CODE_SEGMENT
|
|
||||||
|
|
||||||
VARIABLE(grub_relocator16_end)
|
VARIABLE(grub_relocator16_end)
|
||||||
|
|
|
@ -16,48 +16,21 @@
|
||||||
* along with GRUB. If not, see <http://www.gnu.org/licenses/>.
|
* along with GRUB. If not, see <http://www.gnu.org/licenses/>.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <grub/symbol.h>
|
|
||||||
#include <grub/i386/memory.h>
|
|
||||||
|
|
||||||
#ifdef __x86_64__
|
|
||||||
#define RAX %rax
|
|
||||||
#define RSI %rsi
|
|
||||||
#else
|
|
||||||
#define RAX %eax
|
|
||||||
#define RSI %esi
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/* The code segment of the protected mode. */
|
/* The code segment of the protected mode. */
|
||||||
#define CODE_SEGMENT 0x10
|
#define CODE_SEGMENT 0x10
|
||||||
|
|
||||||
/* The data segment of the protected mode. */
|
/* The data segment of the protected mode. */
|
||||||
#define DATA_SEGMENT 0x18
|
#define DATA_SEGMENT 0x18
|
||||||
|
|
||||||
|
#include "relocator_common.S"
|
||||||
|
|
||||||
.p2align 4 /* force 16-byte alignment */
|
.p2align 4 /* force 16-byte alignment */
|
||||||
|
|
||||||
VARIABLE(grub_relocator32_start)
|
VARIABLE(grub_relocator32_start)
|
||||||
LOCAL(base):
|
PREAMBLE
|
||||||
/* %rax contains now our new 'base'. */
|
|
||||||
mov RAX, RSI
|
|
||||||
add $(LOCAL(cont0) - LOCAL(base)), RAX
|
|
||||||
jmp *RAX
|
|
||||||
LOCAL(cont0):
|
|
||||||
lea (LOCAL(cont1) - LOCAL(base)) (RSI, 1), RAX
|
|
||||||
movl %eax, (LOCAL(jump_vector) - LOCAL(base)) (RSI, 1)
|
|
||||||
|
|
||||||
lea (LOCAL(gdt) - LOCAL(base)) (RSI, 1), RAX
|
RELOAD_GDT
|
||||||
mov RAX, (LOCAL(gdt_addr) - LOCAL(base)) (RSI, 1)
|
|
||||||
|
|
||||||
/* Switch to compatibility mode. */
|
|
||||||
|
|
||||||
lgdt (LOCAL(gdtdesc) - LOCAL(base)) (RSI, 1)
|
|
||||||
|
|
||||||
/* Update %cs. */
|
|
||||||
ljmp *(LOCAL(jump_vector) - LOCAL(base)) (RSI, 1)
|
|
||||||
|
|
||||||
LOCAL(cont1):
|
|
||||||
.code32
|
.code32
|
||||||
|
|
||||||
/* Update other registers. */
|
/* Update other registers. */
|
||||||
movl $DATA_SEGMENT, %eax
|
movl $DATA_SEGMENT, %eax
|
||||||
movl %eax, %ds
|
movl %eax, %ds
|
||||||
|
@ -66,16 +39,15 @@ LOCAL(cont1):
|
||||||
movl %eax, %gs
|
movl %eax, %gs
|
||||||
movl %eax, %ss
|
movl %eax, %ss
|
||||||
|
|
||||||
/* Disable paging. */
|
DISABLE_PAGING
|
||||||
movl %cr0, %eax
|
|
||||||
andl $(~GRUB_MEMORY_CPU_CR0_PAGING_ON), %eax
|
|
||||||
movl %eax, %cr0
|
|
||||||
|
|
||||||
|
#ifdef __x86_64__
|
||||||
/* Disable amd64. */
|
/* Disable amd64. */
|
||||||
movl $GRUB_MEMORY_CPU_AMD64_MSR, %ecx
|
movl $GRUB_MEMORY_CPU_AMD64_MSR, %ecx
|
||||||
rdmsr
|
rdmsr
|
||||||
andl $(~GRUB_MEMORY_CPU_AMD64_MSR_ON), %eax
|
andl $(~GRUB_MEMORY_CPU_AMD64_MSR_ON), %eax
|
||||||
wrmsr
|
wrmsr
|
||||||
|
#endif
|
||||||
|
|
||||||
/* Turn off PAE. */
|
/* Turn off PAE. */
|
||||||
movl %cr4, %eax
|
movl %cr4, %eax
|
||||||
|
@ -143,23 +115,6 @@ LOCAL(gdt):
|
||||||
|
|
||||||
/* Data segment. */
|
/* Data segment. */
|
||||||
.byte 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x92, 0xCF, 0x00
|
.byte 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x92, 0xCF, 0x00
|
||||||
|
LOCAL(gdt_end):
|
||||||
.p2align 4
|
|
||||||
LOCAL(gdtdesc):
|
|
||||||
.word 0x27
|
|
||||||
LOCAL(gdt_addr):
|
|
||||||
#ifdef __x86_64__
|
|
||||||
/* Filled by the code. */
|
|
||||||
.quad 0
|
|
||||||
#else
|
|
||||||
/* Filled by the code. */
|
|
||||||
.long 0
|
|
||||||
#endif
|
|
||||||
|
|
||||||
.p2align 4
|
|
||||||
LOCAL(jump_vector):
|
|
||||||
/* Jump location. Is filled by the code */
|
|
||||||
.long 0
|
|
||||||
.long CODE_SEGMENT
|
|
||||||
|
|
||||||
VARIABLE(grub_relocator32_end)
|
VARIABLE(grub_relocator32_end)
|
||||||
|
|
|
@ -16,44 +16,20 @@
|
||||||
* along with GRUB. If not, see <http://www.gnu.org/licenses/>.
|
* along with GRUB. If not, see <http://www.gnu.org/licenses/>.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <grub/symbol.h>
|
|
||||||
#include <grub/i386/memory.h>
|
|
||||||
|
|
||||||
#ifdef __x86_64__
|
|
||||||
#define RAX %rax
|
|
||||||
#define RSI %rsi
|
|
||||||
#else
|
|
||||||
#define RAX %eax
|
|
||||||
#define RSI %esi
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#define CODE32_SEGMENT 0x18
|
#define CODE32_SEGMENT 0x18
|
||||||
#define CODE64_SEGMENT 0x08
|
#define CODE_SEGMENT 0x08
|
||||||
|
|
||||||
/* The data segment of the protected mode. */
|
/* The data segment of the protected mode. */
|
||||||
#define DATA_SEGMENT 0x10
|
#define DATA_SEGMENT 0x10
|
||||||
|
|
||||||
|
#include "relocator_common.S"
|
||||||
|
|
||||||
.p2align 4 /* force 16-byte alignment */
|
.p2align 4 /* force 16-byte alignment */
|
||||||
|
|
||||||
VARIABLE(grub_relocator64_start)
|
VARIABLE(grub_relocator64_start)
|
||||||
LOCAL(base):
|
PREAMBLE
|
||||||
/* %rax contains now our new 'base'. */
|
|
||||||
mov RAX, RSI
|
|
||||||
|
|
||||||
add $(LOCAL(cont0) - LOCAL(base)), RAX
|
|
||||||
jmp *RAX
|
|
||||||
LOCAL(cont0):
|
|
||||||
#ifndef __x86_64__
|
#ifndef __x86_64__
|
||||||
lea (LOCAL(cont1) - LOCAL(base)) (RSI, 1), RAX
|
DISABLE_PAGING
|
||||||
mov RAX, (LOCAL(jump_vector) - LOCAL(base)) (RSI, 1)
|
|
||||||
|
|
||||||
lea (LOCAL(gdt) - LOCAL(base)) (RSI, 1), RAX
|
|
||||||
mov RAX, (LOCAL(gdt_addr) - LOCAL(base)) (RSI, 1)
|
|
||||||
|
|
||||||
/* Disable paging. */
|
|
||||||
movl %cr0, %eax
|
|
||||||
andl $(~GRUB_MEMORY_CPU_CR0_PAGING_ON), %eax
|
|
||||||
movl %eax, %cr0
|
|
||||||
|
|
||||||
/* Turn on PAE. */
|
/* Turn on PAE. */
|
||||||
movl %cr4, %eax
|
movl %cr4, %eax
|
||||||
|
@ -77,11 +53,7 @@ VARIABLE(grub_relocator64_cr3)
|
||||||
orl $GRUB_MEMORY_CPU_CR0_PAGING_ON, %eax
|
orl $GRUB_MEMORY_CPU_CR0_PAGING_ON, %eax
|
||||||
movl %eax, %cr0
|
movl %eax, %cr0
|
||||||
|
|
||||||
/* Load GDT. */
|
RELOAD_GDT
|
||||||
lgdt (LOCAL(gdtdesc) - LOCAL(base)) (RSI, 1)
|
|
||||||
|
|
||||||
/* Update %cs. */
|
|
||||||
ljmp *(LOCAL(jump_vector) - LOCAL(base)) (RSI, 1)
|
|
||||||
#else
|
#else
|
||||||
/* mov imm64, %rax */
|
/* mov imm64, %rax */
|
||||||
.byte 0x48
|
.byte 0x48
|
||||||
|
@ -91,7 +63,6 @@ VARIABLE(grub_relocator64_cr3)
|
||||||
movq %rax, %cr3
|
movq %rax, %cr3
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
LOCAL(cont1):
|
|
||||||
.code64
|
.code64
|
||||||
|
|
||||||
/* mov imm64, %rax */
|
/* mov imm64, %rax */
|
||||||
|
@ -183,18 +154,7 @@ LOCAL(gdt):
|
||||||
| (1 << 7) /* 4K granular. */)
|
| (1 << 7) /* 4K granular. */)
|
||||||
.byte 0x00 /* Base 00xxxxxx. */
|
.byte 0x00 /* Base 00xxxxxx. */
|
||||||
|
|
||||||
.p2align 4
|
LOCAL(gdt_end):
|
||||||
LOCAL(gdtdesc):
|
|
||||||
.word 0x20
|
|
||||||
LOCAL(gdt_addr):
|
|
||||||
/* Filled by the code. */
|
|
||||||
.long 0
|
|
||||||
|
|
||||||
.p2align 4
|
|
||||||
LOCAL(jump_vector):
|
|
||||||
/* Jump location. Is filled by the code */
|
|
||||||
.long 0
|
|
||||||
.long CODE64_SEGMENT
|
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
VARIABLE(grub_relocator64_end)
|
VARIABLE(grub_relocator64_end)
|
||||||
|
|
82
lib/i386/relocator_common.S
Normal file
82
lib/i386/relocator_common.S
Normal file
|
@ -0,0 +1,82 @@
|
||||||
|
/*
|
||||||
|
* GRUB -- GRand Unified Bootloader
|
||||||
|
* Copyright (C) 2009,2010 Free Software Foundation, Inc.
|
||||||
|
*
|
||||||
|
* GRUB 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 3 of the License, or
|
||||||
|
* (at your option) any later version.
|
||||||
|
*
|
||||||
|
* GRUB 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 GRUB. If not, see <http://www.gnu.org/licenses/>.
|
||||||
|
*/
|
||||||
|
|
||||||
|
|
||||||
|
#include <grub/symbol.h>
|
||||||
|
#include <grub/i386/memory.h>
|
||||||
|
|
||||||
|
#ifdef __x86_64__
|
||||||
|
#define RAX %rax
|
||||||
|
#define RSI %rsi
|
||||||
|
#else
|
||||||
|
#define RAX %eax
|
||||||
|
#define RSI %esi
|
||||||
|
#endif
|
||||||
|
|
||||||
|
.macro DISABLE_PAGING
|
||||||
|
#ifdef GRUB_MACHINE_IEEE1275
|
||||||
|
#endif
|
||||||
|
|
||||||
|
movl %cr0, %eax
|
||||||
|
andl $(~GRUB_MEMORY_CPU_CR0_PAGING_ON), %eax
|
||||||
|
movl %eax, %cr0
|
||||||
|
.endm
|
||||||
|
|
||||||
|
.macro PREAMBLE
|
||||||
|
LOCAL(base):
|
||||||
|
/* %rax contains now our new 'base'. */
|
||||||
|
mov RAX, RSI
|
||||||
|
|
||||||
|
add $(LOCAL(cont0) - LOCAL(base)), RAX
|
||||||
|
jmp *RAX
|
||||||
|
LOCAL(cont0):
|
||||||
|
.endm
|
||||||
|
|
||||||
|
.macro RELOAD_GDT
|
||||||
|
lea (LOCAL(cont1) - LOCAL(base)) (RSI, 1), RAX
|
||||||
|
movl %eax, (LOCAL(jump_vector) - LOCAL(base)) (RSI, 1)
|
||||||
|
|
||||||
|
lea (LOCAL(gdt) - LOCAL(base)) (RSI, 1), RAX
|
||||||
|
mov RAX, (LOCAL(gdt_addr) - LOCAL(base)) (RSI, 1)
|
||||||
|
|
||||||
|
/* Switch to compatibility mode. */
|
||||||
|
lgdt (LOCAL(gdtdesc) - LOCAL(base)) (RSI, 1)
|
||||||
|
|
||||||
|
/* Update %cs. */
|
||||||
|
ljmp *(LOCAL(jump_vector) - LOCAL(base)) (RSI, 1)
|
||||||
|
|
||||||
|
.p2align 4
|
||||||
|
LOCAL(gdtdesc):
|
||||||
|
.word LOCAL(gdt_end) - LOCAL(gdt)
|
||||||
|
LOCAL(gdt_addr):
|
||||||
|
#ifdef __x86_64__
|
||||||
|
/* Filled by the code. */
|
||||||
|
.quad 0
|
||||||
|
#else
|
||||||
|
/* Filled by the code. */
|
||||||
|
.long 0
|
||||||
|
#endif
|
||||||
|
|
||||||
|
.p2align 4
|
||||||
|
LOCAL(jump_vector):
|
||||||
|
/* Jump location. Is filled by the code */
|
||||||
|
.long 0
|
||||||
|
.long CODE_SEGMENT
|
||||||
|
|
||||||
|
LOCAL(cont1):
|
||||||
|
.endm
|
Loading…
Add table
Reference in a new issue