netbsd/sys/arch/usermode/modules/syscallemu/syscallemu.c

/* $NetBSD: syscallemu.c,v 1.1 2012/01/05 13:26:51 jmcneill Exp $ */

/*-
 * Copyright (c) 2012 Jared D. McNeill <jmcneill@invisible.ca>
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: syscallemu.c,v 1.1 2012/01/05 13:26:51 jmcneill Exp $");

#include <sys/param.h>
#include <sys/proc.h>
#include <sys/systm.h>
#include <sys/module.h>
#include <sys/atomic.h>
#include <sys/syscallvar.h>

#include "syscallemu.h"

#if !defined(__HAVE_SYSCALL_INTERN)
#error syscallemu requires __HAVE_SYSCALL_INTERN
#endif

static specificdata_key_t syscallemu_data_key;
static unsigned int syscallemu_refcnt;

static const struct syscall_package syscallemu_syscalls[] = {
	{ SYS_syscallemu,	0, (sy_call_t *)sys_syscallemu	},
	{ 0, 0, NULL },
};

struct syscallemu_data *
syscallemu_getsce(struct proc *p)
{
	return proc_getspecific(p, syscallemu_data_key);
}

void
syscallemu_setsce(struct proc *p, struct syscallemu_data *sce)
{
	proc_setspecific(p, syscallemu_data_key, sce);
}

/*
 * specificdata destructor
 */
static void
syscallemu_dtor(void *priv)
{
	struct syscallemu_data *sce = priv;

	kmem_free(sce, sizeof(*sce));
	atomic_dec_uint(&syscallemu_refcnt);
}

/*
 * Allocate private storage for the syscallemu parameters and stash it
 * in process specificdata. This can only be called once per process.
 *
 * Returns EINVAL if the specified start address falls after the end.
 * Returns EACCESS if syscallemu has already been configured for this process.
 */
int
sys_syscallemu(lwp_t *l, const struct sys_syscallemu_args *uap,
    register_t *retval)
{
	/* {
		syscallarg(uintptr_t) user_start;
		syscallarg(uintptr_t) user_end;
	} */
	vaddr_t user_start = (vaddr_t)SCARG(uap, user_start);
	vaddr_t user_end = (vaddr_t)SCARG(uap, user_end);
	struct syscallemu_data *sce;
	struct proc *p = l->l_proc;

	if (syscallemu_getsce(p) != NULL)
		return EACCES;
	if (user_start >= user_end)
		return EINVAL;

	sce = kmem_alloc(sizeof(*sce), KM_SLEEP);
	sce->sce_user_start = user_start;
	sce->sce_user_end = user_end;
	sce->sce_md_syscall = md_syscallemu(p);
	KASSERT(sce->sce_md_syscall != NULL);

	atomic_inc_uint(&syscallemu_refcnt);
	syscallemu_setsce(p, sce);

#ifdef DEBUG
	printf("syscallemu: enabled for pid %d\n", p->p_pid);
#endif

	return 0;
}

/*
 * Initialize the syscallemu module
 */
static int
syscallemu_init(void)
{
	int error;

	syscallemu_refcnt = 0;

	/* XXX workaround for kern/45781 */
	if (emul_netbsd.e_sysent[SYS_syscallemu].sy_call == sys_nosys) {
		printf("syscallemu: applying workaround for kern/45781\n");
		emul_netbsd.e_sysent[SYS_syscallemu].sy_call = sys_nomodule;
	}
	emul_netbsd.e_sysent[SYS_syscallemu].sy_narg =
	    sizeof(struct sys_syscallemu_args) / sizeof(register_t);
	emul_netbsd.e_sysent[SYS_syscallemu].sy_argsize =
	    sizeof(struct sys_syscallemu_args);

	error = proc_specific_key_create(&syscallemu_data_key, syscallemu_dtor);
	if (error) {
		printf("syscallemu: couldn't create proc specific key (%d)\n",
		    error);
		return error;
	}

	error = syscall_establish(NULL, syscallemu_syscalls);
	if (error) {
		printf("syscallemu: couldn't establish syscalls\n");
		proc_specific_key_delete(syscallemu_data_key);
		return ENXIO;
	}

	return 0;
}

/*
 * Finalize the syscallemu module
 */
static int
syscallemu_fini(void)
{
	if (syscallemu_refcnt > 0)
		return EBUSY;

	syscall_disestablish(NULL, syscallemu_syscalls);
	proc_specific_key_delete(syscallemu_data_key);
	return 0;
}

/*
 * Module glue
 */
MODULE(MODULE_CLASS_MISC, syscallemu, NULL);

static int
syscallemu_modcmd(modcmd_t cmd, void *arg)
{
	switch (cmd) {
	case MODULE_CMD_INIT:
		return syscallemu_init();	
	case MODULE_CMD_FINI:
		return syscallemu_fini();
	case MODULE_CMD_AUTOUNLOAD:
		return EBUSY;
	default:
		return ENOTTY;
	}
}