First try at TLS support and getcontext/setcontext/swapcontext support.
This commit is contained in:
parent
268058c040
commit
b19ccb8124
@ -1,4 +1,4 @@
|
||||
/* $NetBSD: cpu.c,v 1.75 2018/05/17 19:00:39 reinoud Exp $ */
|
||||
/* $NetBSD: cpu.c,v 1.76 2018/05/24 19:39:04 reinoud Exp $ */
|
||||
|
||||
/*-
|
||||
* Copyright (c) 2007 Jared D. McNeill <jmcneill@invisible.ca>
|
||||
@ -30,7 +30,7 @@
|
||||
#include "opt_hz.h"
|
||||
|
||||
#include <sys/cdefs.h>
|
||||
__KERNEL_RCSID(0, "$NetBSD: cpu.c,v 1.75 2018/05/17 19:00:39 reinoud Exp $");
|
||||
__KERNEL_RCSID(0, "$NetBSD: cpu.c,v 1.76 2018/05/24 19:39:04 reinoud Exp $");
|
||||
|
||||
#include <sys/param.h>
|
||||
#include <sys/conf.h>
|
||||
@ -66,6 +66,11 @@ __KERNEL_RCSID(0, "$NetBSD: cpu.c,v 1.75 2018/05/17 19:00:39 reinoud Exp $");
|
||||
static int cpu_match(device_t, cfdata_t, void *);
|
||||
static void cpu_attach(device_t, device_t, void *);
|
||||
|
||||
/* XXX */
|
||||
//extern void *_lwp_getprivate(void);
|
||||
//extern int _lwp_setprivate(void *);
|
||||
|
||||
|
||||
struct cpu_info cpu_info_primary = {
|
||||
.ci_dev = 0,
|
||||
.ci_self = &cpu_info_primary,
|
||||
@ -130,7 +135,6 @@ cpu_configure(void)
|
||||
if (config_rootfound("mainbus", NULL) == NULL)
|
||||
panic("configure: mainbus not configured");
|
||||
|
||||
|
||||
spl0();
|
||||
}
|
||||
|
||||
@ -189,6 +193,8 @@ cpu_need_proftick(struct lwp *l)
|
||||
{
|
||||
}
|
||||
|
||||
|
||||
/* XXX make sure this is atomic? */
|
||||
static
|
||||
void
|
||||
cpu_switchto_atomic(lwp_t *oldlwp, lwp_t *newlwp)
|
||||
@ -208,12 +214,22 @@ cpu_switchto_atomic(lwp_t *oldlwp, lwp_t *newlwp)
|
||||
|
||||
thunk_seterrno(newpcb->pcb_errno);
|
||||
|
||||
/* set both ucontexts up for TLS just in case */
|
||||
newpcb->pcb_ucp.uc_mcontext._mc_tlsbase =
|
||||
(uintptr_t) newlwp->l_private;
|
||||
newpcb->pcb_ucp.uc_flags |= _UC_TLSBASE;
|
||||
|
||||
newpcb->pcb_userret_ucp.uc_mcontext._mc_tlsbase =
|
||||
(uintptr_t) newlwp->l_private;
|
||||
newpcb->pcb_userret_ucp.uc_flags |= _UC_TLSBASE;
|
||||
|
||||
curlwp = newlwp;
|
||||
if (thunk_setcontext(&newpcb->pcb_ucp))
|
||||
panic("setcontext failed");
|
||||
/* not reached */
|
||||
}
|
||||
|
||||
|
||||
lwp_t *
|
||||
cpu_switchto(lwp_t *oldlwp, lwp_t *newlwp, bool returning)
|
||||
{
|
||||
@ -232,17 +248,23 @@ cpu_switchto(lwp_t *oldlwp, lwp_t *newlwp, bool returning)
|
||||
newlwp ? newlwp->l_lid : -1);
|
||||
if (oldpcb) {
|
||||
thunk_printf_debug(" oldpcb uc_link=%p, uc_stack.ss_sp=%p, "
|
||||
"uc_stack.ss_size=%d\n",
|
||||
"uc_stack.ss_size=%d, l_private %p, uc_mcontext._mc_tlsbase=%p(%s)\n",
|
||||
oldpcb->pcb_ucp.uc_link,
|
||||
oldpcb->pcb_ucp.uc_stack.ss_sp,
|
||||
(int)oldpcb->pcb_ucp.uc_stack.ss_size);
|
||||
(int)oldpcb->pcb_ucp.uc_stack.ss_size,
|
||||
(void *) oldlwp->l_private,
|
||||
(void *) oldpcb->pcb_ucp.uc_mcontext._mc_tlsbase,
|
||||
oldpcb->pcb_ucp.uc_flags & _UC_TLSBASE? "ON":"off");
|
||||
}
|
||||
if (newpcb) {
|
||||
thunk_printf_debug(" newpcb uc_link=%p, uc_stack.ss_sp=%p, "
|
||||
"uc_stack.ss_size=%d\n",
|
||||
thunk_printf_debug(" newpewcb uc_link=%p, uc_stack.ss_sp=%p, "
|
||||
"uc_stack.ss_size=%d, l_private %p, uc_mcontext._mc_tlsbase=%p(%s)\n",
|
||||
newpcb->pcb_ucp.uc_link,
|
||||
newpcb->pcb_ucp.uc_stack.ss_sp,
|
||||
(int)newpcb->pcb_ucp.uc_stack.ss_size);
|
||||
(int)newpcb->pcb_ucp.uc_stack.ss_size,
|
||||
(void *) newlwp->l_private,
|
||||
(void *) newpcb->pcb_ucp.uc_mcontext._mc_tlsbase,
|
||||
newpcb->pcb_ucp.uc_flags & _UC_TLSBASE? "ON":"off");
|
||||
}
|
||||
#endif /* !CPU_DEBUG */
|
||||
|
||||
@ -250,7 +272,6 @@ cpu_switchto(lwp_t *oldlwp, lwp_t *newlwp, bool returning)
|
||||
KASSERT(newlwp);
|
||||
thunk_makecontext(&sc->sc_ucp, (void (*)(void)) cpu_switchto_atomic,
|
||||
2, oldlwp, newlwp, NULL, NULL);
|
||||
|
||||
KASSERT(sc);
|
||||
if (oldpcb) {
|
||||
thunk_swapcontext(&oldpcb->pcb_ucp, &sc->sc_ucp);
|
||||
@ -284,11 +305,16 @@ cpu_getmcontext(struct lwp *l, mcontext_t *mcp, unsigned int *flags)
|
||||
{
|
||||
struct pcb *pcb = lwp_getpcb(l);
|
||||
ucontext_t *ucp = &pcb->pcb_userret_ucp;
|
||||
|
||||
|
||||
#ifdef CPU_DEBUG
|
||||
thunk_printf_debug("cpu_getmcontext\n");
|
||||
#endif
|
||||
memcpy(mcp, &ucp->uc_mcontext, sizeof(mcontext_t));
|
||||
|
||||
/* XXX be overzealous and provide all */
|
||||
mcp->_mc_tlsbase = (uintptr_t) l->l_private;
|
||||
*flags = _UC_CPU | _UC_STACK | _UC_SIGMASK | _UC_FPU | _UC_TLSBASE;
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
@ -299,6 +325,10 @@ cpu_mcontext_validate(struct lwp *l, const mcontext_t *mcp)
|
||||
* can we check here? or should that be done in the target
|
||||
* specific places?
|
||||
*/
|
||||
/* XXX NO CHECKING! XXX */
|
||||
#ifdef CPU_DEBUG
|
||||
thunk_printf("cpu_mcontext_validate\n");
|
||||
#endif
|
||||
return 0;
|
||||
}
|
||||
|
||||
@ -311,7 +341,12 @@ cpu_setmcontext(struct lwp *l, const mcontext_t *mcp, unsigned int flags)
|
||||
#ifdef CPU_DEBUG
|
||||
thunk_printf_debug("cpu_setmcontext\n");
|
||||
#endif
|
||||
ucp->uc_flags = flags;
|
||||
memcpy(&ucp->uc_mcontext, mcp, sizeof(mcontext_t));
|
||||
|
||||
/* update our private, it might be altered in userland */
|
||||
l->l_private = (void *) ucp->uc_mcontext._mc_tlsbase;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
@ -382,10 +417,14 @@ cpu_lwp_fork(struct lwp *l1, struct lwp *l2, void *stack, size_t stacksize,
|
||||
/* copy the PCB and its switchframes from parent */
|
||||
memcpy(pcb2, pcb1, sizeof(struct pcb));
|
||||
|
||||
/* refresh context */
|
||||
/* refresh context, XXX needed? */
|
||||
if (thunk_getcontext(&pcb2->pcb_ucp))
|
||||
panic("getcontext failed");
|
||||
|
||||
/* set up for TLS */
|
||||
pcb2->pcb_ucp.uc_mcontext._mc_tlsbase = (intptr_t) l2->l_private;
|
||||
pcb2->pcb_ucp.uc_flags |= _UC_TLSBASE;
|
||||
|
||||
/* recalculate the system stack top */
|
||||
pcb2->sys_stack_top = pcb2->sys_stack + TRAPSTACKSIZE;
|
||||
|
||||
@ -395,7 +434,7 @@ cpu_lwp_fork(struct lwp *l1, struct lwp *l2, void *stack, size_t stacksize,
|
||||
pcb2->pcb_ucp.uc_link = &pcb2->pcb_userret_ucp;
|
||||
|
||||
thunk_sigemptyset(&pcb2->pcb_ucp.uc_sigmask);
|
||||
pcb2->pcb_ucp.uc_flags = _UC_STACK | _UC_CPU | _UC_SIGMASK;
|
||||
|
||||
thunk_makecontext(&pcb2->pcb_ucp,
|
||||
(void (*)(void)) cpu_lwp_trampoline,
|
||||
3, &pcb2->pcb_ucp, func, arg, NULL);
|
||||
|
Loading…
Reference in New Issue
Block a user