00001 /* 00002 * Copyright (C) 2006 Jakub Jermar 00003 * All rights reserved. 00004 * 00005 * Redistribution and use in source and binary forms, with or without 00006 * modification, are permitted provided that the following conditions 00007 * are met: 00008 * 00009 * - Redistributions of source code must retain the above copyright 00010 * notice, this list of conditions and the following disclaimer. 00011 * - Redistributions in binary form must reproduce the above copyright 00012 * notice, this list of conditions and the following disclaimer in the 00013 * documentation and/or other materials provided with the distribution. 00014 * - The name of the author may not be used to endorse or promote products 00015 * derived from this software without specific prior written permission. 00016 * 00017 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 00018 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 00019 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 00020 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 00021 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 00022 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 00023 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 00024 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 00025 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 00026 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 00027 */ 00028 00035 #include <proc/scheduler.h> 00036 #include <proc/thread.h> 00037 #include <arch.h> 00038 #include <arch/register.h> 00039 #include <arch/context.h> 00040 #include <arch/stack.h> 00041 #include <arch/mm/tlb.h> 00042 #include <config.h> 00043 #include <align.h> 00044 00046 void before_task_runs_arch(void) 00047 { 00048 } 00049 00051 void before_thread_runs_arch(void) 00052 { 00053 __address base; 00054 00055 base = ALIGN_DOWN(config.base, 1<<KERNEL_PAGE_WIDTH); 00056 00057 if ((__address) THREAD->kstack < base || (__address) THREAD->kstack > base + (1<<(KERNEL_PAGE_WIDTH))) { 00058 /* 00059 * Kernel stack of this thread is not mapped by DTR[TR_KERNEL]. 00060 * Use DTR[TR_KSTACK1] and DTR[TR_KSTACK2] to map it. 00061 */ 00062 00063 /* purge DTR[TR_STACK1] and DTR[TR_STACK2] */ 00064 dtr_purge((__address) THREAD->kstack, PAGE_WIDTH+1); 00065 00066 /* insert DTR[TR_STACK1] and DTR[TR_STACK2] */ 00067 dtlb_kernel_mapping_insert((__address) THREAD->kstack, KA2PA(THREAD->kstack), true, DTR_KSTACK1); 00068 dtlb_kernel_mapping_insert((__address) THREAD->kstack + PAGE_SIZE, KA2PA(THREAD->kstack) + FRAME_SIZE, true, DTR_KSTACK2); 00069 } 00070 00071 /* 00072 * Record address of kernel backing store to bank 0 r22. 00073 * Record address of kernel stack to bank 0 r23. 00074 * These values will be found there after switch from userspace. 00075 */ 00076 __asm__ volatile ( 00077 "bsw.0\n" 00078 "mov r22 = %0\n" 00079 "mov r23 = %1\n" 00080 "bsw.1\n" 00081 : 00082 : "r" (&THREAD->kstack[THREAD_STACK_SIZE]), 00083 "r" (&THREAD->kstack[THREAD_STACK_SIZE - SP_DELTA]) 00084 ); 00085 } 00086 00087 void after_thread_ran_arch(void) 00088 { 00089 } 00090