174 строки
5.8 KiB
C
174 строки
5.8 KiB
C
/*
|
|
* Copyright (C) 2002 Jeff Dike (jdike@karaya.com)
|
|
* Licensed under the GPL
|
|
*/
|
|
|
|
#include <signal.h>
|
|
#include <errno.h>
|
|
#include <sys/mman.h>
|
|
#include <sys/wait.h>
|
|
#include <asm/page.h>
|
|
#include <asm/unistd.h>
|
|
#include "mem_user.h"
|
|
#include "mem.h"
|
|
#include "mm_id.h"
|
|
#include "user.h"
|
|
#include "os.h"
|
|
#include "proc_mm.h"
|
|
#include "ptrace_user.h"
|
|
#include "user_util.h"
|
|
#include "kern_util.h"
|
|
#include "task.h"
|
|
#include "registers.h"
|
|
#include "uml-config.h"
|
|
#include "sysdep/ptrace.h"
|
|
#include "sysdep/stub.h"
|
|
#include "skas.h"
|
|
|
|
extern unsigned long syscall_stub, __syscall_stub_start;
|
|
|
|
extern void wait_stub_done(int pid, int sig, char * fname);
|
|
|
|
static long run_syscall_stub(struct mm_id * mm_idp, int syscall,
|
|
unsigned long *args)
|
|
{
|
|
int n, pid = mm_idp->u.pid;
|
|
unsigned long regs[MAX_REG_NR];
|
|
|
|
get_safe_registers(regs);
|
|
regs[REGS_IP_INDEX] = UML_CONFIG_STUB_CODE +
|
|
((unsigned long) &syscall_stub -
|
|
(unsigned long) &__syscall_stub_start);
|
|
/* XXX Don't have a define for starting a syscall */
|
|
regs[REGS_SYSCALL_NR] = syscall;
|
|
regs[REGS_SYSCALL_ARG1] = args[0];
|
|
regs[REGS_SYSCALL_ARG2] = args[1];
|
|
regs[REGS_SYSCALL_ARG3] = args[2];
|
|
regs[REGS_SYSCALL_ARG4] = args[3];
|
|
regs[REGS_SYSCALL_ARG5] = args[4];
|
|
regs[REGS_SYSCALL_ARG6] = args[5];
|
|
n = ptrace_setregs(pid, regs);
|
|
if(n < 0){
|
|
printk("run_syscall_stub : PTRACE_SETREGS failed, "
|
|
"errno = %d\n", n);
|
|
return(n);
|
|
}
|
|
|
|
wait_stub_done(pid, 0, "run_syscall_stub");
|
|
|
|
return(*((unsigned long *) mm_idp->stack));
|
|
}
|
|
|
|
int map(struct mm_id *mm_idp, unsigned long virt, unsigned long len,
|
|
int r, int w, int x, int phys_fd, unsigned long long offset)
|
|
{
|
|
int prot, n;
|
|
|
|
prot = (r ? PROT_READ : 0) | (w ? PROT_WRITE : 0) |
|
|
(x ? PROT_EXEC : 0);
|
|
|
|
if(proc_mm){
|
|
struct proc_mm_op map;
|
|
int fd = mm_idp->u.mm_fd;
|
|
map = ((struct proc_mm_op) { .op = MM_MMAP,
|
|
.u =
|
|
{ .mmap =
|
|
{ .addr = virt,
|
|
.len = len,
|
|
.prot = prot,
|
|
.flags = MAP_SHARED |
|
|
MAP_FIXED,
|
|
.fd = phys_fd,
|
|
.offset= offset
|
|
} } } );
|
|
n = os_write_file(fd, &map, sizeof(map));
|
|
if(n != sizeof(map))
|
|
printk("map : /proc/mm map failed, err = %d\n", -n);
|
|
}
|
|
else {
|
|
long res;
|
|
unsigned long args[] = { virt, len, prot,
|
|
MAP_SHARED | MAP_FIXED, phys_fd,
|
|
MMAP_OFFSET(offset) };
|
|
|
|
res = run_syscall_stub(mm_idp, STUB_MMAP_NR, args);
|
|
if((void *) res == MAP_FAILED)
|
|
printk("mmap stub failed, errno = %d\n", res);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int unmap(struct mm_id *mm_idp, void *addr, unsigned long len)
|
|
{
|
|
int n;
|
|
|
|
if(proc_mm){
|
|
struct proc_mm_op unmap;
|
|
int fd = mm_idp->u.mm_fd;
|
|
unmap = ((struct proc_mm_op) { .op = MM_MUNMAP,
|
|
.u =
|
|
{ .munmap =
|
|
{ .addr =
|
|
(unsigned long) addr,
|
|
.len = len } } } );
|
|
n = os_write_file(fd, &unmap, sizeof(unmap));
|
|
if(n != sizeof(unmap)) {
|
|
if(n < 0)
|
|
return(n);
|
|
else if(n > 0)
|
|
return(-EIO);
|
|
}
|
|
}
|
|
else {
|
|
int res;
|
|
unsigned long args[] = { (unsigned long) addr, len, 0, 0, 0,
|
|
0 };
|
|
|
|
res = run_syscall_stub(mm_idp, __NR_munmap, args);
|
|
if(res < 0)
|
|
printk("munmap stub failed, errno = %d\n", res);
|
|
}
|
|
|
|
return(0);
|
|
}
|
|
|
|
int protect(struct mm_id *mm_idp, unsigned long addr, unsigned long len,
|
|
int r, int w, int x)
|
|
{
|
|
struct proc_mm_op protect;
|
|
int prot, n;
|
|
|
|
prot = (r ? PROT_READ : 0) | (w ? PROT_WRITE : 0) |
|
|
(x ? PROT_EXEC : 0);
|
|
|
|
if(proc_mm){
|
|
int fd = mm_idp->u.mm_fd;
|
|
protect = ((struct proc_mm_op) { .op = MM_MPROTECT,
|
|
.u =
|
|
{ .mprotect =
|
|
{ .addr =
|
|
(unsigned long) addr,
|
|
.len = len,
|
|
.prot = prot } } } );
|
|
|
|
n = os_write_file(fd, &protect, sizeof(protect));
|
|
if(n != sizeof(protect))
|
|
panic("protect failed, err = %d", -n);
|
|
}
|
|
else {
|
|
int res;
|
|
unsigned long args[] = { addr, len, prot, 0, 0, 0 };
|
|
|
|
res = run_syscall_stub(mm_idp, __NR_mprotect, args);
|
|
if(res < 0)
|
|
panic("mprotect stub failed, errno = %d\n", res);
|
|
}
|
|
|
|
return(0);
|
|
}
|
|
|
|
void before_mem_skas(unsigned long unused)
|
|
{
|
|
}
|