static int
pgfault_handler(struct trapframe *tf, uint32_t addr, uint32_t error_code)
{
#if 0
extern struct mm_struct *check_mm_struct;
if (check_mm_struct != NULL) {
return do_pgfault(check_mm_struct, error_code, addr);
}
panic("unhandled page fault.\n");
#endif
extern struct mm_struct *check_mm_struct;
if (check_mm_struct != NULL) { //used for test check_swap
//print_pgfault(tf);
}
struct mm_struct *mm;
if (check_mm_struct != NULL) {
assert(current == idleproc);
mm = check_mm_struct;
} else {
if (current == NULL) {
print_trapframe(tf);
//print_pgfault(tf);
panic("unhandled page fault.\n");
}
mm = current->mm;
} //kprintf(" (do_pgfault(%x,%d,%x)) ", mm, error_code, addr);
return do_pgfault(mm, error_code, addr);
}
static int pgfault_handler(struct trapframe *tf)
{
extern struct mm_struct *check_mm_struct;
struct mm_struct *mm;
if (check_mm_struct != NULL) {
//assert(current == idleproc);
assert(pls_read(current) == pls_read(idleproc));
mm = check_mm_struct;
} else {
if (pls_read(current) == NULL) {
print_trapframe(tf);
print_pgfault(tf);
panic("unhandled page fault.\n");
}
mm = pls_read(current)->mm;
}
//print_pgfault(tf);
/* convert ARM error code to kernel error code */
machine_word_t error_code = 0;
if (tf->tf_err & (1 << 11))
error_code |= 0x02; //write
if ((tf->tf_err & 0xC) != 0x04)
error_code |= 0x01;
uint32_t badaddr = 0;
if (tf->tf_trapno == T_PABT) {
badaddr = tf->tf_epc;
} else {
badaddr = far();
}
//kprintf("rrr %08x %08x\n", error_code, *(volatile uint32_t*)(VPT_BASE+4*0xe00));
return do_pgfault(mm, error_code, badaddr);
}
static int
pgfault_handler(struct trapframe *tf) {
extern struct mm_struct *check_mm_struct;
print_pgfault(tf);
if (check_mm_struct != NULL) {
return do_pgfault(check_mm_struct, tf->tf_err, rcr2());
}
panic("unhandled page fault.\n");
}
static int pgfault_handler(struct trapframe *tf)
{
extern struct mm_struct *check_mm_struct;
struct mm_struct *mm;
if (check_mm_struct != NULL) {
assert(pls_read(current) == pls_read(idleproc));
mm = check_mm_struct;
} else {
if (pls_read(current) == NULL) {
print_trapframe(tf);
print_pgfault(tf);
panic("unhandled page fault.\n");
}
mm = pls_read(current)->mm;
}
return do_pgfault(mm, tf->tf_err, rcr2());
}
static int
pgfault_handler(struct trapframe *tf) {
extern struct mm_struct *check_mm_struct;
if(check_mm_struct !=NULL) { //used for test check_swap
print_pgfault(tf);
}
struct mm_struct *mm;
if (check_mm_struct != NULL) {
assert(current == idleproc);
mm = check_mm_struct;
}
else {
if (current == NULL) {
print_trapframe(tf);
print_pgfault(tf);
panic("unhandled page fault.\n");
}
mm = current->mm;
}
return do_pgfault(mm, tf->tf_err, rcr2());
}
unsigned long trapHandler(struct rtrapframe* tf, long cause, long epc, long badaddr)//long* tf
{
uint32_t sp1=read_sp();
uint32_t saved=tf;
long funRe=0;
long returnValue = 0;
long sysNum=(long)(tf->a7);
long args[5];
args[0]=(long)(tf->a0);
args[1]=(long)(tf->a1);
args[2]=(long)(tf->a2);
args[3]=(long)(tf->a3);
args[4]=(long)(tf->a4);
struct rtrapframe *otf = current->tf;
current->tf = tf;
bool ifuser=tf->t0;
funRe=((ifuser==1)?-1:0);
switch(cause)
{
case CAUSE_MACHINE_ECALL:
case CAUSE_SUPERVISOR_ECALL:
{
switch(sysNum)
{
case SYS_exit:
{
cprintf("exit\n");
sys_exit(args[0]);
break;
}
case SYS_write:
{
returnValue=sys_write(sysNum,args[0],args[1],args[2]);
current->tf=otf;
tf->a0 = (uint32_t)returnValue;
//asm volatile("csrw mepc, %0"::"r"(epc+4));
return funRe;
break;
}
case SYS_exec:
{
const char *name = (const char *)args[0];
size_t len = (size_t)args[1];
returnValue = sys_execve(name, len);
funRe=-1;
break;
}
case SYS_S2M:
{
set_mstatus_field(MSTATUS_PRV1,3);
break;
}
case SYS_S2U:
{
set_mstatus_field(MSTATUS_PRV1,0);
break;
}
case SYS_getpid:
{
returnValue = sys_getpid();
break;
}
case SYS_fork:
{
returnValue=sys_fork();
//funRe=-1;
// cprintf("hello\n");
break;
}
case SYS_yield:
{
//cprintf("yield\n");
returnValue=sys_yield();
break;
}
case SYS_wait:
{
returnValue=sys_wait(args[0],args[1]);
break;
}
}
break;
}
case CAUSE_USER_ECALL:
{
switch(sysNum)
{
case SYS_write:
{
returnValue = sys_write(sysNum, args[0], args[1], args[2]);
current->tf=otf;
tf->a0 = (uint32_t)returnValue;
return funRe;
break;
}
case SYS_getpid:
{
returnValue = sys_getpid();
break;
}
case SYS_exit:
{
returnValue = sys_exit(args[0]);
break;
}
}
break;
}
case CAUSE_FAULT_LOAD:
case CAUSE_FAULT_STORE:
case CAUSE_ILLEGAL_INSTRUCTION:
{
extern struct mm_struct *check_mm_struct;
uint32_t mstatus=read_csr(mstatus);
print_pgfault(mstatus,cause,badaddr);
if (check_mm_struct != NULL) {
if(do_pgfault(check_mm_struct, cause, badaddr, mstatus)!=0)
panic("unhandled page fault in function.\n");
}
else
{
if(current==NULL)
panic("unhandled page fault.\n");
do_pgfault(current->mm, cause, badaddr, mstatus);
}
break;
}
default:
{
prvSyscallExit(cause);
}
}
//uint32_t sp3=read_sp();
//cprintf("sysNum=%d\n",sysNum);
//cprintf("sp3=%08x\n",sp3);
current->tf=otf;
tf->a0 = (uint32_t)returnValue;
//asm volatile("csrw mepc, %0"::"r"(epc+4));
return funRe;
}
