mirror of https://github.com/xqemu/xqemu.git
linux-user: move nios2 cpu loop to nios2 directory
No code change, only move code from main.c to nios2/cpu_loop.c. Signed-off-by: Laurent Vivier <laurent@vivier.eu> Reviewed-by: Richard Henderson <richard.henderson@linaro.org> Message-Id: <20180411185651.21351-9-laurent@vivier.eu>
This commit is contained in:
Laurent Vivier
parent
58908ef603
commit
0ec0f01c9d
|
|
@ -149,109 +149,6 @@ void fork_end(int child)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
#ifdef TARGET_NIOS2
|
|
||||||
|
|
||||||
void cpu_loop(CPUNios2State *env)
|
|
||||||
{
|
|
||||||
CPUState *cs = ENV_GET_CPU(env);
|
|
||||||
Nios2CPU *cpu = NIOS2_CPU(cs);
|
|
||||||
target_siginfo_t info;
|
|
||||||
int trapnr, gdbsig, ret;
|
|
||||||
|
|
||||||
for (;;) {
|
|
||||||
cpu_exec_start(cs);
|
|
||||||
trapnr = cpu_exec(cs);
|
|
||||||
cpu_exec_end(cs);
|
|
||||||
gdbsig = 0;
|
|
||||||
|
|
||||||
switch (trapnr) {
|
|
||||||
case EXCP_INTERRUPT:
|
|
||||||
/* just indicate that signals should be handled asap */
|
|
||||||
break;
|
|
||||||
case EXCP_TRAP:
|
|
||||||
if (env->regs[R_AT] == 0) {
|
|
||||||
abi_long ret;
|
|
||||||
qemu_log_mask(CPU_LOG_INT, "\nSyscall\n");
|
|
||||||
|
|
||||||
ret = do_syscall(env, env->regs[2],
|
|
||||||
env->regs[4], env->regs[5], env->regs[6],
|
|
||||||
env->regs[7], env->regs[8], env->regs[9],
|
|
||||||
0, 0);
|
|
||||||
|
|
||||||
if (env->regs[2] == 0) { /* FIXME: syscall 0 workaround */
|
|
||||||
ret = 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
env->regs[2] = abs(ret);
|
|
||||||
/* Return value is 0..4096 */
|
|
||||||
env->regs[7] = (ret > 0xfffffffffffff000ULL);
|
|
||||||
env->regs[CR_ESTATUS] = env->regs[CR_STATUS];
|
|
||||||
env->regs[CR_STATUS] &= ~0x3;
|
|
||||||
env->regs[R_EA] = env->regs[R_PC] + 4;
|
|
||||||
env->regs[R_PC] += 4;
|
|
||||||
break;
|
|
||||||
} else {
|
|
||||||
qemu_log_mask(CPU_LOG_INT, "\nTrap\n");
|
|
||||||
|
|
||||||
env->regs[CR_ESTATUS] = env->regs[CR_STATUS];
|
|
||||||
env->regs[CR_STATUS] &= ~0x3;
|
|
||||||
env->regs[R_EA] = env->regs[R_PC] + 4;
|
|
||||||
env->regs[R_PC] = cpu->exception_addr;
|
|
||||||
|
|
||||||
gdbsig = TARGET_SIGTRAP;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
case 0xaa:
|
|
||||||
switch (env->regs[R_PC]) {
|
|
||||||
/*case 0x1000:*/ /* TODO:__kuser_helper_version */
|
|
||||||
case 0x1004: /* __kuser_cmpxchg */
|
|
||||||
start_exclusive();
|
|
||||||
if (env->regs[4] & 0x3) {
|
|
||||||
goto kuser_fail;
|
|
||||||
}
|
|
||||||
ret = get_user_u32(env->regs[2], env->regs[4]);
|
|
||||||
if (ret) {
|
|
||||||
end_exclusive();
|
|
||||||
goto kuser_fail;
|
|
||||||
}
|
|
||||||
env->regs[2] -= env->regs[5];
|
|
||||||
if (env->regs[2] == 0) {
|
|
||||||
put_user_u32(env->regs[6], env->regs[4]);
|
|
||||||
}
|
|
||||||
end_exclusive();
|
|
||||||
env->regs[R_PC] = env->regs[R_RA];
|
|
||||||
break;
|
|
||||||
/*case 0x1040:*/ /* TODO:__kuser_sigtramp */
|
|
||||||
default:
|
|
||||||
;
|
|
||||||
kuser_fail:
|
|
||||||
info.si_signo = TARGET_SIGSEGV;
|
|
||||||
info.si_errno = 0;
|
|
||||||
/* TODO: check env->error_code */
|
|
||||||
info.si_code = TARGET_SEGV_MAPERR;
|
|
||||||
info._sifields._sigfault._addr = env->regs[R_PC];
|
|
||||||
queue_signal(env, info.si_signo, QEMU_SI_FAULT, &info);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
EXCP_DUMP(env, "\nqemu: unhandled CPU exception %#x - aborting\n",
|
|
||||||
trapnr);
|
|
||||||
gdbsig = TARGET_SIGILL;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
if (gdbsig) {
|
|
||||||
gdb_handlesig(cs, gdbsig);
|
|
||||||
if (gdbsig != TARGET_SIGTRAP) {
|
|
||||||
exit(EXIT_FAILURE);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
process_pending_signals(env);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
#endif /* TARGET_NIOS2 */
|
|
||||||
|
|
||||||
#ifdef TARGET_OPENRISC
|
#ifdef TARGET_OPENRISC
|
||||||
|
|
||||||
void cpu_loop(CPUOpenRISCState *env)
|
void cpu_loop(CPUOpenRISCState *env)
|
||||||
|
|
@ -2545,36 +2442,6 @@ int main(int argc, char **argv, char **envp)
|
||||||
env->regs[31] = regs->r31;
|
env->regs[31] = regs->r31;
|
||||||
env->sregs[SR_PC] = regs->pc;
|
env->sregs[SR_PC] = regs->pc;
|
||||||
}
|
}
|
||||||
#elif defined(TARGET_NIOS2)
|
|
||||||
{
|
|
||||||
env->regs[0] = 0;
|
|
||||||
env->regs[1] = regs->r1;
|
|
||||||
env->regs[2] = regs->r2;
|
|
||||||
env->regs[3] = regs->r3;
|
|
||||||
env->regs[4] = regs->r4;
|
|
||||||
env->regs[5] = regs->r5;
|
|
||||||
env->regs[6] = regs->r6;
|
|
||||||
env->regs[7] = regs->r7;
|
|
||||||
env->regs[8] = regs->r8;
|
|
||||||
env->regs[9] = regs->r9;
|
|
||||||
env->regs[10] = regs->r10;
|
|
||||||
env->regs[11] = regs->r11;
|
|
||||||
env->regs[12] = regs->r12;
|
|
||||||
env->regs[13] = regs->r13;
|
|
||||||
env->regs[14] = regs->r14;
|
|
||||||
env->regs[15] = regs->r15;
|
|
||||||
/* TODO: unsigned long orig_r2; */
|
|
||||||
env->regs[R_RA] = regs->ra;
|
|
||||||
env->regs[R_FP] = regs->fp;
|
|
||||||
env->regs[R_SP] = regs->sp;
|
|
||||||
env->regs[R_GP] = regs->gp;
|
|
||||||
env->regs[CR_ESTATUS] = regs->estatus;
|
|
||||||
env->regs[R_EA] = regs->ea;
|
|
||||||
/* TODO: unsigned long orig_r7; */
|
|
||||||
|
|
||||||
/* Emulate eret when starting thread. */
|
|
||||||
env->regs[R_PC] = regs->ea;
|
|
||||||
}
|
|
||||||
#elif defined(TARGET_OPENRISC)
|
#elif defined(TARGET_OPENRISC)
|
||||||
{
|
{
|
||||||
int i;
|
int i;
|
||||||
|
|
|
||||||
|
|
@ -21,6 +21,132 @@
|
||||||
#include "qemu.h"
|
#include "qemu.h"
|
||||||
#include "cpu_loop-common.h"
|
#include "cpu_loop-common.h"
|
||||||
|
|
||||||
|
void cpu_loop(CPUNios2State *env)
|
||||||
|
{
|
||||||
|
CPUState *cs = ENV_GET_CPU(env);
|
||||||
|
Nios2CPU *cpu = NIOS2_CPU(cs);
|
||||||
|
target_siginfo_t info;
|
||||||
|
int trapnr, gdbsig, ret;
|
||||||
|
|
||||||
|
for (;;) {
|
||||||
|
cpu_exec_start(cs);
|
||||||
|
trapnr = cpu_exec(cs);
|
||||||
|
cpu_exec_end(cs);
|
||||||
|
gdbsig = 0;
|
||||||
|
|
||||||
|
switch (trapnr) {
|
||||||
|
case EXCP_INTERRUPT:
|
||||||
|
/* just indicate that signals should be handled asap */
|
||||||
|
break;
|
||||||
|
case EXCP_TRAP:
|
||||||
|
if (env->regs[R_AT] == 0) {
|
||||||
|
abi_long ret;
|
||||||
|
qemu_log_mask(CPU_LOG_INT, "\nSyscall\n");
|
||||||
|
|
||||||
|
ret = do_syscall(env, env->regs[2],
|
||||||
|
env->regs[4], env->regs[5], env->regs[6],
|
||||||
|
env->regs[7], env->regs[8], env->regs[9],
|
||||||
|
0, 0);
|
||||||
|
|
||||||
|
if (env->regs[2] == 0) { /* FIXME: syscall 0 workaround */
|
||||||
|
ret = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
env->regs[2] = abs(ret);
|
||||||
|
/* Return value is 0..4096 */
|
||||||
|
env->regs[7] = (ret > 0xfffffffffffff000ULL);
|
||||||
|
env->regs[CR_ESTATUS] = env->regs[CR_STATUS];
|
||||||
|
env->regs[CR_STATUS] &= ~0x3;
|
||||||
|
env->regs[R_EA] = env->regs[R_PC] + 4;
|
||||||
|
env->regs[R_PC] += 4;
|
||||||
|
break;
|
||||||
|
} else {
|
||||||
|
qemu_log_mask(CPU_LOG_INT, "\nTrap\n");
|
||||||
|
|
||||||
|
env->regs[CR_ESTATUS] = env->regs[CR_STATUS];
|
||||||
|
env->regs[CR_STATUS] &= ~0x3;
|
||||||
|
env->regs[R_EA] = env->regs[R_PC] + 4;
|
||||||
|
env->regs[R_PC] = cpu->exception_addr;
|
||||||
|
|
||||||
|
gdbsig = TARGET_SIGTRAP;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
case 0xaa:
|
||||||
|
switch (env->regs[R_PC]) {
|
||||||
|
/*case 0x1000:*/ /* TODO:__kuser_helper_version */
|
||||||
|
case 0x1004: /* __kuser_cmpxchg */
|
||||||
|
start_exclusive();
|
||||||
|
if (env->regs[4] & 0x3) {
|
||||||
|
goto kuser_fail;
|
||||||
|
}
|
||||||
|
ret = get_user_u32(env->regs[2], env->regs[4]);
|
||||||
|
if (ret) {
|
||||||
|
end_exclusive();
|
||||||
|
goto kuser_fail;
|
||||||
|
}
|
||||||
|
env->regs[2] -= env->regs[5];
|
||||||
|
if (env->regs[2] == 0) {
|
||||||
|
put_user_u32(env->regs[6], env->regs[4]);
|
||||||
|
}
|
||||||
|
end_exclusive();
|
||||||
|
env->regs[R_PC] = env->regs[R_RA];
|
||||||
|
break;
|
||||||
|
/*case 0x1040:*/ /* TODO:__kuser_sigtramp */
|
||||||
|
default:
|
||||||
|
;
|
||||||
|
kuser_fail:
|
||||||
|
info.si_signo = TARGET_SIGSEGV;
|
||||||
|
info.si_errno = 0;
|
||||||
|
/* TODO: check env->error_code */
|
||||||
|
info.si_code = TARGET_SEGV_MAPERR;
|
||||||
|
info._sifields._sigfault._addr = env->regs[R_PC];
|
||||||
|
queue_signal(env, info.si_signo, QEMU_SI_FAULT, &info);
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
EXCP_DUMP(env, "\nqemu: unhandled CPU exception %#x - aborting\n",
|
||||||
|
trapnr);
|
||||||
|
gdbsig = TARGET_SIGILL;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
if (gdbsig) {
|
||||||
|
gdb_handlesig(cs, gdbsig);
|
||||||
|
if (gdbsig != TARGET_SIGTRAP) {
|
||||||
|
exit(EXIT_FAILURE);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
process_pending_signals(env);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
void target_cpu_copy_regs(CPUArchState *env, struct target_pt_regs *regs)
|
void target_cpu_copy_regs(CPUArchState *env, struct target_pt_regs *regs)
|
||||||
{
|
{
|
||||||
|
env->regs[0] = 0;
|
||||||
|
env->regs[1] = regs->r1;
|
||||||
|
env->regs[2] = regs->r2;
|
||||||
|
env->regs[3] = regs->r3;
|
||||||
|
env->regs[4] = regs->r4;
|
||||||
|
env->regs[5] = regs->r5;
|
||||||
|
env->regs[6] = regs->r6;
|
||||||
|
env->regs[7] = regs->r7;
|
||||||
|
env->regs[8] = regs->r8;
|
||||||
|
env->regs[9] = regs->r9;
|
||||||
|
env->regs[10] = regs->r10;
|
||||||
|
env->regs[11] = regs->r11;
|
||||||
|
env->regs[12] = regs->r12;
|
||||||
|
env->regs[13] = regs->r13;
|
||||||
|
env->regs[14] = regs->r14;
|
||||||
|
env->regs[15] = regs->r15;
|
||||||
|
/* TODO: unsigned long orig_r2; */
|
||||||
|
env->regs[R_RA] = regs->ra;
|
||||||
|
env->regs[R_FP] = regs->fp;
|
||||||
|
env->regs[R_SP] = regs->sp;
|
||||||
|
env->regs[R_GP] = regs->gp;
|
||||||
|
env->regs[CR_ESTATUS] = regs->estatus;
|
||||||
|
env->regs[R_EA] = regs->ea;
|
||||||
|
/* TODO: unsigned long orig_r7; */
|
||||||
|
|
||||||
|
/* Emulate eret when starting thread. */
|
||||||
|
env->regs[R_PC] = regs->ea;
|
||||||
}
|
}
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue