|
|
1.1 ! root 1: /* ! 2: * context switching ! 3: * 2003-10 by SONE Takeshi ! 4: */ ! 5: ! 6: #include "config.h" ! 7: #include "kernel/kernel.h" ! 8: #include "context.h" ! 9: #include "libopenbios/sys_info.h" ! 10: #include "boot.h" ! 11: #include "openbios.h" ! 12: ! 13: #define MAIN_STACK_SIZE 16384 ! 14: #define IMAGE_STACK_SIZE 4096*2 ! 15: ! 16: #define debug printk ! 17: ! 18: static void start_main(void); /* forward decl. */ ! 19: void __exit_context(void); /* assembly routine */ ! 20: ! 21: /* ! 22: * Main context structure ! 23: * It is placed at the bottom of our stack, and loaded by assembly routine ! 24: * to start us up. ! 25: */ ! 26: static struct context main_ctx = { ! 27: .regs[REG_SP] = (uint32_t) &_estack - 96, ! 28: .pc = (uint32_t) start_main, ! 29: .npc = (uint32_t) start_main + 4, ! 30: .return_addr = (uint32_t) __exit_context, ! 31: }; ! 32: ! 33: /* This is used by assembly routine to load/store the context which ! 34: * it is to switch/switched. */ ! 35: struct context *__context = &main_ctx; ! 36: ! 37: /* Stack for loaded ELF image */ ! 38: static uint8_t image_stack[IMAGE_STACK_SIZE]; ! 39: ! 40: /* Pointer to startup context (physical address) */ ! 41: unsigned long __boot_ctx; ! 42: ! 43: /* ! 44: * Main starter ! 45: * This is the C function that runs first. ! 46: */ ! 47: static void start_main(void) ! 48: { ! 49: /* Save startup context, so we can refer to it later. ! 50: * We have to keep it in physical address since we will relocate. */ ! 51: __boot_ctx = virt_to_phys(__context); ! 52: ! 53: /* Start the real fun */ ! 54: openbios(); ! 55: ! 56: /* Returning from here should jump to __exit_context */ ! 57: __context = boot_ctx; ! 58: } ! 59: ! 60: /* Setup a new context using the given stack. ! 61: */ ! 62: struct context * ! 63: init_context(uint8_t *stack, uint32_t stack_size, int num_params) ! 64: { ! 65: struct context *ctx; ! 66: ! 67: ctx = (struct context *) ! 68: (stack + stack_size - (sizeof(*ctx) + num_params*sizeof(uint32_t))); ! 69: memset(ctx, 0, sizeof(*ctx)); ! 70: ! 71: /* Fill in reasonable default for flat memory model */ ! 72: ctx->regs[REG_SP] = virt_to_phys(SP_LOC(ctx)); ! 73: ctx->return_addr = virt_to_phys(__exit_context); ! 74: ! 75: return ctx; ! 76: } ! 77: ! 78: /* Switch to another context. */ ! 79: struct context *switch_to(struct context *ctx) ! 80: { ! 81: volatile struct context *save; ! 82: struct context *ret; ! 83: ! 84: debug("switching to new context:\n"); ! 85: save = __context; ! 86: __context = ctx; ! 87: asm __volatile__ ("\n\tcall __switch_context" ! 88: "\n\tnop" ::: "g1", "g2", "g3", "g4", "g5", "g6", "g7", ! 89: "o0", "o1", "o2", "o3", "o4", "o5", "sp", "o7", ! 90: "l0", "l1", "l2", "l3", "l4", "l5", "l6", "l7", ! 91: "i0", "i1", "i2", "i3", "i4", "i5", "i7", ! 92: "f0", "f1", "f2", "f3", "f4", "f5", "f6", "f7", "f8", "f9", ! 93: "f10", "f11", "f12", "f13", "f14", "f15", "f16", "f17", "f18", "f19", ! 94: "f20", "f21", "f22", "f23", "f24", "f25", "f26", "f27", "f28", "f29", ! 95: "f30", "f31", ! 96: "memory"); ! 97: ret = __context; ! 98: __context = (struct context *)save; ! 99: return ret; ! 100: } ! 101: ! 102: /* Start ELF Boot image */ ! 103: unsigned int start_elf(unsigned long entry_point, unsigned long param) ! 104: { ! 105: struct context *ctx; ! 106: ! 107: ctx = init_context(image_stack, sizeof image_stack, 1); ! 108: ctx->pc = entry_point; ! 109: ctx->param[0] = param; ! 110: ! 111: ctx = switch_to(ctx); ! 112: return ctx->regs[REG_O0]; ! 113: }
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.