ca971bbfd8
This patch changes the top-level directory layout as a preparatory step for improving the tools for managing 3rd-party source codes. The rationale is described in the issue referenced below. Issue #1082
323 lines
7.6 KiB
C++
323 lines
7.6 KiB
C++
/*
|
|
* \brief Fiasco thread facility
|
|
* \author Stefan Kalkowski
|
|
* \date 2011-01-04
|
|
*/
|
|
|
|
/*
|
|
* Copyright (C) 2011-2013 Genode Labs GmbH
|
|
*
|
|
* This file is part of the Genode OS framework, which is distributed
|
|
* under the terms of the GNU General Public License version 2.
|
|
*/
|
|
|
|
/* Genode includes */
|
|
#include <base/ipc.h>
|
|
#include <base/printf.h>
|
|
#include <util/string.h>
|
|
|
|
/* core includes */
|
|
#include <cap_session_component.h>
|
|
#include <platform_thread.h>
|
|
#include <platform.h>
|
|
#include <core_env.h>
|
|
|
|
/* Fiasco includes */
|
|
namespace Fiasco {
|
|
#include <l4/sys/debugger.h>
|
|
#include <l4/sys/factory.h>
|
|
#include <l4/sys/irq.h>
|
|
#include <l4/sys/scheduler.h>
|
|
#include <l4/sys/thread.h>
|
|
#include <l4/sys/types.h>
|
|
}
|
|
|
|
using namespace Genode;
|
|
using namespace Fiasco;
|
|
|
|
|
|
int Platform_thread::start(void *ip, void *sp)
|
|
{
|
|
/* map the pager cap */
|
|
if (_platform_pd)
|
|
_pager.map(_platform_pd->native_task().dst());
|
|
|
|
/* reserve utcb area and associate thread with this task */
|
|
l4_thread_control_start();
|
|
l4_thread_control_pager(_pager.remote);
|
|
l4_thread_control_exc_handler(_pager.remote);
|
|
l4_thread_control_bind(_utcb, _platform_pd->native_task().dst());
|
|
l4_msgtag_t tag = l4_thread_control_commit(_thread.local.dst());
|
|
if (l4_msgtag_has_error(tag)) {
|
|
PWRN("l4_thread_control_commit for %lx failed!",
|
|
(unsigned long) _thread.local.dst());
|
|
return -1;
|
|
}
|
|
|
|
_state = RUNNING;
|
|
|
|
/* set ip and sp and run the thread */
|
|
tag = l4_thread_ex_regs(_thread.local.dst(), (l4_addr_t) ip,
|
|
(l4_addr_t) sp, 0);
|
|
if (l4_msgtag_has_error(tag)) {
|
|
PWRN("l4_thread_ex_regs failed!");
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
void Platform_thread::pause()
|
|
{
|
|
if (!_pager_obj)
|
|
return;
|
|
|
|
_pager_obj->state.lock.lock();
|
|
|
|
if (_pager_obj->state.paused == true) {
|
|
_pager_obj->state.lock.unlock();
|
|
return;
|
|
}
|
|
|
|
unsigned exc = _pager_obj->state.exceptions;
|
|
_pager_obj->state.ip = ~0UL;
|
|
_pager_obj->state.sp = ~0UL;
|
|
l4_umword_t flags = L4_THREAD_EX_REGS_TRIGGER_EXCEPTION;
|
|
|
|
/* Mark thread to be stopped */
|
|
_pager_obj->state.paused = true;
|
|
|
|
/*
|
|
* Force the thread to be paused to trigger an exception.
|
|
* The pager thread, which also acts as exception handler, will
|
|
* leave the thread in exception state until, it gets woken again
|
|
*/
|
|
l4_thread_ex_regs_ret(_thread.local.dst(), &_pager_obj->state.ip,
|
|
&_pager_obj->state.sp, &flags);
|
|
|
|
/*
|
|
* The thread state ("ready") is encoded in the lowest bit of the flags.
|
|
*/
|
|
bool in_syscall = (flags & 1) == 0;
|
|
_pager_obj->state.lock.unlock();
|
|
|
|
/**
|
|
* Check whether the thread was in ongoing ipc, if so it won't raise
|
|
* an exception before ipc is completed.
|
|
*/
|
|
if (!in_syscall) {
|
|
/*
|
|
* Wait until the pager thread got an exception from
|
|
* the requested thread, and stored its thread state
|
|
*/
|
|
while (exc == _pager_obj->state.exceptions && !_pager_obj->state.in_exception)
|
|
l4_thread_switch(_thread.local.dst());
|
|
}
|
|
}
|
|
|
|
|
|
void Platform_thread::resume()
|
|
{
|
|
if (!_pager_obj)
|
|
return;
|
|
|
|
_pager_obj->state.lock.lock();
|
|
|
|
/* Mark thread to be runable again */
|
|
_pager_obj->state.paused = false;
|
|
_pager_obj->state.lock.unlock();
|
|
|
|
/* Send a message to the exception handler, to unblock the client */
|
|
Msgbuf<16> snd, rcv;
|
|
Ipc_client ipc_client(_pager_obj->cap(), &snd, &rcv);
|
|
ipc_client << _pager_obj << IPC_CALL;
|
|
}
|
|
|
|
|
|
void Platform_thread::bind(Platform_pd *pd)
|
|
{
|
|
_platform_pd = pd;
|
|
_gate.map(pd->native_task().dst());
|
|
_irq.map(pd->native_task().dst());
|
|
}
|
|
|
|
|
|
void Platform_thread::unbind()
|
|
{
|
|
if (_state == RUNNING) {
|
|
/* first set the thread as its own pager */
|
|
l4_thread_control_start();
|
|
l4_thread_control_pager(_gate.remote);
|
|
l4_thread_control_exc_handler(_gate.remote);
|
|
if (l4_msgtag_has_error(l4_thread_control_commit(_thread.local.dst())))
|
|
PWRN("l4_thread_control_commit for %lx failed!",
|
|
(unsigned long) _thread.local.dst());
|
|
|
|
/* now force it into a pagefault */
|
|
l4_thread_ex_regs(_thread.local.dst(), 0, 0, L4_THREAD_EX_REGS_CANCEL);
|
|
}
|
|
|
|
_platform_pd = (Platform_pd*) 0;
|
|
}
|
|
|
|
|
|
void Platform_thread::pager(Pager_object *pager_obj)
|
|
{
|
|
_pager_obj = pager_obj;
|
|
if (_pager_obj)
|
|
_pager.local = pager_obj->cap();
|
|
else
|
|
_pager.local = Native_capability();
|
|
}
|
|
|
|
|
|
void Platform_thread::state(Thread_state s)
|
|
{
|
|
if (_pager_obj)
|
|
_pager_obj->state = s;
|
|
}
|
|
|
|
|
|
Thread_state Platform_thread::state()
|
|
{
|
|
Thread_state s;
|
|
if (_pager_obj) s = _pager_obj->state;
|
|
|
|
s.kcap = _gate.remote;
|
|
s.id = _gate.local.local_name();
|
|
s.utcb = _utcb;
|
|
|
|
return s;
|
|
}
|
|
|
|
|
|
void Platform_thread::cancel_blocking()
|
|
{
|
|
l4_irq_trigger(_irq.local.dst());
|
|
}
|
|
|
|
|
|
void Platform_thread::affinity(Affinity::Location location)
|
|
{
|
|
_location = location;
|
|
|
|
int const cpu = location.xpos();
|
|
|
|
l4_sched_param_t params = l4_sched_param(_prio);
|
|
params.affinity = l4_sched_cpu_set(cpu, 0, 1);
|
|
l4_msgtag_t tag = l4_scheduler_run_thread(L4_BASE_SCHEDULER_CAP,
|
|
_thread.local.dst(), ¶ms);
|
|
if (l4_error(tag))
|
|
PWRN("setting affinity of %lx to %d failed!", _thread.local.dst(), cpu);
|
|
}
|
|
|
|
|
|
Affinity::Location Platform_thread::affinity()
|
|
{
|
|
return _location;
|
|
}
|
|
|
|
|
|
void Platform_thread::_create_thread()
|
|
{
|
|
l4_msgtag_t tag = l4_factory_create_thread(L4_BASE_FACTORY_CAP,
|
|
_thread.local.dst());
|
|
if (l4_msgtag_has_error(tag))
|
|
PERR("cannot create more thread kernel-objects!");
|
|
|
|
/* create initial gate for thread */
|
|
_gate.local = Cap_session_component::alloc(0, _thread.local);
|
|
}
|
|
|
|
|
|
void Platform_thread::_finalize_construction(const char *name)
|
|
{
|
|
/* create irq for new thread */
|
|
l4_msgtag_t tag = l4_factory_create_irq(L4_BASE_FACTORY_CAP,
|
|
_irq.local.dst());
|
|
if (l4_msgtag_has_error(tag))
|
|
PWRN("creating thread's irq failed");
|
|
|
|
/* attach thread to irq */
|
|
tag = l4_irq_attach(_irq.local.dst(), 0, _thread.local.dst());
|
|
if (l4_msgtag_has_error(tag))
|
|
PWRN("attaching thread's irq failed");
|
|
|
|
/* set human readable name in kernel debugger */
|
|
strncpy(_name, name, sizeof(_name));
|
|
Fiasco::l4_debugger_set_object_name(_thread.local.dst(), name);
|
|
|
|
/* set priority of thread */
|
|
l4_sched_param_t params = l4_sched_param(_prio);
|
|
l4_scheduler_run_thread(L4_BASE_SCHEDULER_CAP, _thread.local.dst(),
|
|
¶ms);
|
|
}
|
|
|
|
|
|
Weak_ptr<Address_space> Platform_thread::address_space()
|
|
{
|
|
return _platform_pd->Address_space::weak_ptr();
|
|
}
|
|
|
|
|
|
Platform_thread::Platform_thread(const char *name, unsigned prio, addr_t)
|
|
: _state(DEAD),
|
|
_core_thread(false),
|
|
_thread(true),
|
|
_irq(true),
|
|
_utcb(0),
|
|
_platform_pd(0),
|
|
_pager_obj(0),
|
|
_prio(Cpu_session::scale_priority(DEFAULT_PRIORITY, prio))
|
|
{
|
|
((Core_cap_index*)_thread.local.idx())->pt(this);
|
|
_create_thread();
|
|
_finalize_construction(name);
|
|
}
|
|
|
|
|
|
Platform_thread::Platform_thread(Core_cap_index* thread,
|
|
Core_cap_index* irq, const char *name)
|
|
: _state(RUNNING),
|
|
_core_thread(true),
|
|
_thread(Native_capability(thread), L4_BASE_THREAD_CAP),
|
|
_irq(Native_capability(irq)),
|
|
_utcb(0),
|
|
_platform_pd(0),
|
|
_pager_obj(0),
|
|
_prio(Cpu_session::scale_priority(DEFAULT_PRIORITY, 0))
|
|
{
|
|
reinterpret_cast<Core_cap_index*>(_thread.local.idx())->pt(this);
|
|
_finalize_construction(name);
|
|
}
|
|
|
|
|
|
Platform_thread::Platform_thread(const char *name)
|
|
: _state(DEAD),
|
|
_core_thread(true),
|
|
_thread(true),
|
|
_irq(true),
|
|
_utcb(0),
|
|
_platform_pd(0),
|
|
_pager_obj(0),
|
|
_prio(Cpu_session::scale_priority(DEFAULT_PRIORITY, 0))
|
|
{
|
|
((Core_cap_index*)_thread.local.idx())->pt(this);
|
|
_create_thread();
|
|
_finalize_construction(name);
|
|
}
|
|
|
|
|
|
Platform_thread::~Platform_thread()
|
|
{
|
|
_gate.local.idx()->dec();
|
|
|
|
/*
|
|
* We inform our protection domain about thread destruction, which will end up in
|
|
* Thread::unbind()
|
|
*/
|
|
if (_platform_pd)
|
|
_platform_pd->unbind_thread(this);
|
|
}
|