mirror of
https://gitlab.com/qemu-project/openbios.git
synced 2024-02-13 08:34:06 +08:00
f4564e0dc0
Remove old hack to jump to loaded code and use switch_to(). Use FLUSH_ALL_KERNEL_WINDOWS macro from Linux. Signed-off-by: Blue Swirl <blauwirbel@gmail.com> git-svn-id: svn://coreboot.org/openbios/trunk/openbios-devel@827 f158a5a8-5612-0410-a976-696ce0be7e32
119 lines
3.2 KiB
C
119 lines
3.2 KiB
C
/*
|
|
* context switching
|
|
* 2003-10 by SONE Takeshi
|
|
*/
|
|
|
|
#include "config.h"
|
|
#include "kernel/kernel.h"
|
|
#include "context.h"
|
|
#include "libopenbios/sys_info.h"
|
|
#include "boot.h"
|
|
|
|
#define MAIN_STACK_SIZE 16384
|
|
#define IMAGE_STACK_SIZE 4096
|
|
|
|
#define debug printk
|
|
|
|
static void start_main(void); /* forward decl. */
|
|
void __exit_context(void); /* assembly routine */
|
|
|
|
/*
|
|
* Main context structure
|
|
* It is placed at the bottom of our stack, and loaded by assembly routine
|
|
* to start us up.
|
|
*/
|
|
static struct context main_ctx = {
|
|
.regs[REG_SP] = (uint32_t) &_estack - 96,
|
|
.pc = (uint32_t) start_main,
|
|
.npc = (uint32_t) start_main + 4,
|
|
.return_addr = (uint32_t) __exit_context,
|
|
};
|
|
|
|
/* This is used by assembly routine to load/store the context which
|
|
* it is to switch/switched. */
|
|
struct context *__context = &main_ctx;
|
|
|
|
/* Stack for loaded ELF image */
|
|
static uint8_t image_stack[IMAGE_STACK_SIZE];
|
|
|
|
/* Pointer to startup context (physical address) */
|
|
unsigned long __boot_ctx;
|
|
|
|
/*
|
|
* Main starter
|
|
* This is the C function that runs first.
|
|
*/
|
|
static void start_main(void)
|
|
{
|
|
int retval;
|
|
extern int openbios(void);
|
|
|
|
/* Save startup context, so we can refer to it later.
|
|
* We have to keep it in physical address since we will relocate. */
|
|
__boot_ctx = virt_to_phys(__context);
|
|
|
|
/* Start the real fun */
|
|
retval = openbios();
|
|
|
|
/* Pass return value to startup context. Bootloader may see it. */
|
|
//boot_ctx->eax = retval;
|
|
|
|
/* Returning from here should jump to __exit_context */
|
|
__context = boot_ctx;
|
|
}
|
|
|
|
/* Setup a new context using the given stack.
|
|
*/
|
|
struct context *
|
|
init_context(uint8_t *stack, uint32_t stack_size, int num_params)
|
|
{
|
|
struct context *ctx;
|
|
|
|
ctx = (struct context *)
|
|
(stack + stack_size - (sizeof(*ctx) + num_params*sizeof(uint32_t)));
|
|
memset(ctx, 0, sizeof(*ctx));
|
|
|
|
/* Fill in reasonable default for flat memory model */
|
|
ctx->regs[REG_SP] = virt_to_phys(SP_LOC(ctx));
|
|
ctx->return_addr = virt_to_phys(__exit_context);
|
|
|
|
return ctx;
|
|
}
|
|
|
|
/* Switch to another context. */
|
|
struct context *switch_to(struct context *ctx)
|
|
{
|
|
volatile struct context *save;
|
|
struct context *ret;
|
|
|
|
debug("switching to new context:\n");
|
|
save = __context;
|
|
__context = ctx;
|
|
asm __volatile__ ("\n\tcall __switch_context"
|
|
"\n\tnop" ::: "g1", "g2", "g3", "g4", "g5", "g6", "g7",
|
|
"o0", "o1", "o2", "o3", "o4", "o5", "sp", "o7",
|
|
"l0", "l1", "l2", "l3", "l4", "l5", "l6", "l7",
|
|
"i0", "i1", "i2", "i3", "i4", "i5", "i7",
|
|
"f0", "f1", "f2", "f3", "f4", "f5", "f6", "f7", "f8", "f9",
|
|
"f10", "f11", "f12", "f13", "f14", "f15", "f16", "f17", "f18", "f19",
|
|
"f20", "f21", "f22", "f23", "f24", "f25", "f26", "f27", "f28", "f29",
|
|
"f30", "f31",
|
|
"memory");
|
|
ret = __context;
|
|
__context = (struct context *)save;
|
|
return ret;
|
|
}
|
|
|
|
/* Start ELF Boot image */
|
|
unsigned int start_elf(unsigned long entry_point, unsigned long param)
|
|
{
|
|
struct context *ctx;
|
|
|
|
ctx = init_context(image_stack, sizeof image_stack, 1);
|
|
ctx->pc = entry_point;
|
|
ctx->param[0] = param;
|
|
|
|
ctx = switch_to(ctx);
|
|
return ctx->regs[REG_O0];
|
|
}
|