diff options
Diffstat (limited to 'sys/kern/p1003_1b.c')
| -rw-r--r-- | sys/kern/p1003_1b.c | 315 |
1 files changed, 315 insertions, 0 deletions
diff --git a/sys/kern/p1003_1b.c b/sys/kern/p1003_1b.c new file mode 100644 index 0000000..fb89efc --- /dev/null +++ b/sys/kern/p1003_1b.c @@ -0,0 +1,315 @@ +/*- + * Copyright (c) 1996, 1997, 1998 + * HD Associates, Inc. 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. + * 3. All advertising materials mentioning features or use of this software + * must display the following acknowledgement: + * This product includes software developed by HD Associates, Inc + * 4. Neither the name of the author nor the names of any co-contributors + * may be used to endorse or promote products derived from this software + * without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY HD ASSOCIATES 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 HD ASSOCIATES 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. + */ + +/* p1003_1b: Real Time common code. + */ + +#include <sys/cdefs.h> +__FBSDID("$FreeBSD$"); + +#include "opt_posix.h" + +#include <sys/param.h> +#include <sys/systm.h> +#include <sys/kernel.h> +#include <sys/lock.h> +#include <sys/module.h> +#include <sys/mutex.h> +#include <sys/priv.h> +#include <sys/proc.h> +#include <sys/posix4.h> +#include <sys/syscallsubr.h> +#include <sys/sysctl.h> +#include <sys/sysent.h> +#include <sys/syslog.h> +#include <sys/sysproto.h> + +MALLOC_DEFINE(M_P31B, "p1003.1b", "Posix 1003.1B"); + +/* The system calls return ENOSYS if an entry is called that is not run-time + * supported. I am also logging since some programs start to use this when + * they shouldn't. That will be removed if annoying. + */ +int +syscall_not_present(struct thread *td, const char *s, struct nosys_args *uap) +{ + log(LOG_ERR, "cmd %s pid %d tried to use non-present %s\n", + td->td_name, td->td_proc->p_pid, s); + + /* a " return nosys(p, uap); " here causes a core dump. + */ + + return ENOSYS; +} + +#if !defined(_KPOSIX_PRIORITY_SCHEDULING) + +/* Not configured but loadable via a module: + */ + +static int +sched_attach(void) +{ + return 0; +} + +SYSCALL_NOT_PRESENT_GEN(sched_setparam) +SYSCALL_NOT_PRESENT_GEN(sched_getparam) +SYSCALL_NOT_PRESENT_GEN(sched_setscheduler) +SYSCALL_NOT_PRESENT_GEN(sched_getscheduler) +SYSCALL_NOT_PRESENT_GEN(sched_yield) +SYSCALL_NOT_PRESENT_GEN(sched_get_priority_max) +SYSCALL_NOT_PRESENT_GEN(sched_get_priority_min) +SYSCALL_NOT_PRESENT_GEN(sched_rr_get_interval) +#else + +/* Configured in kernel version: + */ +static struct ksched *ksched; + +static int +sched_attach(void) +{ + int ret = ksched_attach(&ksched); + + if (ret == 0) + p31b_setcfg(CTL_P1003_1B_PRIORITY_SCHEDULING, 200112L); + + return ret; +} + +int +sys_sched_setparam(struct thread *td, struct sched_setparam_args *uap) +{ + struct thread *targettd; + struct proc *targetp; + int e; + struct sched_param sched_param; + + e = copyin(uap->param, &sched_param, sizeof(sched_param)); + if (e) + return (e); + + if (uap->pid == 0) { + targetp = td->td_proc; + targettd = td; + PROC_LOCK(targetp); + } else { + targetp = pfind(uap->pid); + if (targetp == NULL) + return (ESRCH); + targettd = FIRST_THREAD_IN_PROC(targetp); + } + + e = p_cansched(td, targetp); + if (e == 0) { + e = ksched_setparam(ksched, targettd, + (const struct sched_param *)&sched_param); + } + PROC_UNLOCK(targetp); + return (e); +} + +int +sys_sched_getparam(struct thread *td, struct sched_getparam_args *uap) +{ + int e; + struct sched_param sched_param; + struct thread *targettd; + struct proc *targetp; + + if (uap->pid == 0) { + targetp = td->td_proc; + targettd = td; + PROC_LOCK(targetp); + } else { + targetp = pfind(uap->pid); + if (targetp == NULL) { + return (ESRCH); + } + targettd = FIRST_THREAD_IN_PROC(targetp); + } + + e = p_cansee(td, targetp); + if (e == 0) { + e = ksched_getparam(ksched, targettd, &sched_param); + } + PROC_UNLOCK(targetp); + if (e == 0) + e = copyout(&sched_param, uap->param, sizeof(sched_param)); + return (e); +} + +int +sys_sched_setscheduler(struct thread *td, struct sched_setscheduler_args *uap) +{ + int e; + struct sched_param sched_param; + struct thread *targettd; + struct proc *targetp; + + /* Don't allow non root user to set a scheduler policy. */ + e = priv_check(td, PRIV_SCHED_SET); + if (e) + return (e); + + e = copyin(uap->param, &sched_param, sizeof(sched_param)); + if (e) + return (e); + + if (uap->pid == 0) { + targetp = td->td_proc; + targettd = td; + PROC_LOCK(targetp); + } else { + targetp = pfind(uap->pid); + if (targetp == NULL) + return (ESRCH); + targettd = FIRST_THREAD_IN_PROC(targetp); + } + + e = p_cansched(td, targetp); + if (e == 0) { + e = ksched_setscheduler(ksched, targettd, + uap->policy, (const struct sched_param *)&sched_param); + } + PROC_UNLOCK(targetp); + return (e); +} + +int +sys_sched_getscheduler(struct thread *td, struct sched_getscheduler_args *uap) +{ + int e, policy; + struct thread *targettd; + struct proc *targetp; + + if (uap->pid == 0) { + targetp = td->td_proc; + targettd = td; + PROC_LOCK(targetp); + } else { + targetp = pfind(uap->pid); + if (targetp == NULL) + return (ESRCH); + targettd = FIRST_THREAD_IN_PROC(targetp); + } + + e = p_cansee(td, targetp); + if (e == 0) { + e = ksched_getscheduler(ksched, targettd, &policy); + td->td_retval[0] = policy; + } + PROC_UNLOCK(targetp); + + return (e); +} + +int +sys_sched_yield(struct thread *td, struct sched_yield_args *uap) +{ + + sched_relinquish(curthread); + return 0; +} + +int +sys_sched_get_priority_max(struct thread *td, + struct sched_get_priority_max_args *uap) +{ + int error, prio; + + error = ksched_get_priority_max(ksched, uap->policy, &prio); + td->td_retval[0] = prio; + return (error); +} + +int +sys_sched_get_priority_min(struct thread *td, + struct sched_get_priority_min_args *uap) +{ + int error, prio; + + error = ksched_get_priority_min(ksched, uap->policy, &prio); + td->td_retval[0] = prio; + return (error); +} + +int +sys_sched_rr_get_interval(struct thread *td, + struct sched_rr_get_interval_args *uap) +{ + struct timespec timespec; + int error; + + error = kern_sched_rr_get_interval(td, uap->pid, ×pec); + if (error == 0) + error = copyout(×pec, uap->interval, sizeof(timespec)); + return (error); +} + +int +kern_sched_rr_get_interval(struct thread *td, pid_t pid, + struct timespec *ts) +{ + int e; + struct thread *targettd; + struct proc *targetp; + + if (pid == 0) { + targettd = td; + targetp = td->td_proc; + PROC_LOCK(targetp); + } else { + targetp = pfind(pid); + if (targetp == NULL) + return (ESRCH); + targettd = FIRST_THREAD_IN_PROC(targetp); + } + + e = p_cansee(td, targetp); + if (e == 0) + e = ksched_rr_get_interval(ksched, targettd, ts); + PROC_UNLOCK(targetp); + return (e); +} + +#endif + +static void +p31binit(void *notused) +{ + (void) sched_attach(); + p31b_setcfg(CTL_P1003_1B_PAGESIZE, PAGE_SIZE); +} + +SYSINIT(p31b, SI_SUB_P1003_1B, SI_ORDER_FIRST, p31binit, NULL); |
