2012-05-30 20:13:09 +02:00
|
|
|
/*
|
|
|
|
* \brief Thread facility
|
|
|
|
* \author Martin Stein
|
|
|
|
* \date 2012-02-12
|
|
|
|
*/
|
|
|
|
|
|
|
|
/*
|
2013-01-10 21:44:47 +01:00
|
|
|
* Copyright (C) 2012-2013 Genode Labs GmbH
|
2012-05-30 20:13:09 +02:00
|
|
|
*
|
|
|
|
* This file is part of the Genode OS framework, which is distributed
|
|
|
|
* under the terms of the GNU General Public License version 2.
|
|
|
|
*/
|
|
|
|
|
|
|
|
/* core includes */
|
|
|
|
#include <platform_thread.h>
|
|
|
|
#include <core_env.h>
|
|
|
|
#include <rm_session_component.h>
|
|
|
|
|
|
|
|
using namespace Genode;
|
|
|
|
|
|
|
|
namespace Kernel { unsigned core_id(); }
|
|
|
|
|
|
|
|
|
2012-10-09 15:41:40 +02:00
|
|
|
bool Platform_thread::_attaches_utcb_by_itself()
|
|
|
|
{
|
|
|
|
/*
|
|
|
|
* If this is a main thread outside of core it'll not manage its
|
|
|
|
* virtual context area by itself, as it is done for other threads
|
|
|
|
* through a sub RM-session.
|
|
|
|
*/
|
2013-06-06 14:18:36 +02:00
|
|
|
return _pd_id == Kernel::core_id() || !main_thread();
|
2012-10-09 15:41:40 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
|
2013-03-08 11:54:12 +01:00
|
|
|
Weak_ptr<Address_space> Platform_thread::address_space()
|
|
|
|
{
|
|
|
|
return _address_space;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2012-10-09 15:41:40 +02:00
|
|
|
Platform_thread::~Platform_thread()
|
|
|
|
{
|
2013-08-30 13:30:19 +02:00
|
|
|
/* detach UTCB */
|
2012-10-09 15:41:40 +02:00
|
|
|
if (!_attaches_utcb_by_itself()) {
|
2013-09-18 13:16:17 +02:00
|
|
|
|
|
|
|
/* the RM client may be destructed before platform thread */
|
|
|
|
if (_rm_client) {
|
|
|
|
Rm_session_component * const rm = _rm_client->member_rm_session();
|
|
|
|
rm->detach(_virt_utcb);
|
|
|
|
}
|
2012-10-09 15:41:40 +02:00
|
|
|
}
|
|
|
|
/* free UTCB */
|
|
|
|
if (_pd_id == Kernel::core_id()) {
|
|
|
|
Range_allocator * const ram = platform()->ram_alloc();
|
|
|
|
ram->free((void *)_phys_utcb, sizeof(Native_utcb));
|
|
|
|
} else {
|
|
|
|
Ram_session_component * const ram =
|
|
|
|
dynamic_cast<Ram_session_component *>(core_env()->ram_session());
|
|
|
|
assert(ram);
|
|
|
|
ram->free(_utcb);
|
|
|
|
}
|
2013-09-18 23:40:38 +02:00
|
|
|
/* release from pager */
|
|
|
|
if (_rm_client) {
|
|
|
|
Pager_object * const object = dynamic_cast<Pager_object *>(_rm_client);
|
|
|
|
assert(object);
|
|
|
|
Rm_session_component * const rm = _rm_client->member_rm_session();
|
|
|
|
assert(rm);
|
|
|
|
Pager_capability cap = reinterpret_cap_cast<Pager_object>(object->cap());
|
|
|
|
rm->remove_client(cap);
|
|
|
|
}
|
2012-10-09 15:41:40 +02:00
|
|
|
/* destroy object at the kernel */
|
|
|
|
Kernel::delete_thread(_id);
|
|
|
|
}
|
|
|
|
|
2012-05-30 20:13:09 +02:00
|
|
|
Platform_thread::Platform_thread(const char * name,
|
|
|
|
Thread_base * const thread_base,
|
2012-12-19 14:46:48 +01:00
|
|
|
size_t const stack_size, unsigned const pd_id)
|
2012-05-30 20:13:09 +02:00
|
|
|
:
|
|
|
|
_thread_base(thread_base), _stack_size(stack_size),
|
2013-11-11 16:55:30 +01:00
|
|
|
_pd_id(pd_id), _rm_client(0), _virt_utcb(0),
|
|
|
|
_priority(Kernel::Priority::MAX),
|
|
|
|
_main_thread(0)
|
2012-05-30 20:13:09 +02:00
|
|
|
{
|
|
|
|
strncpy(_name, name, NAME_MAX_LEN);
|
|
|
|
|
|
|
|
/* create UTCB for a core thread */
|
|
|
|
Range_allocator * const ram = platform()->ram_alloc();
|
2013-08-30 13:30:19 +02:00
|
|
|
if (!ram->alloc_aligned(sizeof(Native_utcb), (void **)&_phys_utcb,
|
|
|
|
MIN_MAPPING_SIZE_LOG2).is_ok())
|
|
|
|
{
|
|
|
|
PERR("failed to allocate UTCB");
|
|
|
|
throw Cpu_session::Out_of_metadata();
|
|
|
|
}
|
2012-05-30 20:13:09 +02:00
|
|
|
_virt_utcb = _phys_utcb;
|
|
|
|
|
|
|
|
/* common constructor parts */
|
|
|
|
_init();
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
Platform_thread::Platform_thread(const char * name, unsigned int priority,
|
|
|
|
addr_t utcb)
|
|
|
|
:
|
|
|
|
_thread_base(0), _stack_size(0), _pd_id(0), _rm_client(0),
|
2013-11-11 16:55:30 +01:00
|
|
|
_virt_utcb((Native_utcb *)utcb),
|
|
|
|
_priority(Cpu_session::scale_priority(Kernel::Priority::MAX, priority)),
|
|
|
|
_main_thread(0)
|
2012-05-30 20:13:09 +02:00
|
|
|
{
|
|
|
|
strncpy(_name, name, NAME_MAX_LEN);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Allocate UTCB backing store for a thread outside of core. Page alignment
|
|
|
|
* is done by RAM session by default. It's save to use core env because
|
|
|
|
* this cannot be its server activation thread.
|
|
|
|
*/
|
2013-08-30 13:30:19 +02:00
|
|
|
Ram_session_component * const ram =
|
|
|
|
dynamic_cast<Ram_session_component *>(core_env()->ram_session());
|
|
|
|
assert(ram);
|
|
|
|
try { _utcb = ram->alloc(sizeof(Native_utcb), 1); }
|
|
|
|
catch (...) {
|
|
|
|
PERR("failed to allocate UTCB");
|
|
|
|
throw Cpu_session::Out_of_metadata();
|
2012-05-30 20:13:09 +02:00
|
|
|
}
|
2013-08-30 13:30:19 +02:00
|
|
|
_phys_utcb = (Native_utcb *)ram->phys_addr(_utcb);
|
2012-05-30 20:13:09 +02:00
|
|
|
|
|
|
|
/* common constructor parts */
|
|
|
|
_init();
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2013-03-08 11:54:12 +01:00
|
|
|
int Platform_thread::join_pd(unsigned const pd_id, bool const main_thread,
|
|
|
|
Weak_ptr<Address_space> address_space)
|
2012-05-30 20:13:09 +02:00
|
|
|
{
|
|
|
|
/* check if we're already in another PD */
|
2013-08-30 13:30:19 +02:00
|
|
|
if (_pd_id && _pd_id != pd_id) {
|
|
|
|
PERR("already joined a PD");
|
|
|
|
return -1;
|
|
|
|
}
|
2012-05-30 20:13:09 +02:00
|
|
|
/* denote configuration for start method */
|
2013-03-08 11:54:12 +01:00
|
|
|
_pd_id = pd_id;
|
|
|
|
_main_thread = main_thread;
|
|
|
|
_address_space = address_space;
|
2012-05-30 20:13:09 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void Platform_thread::_init()
|
|
|
|
{
|
2013-08-30 13:30:19 +02:00
|
|
|
/* create kernel object */
|
2012-10-09 15:41:40 +02:00
|
|
|
_id = Kernel::new_thread(_kernel_thread, this);
|
2013-08-30 13:30:19 +02:00
|
|
|
if (!_id) {
|
|
|
|
PERR("failed to create kernel object");
|
|
|
|
throw Cpu_session::Thread_creation_failed();
|
|
|
|
}
|
2012-05-30 20:13:09 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
int Platform_thread::start(void * ip, void * sp, unsigned int cpu_no)
|
|
|
|
{
|
2013-08-30 13:30:19 +02:00
|
|
|
/* must be in a PD to get started */
|
|
|
|
if (!_pd_id) {
|
|
|
|
PERR("invalid PD");
|
|
|
|
return -1;
|
|
|
|
}
|
2012-10-09 15:41:40 +02:00
|
|
|
/* attach UTCB if the thread can't do this by itself */
|
|
|
|
if (!_attaches_utcb_by_itself())
|
2012-05-30 20:13:09 +02:00
|
|
|
{
|
|
|
|
/*
|
|
|
|
* Declare page aligned virtual UTCB outside the context area.
|
|
|
|
* Kernel afterwards offers this as bootstrap argument to the thread.
|
|
|
|
*/
|
|
|
|
_virt_utcb = (Native_utcb *)((platform()->vm_start()
|
2013-09-18 23:40:38 +02:00
|
|
|
+ platform()->vm_size() - sizeof(Native_utcb))
|
|
|
|
& ~((1<<MIN_MAPPING_SIZE_LOG2)-1));
|
2012-05-30 20:13:09 +02:00
|
|
|
|
|
|
|
/* attach UTCB */
|
2013-08-30 13:30:19 +02:00
|
|
|
if (!_rm_client) {
|
|
|
|
PERR("invalid RM client");
|
|
|
|
return -1;
|
|
|
|
};
|
2012-05-30 20:13:09 +02:00
|
|
|
Rm_session_component * const rm = _rm_client->member_rm_session();
|
|
|
|
try { rm->attach(_utcb, 0, 0, true, _virt_utcb, 0); }
|
2013-08-30 13:30:19 +02:00
|
|
|
catch (...) {
|
|
|
|
PERR("failed to attach UTCB");
|
|
|
|
return -1;
|
|
|
|
}
|
2012-05-30 20:13:09 +02:00
|
|
|
}
|
|
|
|
/* let thread participate in CPU scheduling */
|
2012-11-07 07:56:22 +01:00
|
|
|
_tlb = Kernel::start_thread(this, ip, sp, cpu_no);
|
2013-08-30 13:30:19 +02:00
|
|
|
if (!_tlb) {
|
|
|
|
PERR("failed to start thread");
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
return 0;
|
2012-05-30 20:13:09 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void Platform_thread::pager(Pager_object * const pager)
|
|
|
|
{
|
2013-09-18 12:57:01 +02:00
|
|
|
if (pager) {
|
|
|
|
Kernel::set_pager(pager->cap().dst(), _id);
|
|
|
|
_rm_client = dynamic_cast<Rm_client *>(pager);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
Kernel::set_pager(0, _id);
|
|
|
|
_rm_client = 0;
|
|
|
|
return;
|
2012-05-30 20:13:09 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
|
2013-08-30 13:30:19 +02:00
|
|
|
Genode::Pager_object * Platform_thread::pager()
|
|
|
|
{
|
|
|
|
return _rm_client ? static_cast<Pager_object *>(_rm_client) : 0;
|
|
|
|
}
|
2013-11-11 13:03:07 +01:00
|
|
|
|
|
|
|
|
|
|
|
addr_t const * cpu_state_regs();
|
|
|
|
|
|
|
|
size_t cpu_state_regs_length();
|
|
|
|
|
|
|
|
|
|
|
|
Thread_state Platform_thread::state()
|
|
|
|
{
|
|
|
|
static addr_t const * const src = cpu_state_regs();
|
|
|
|
static size_t const length = cpu_state_regs_length();
|
|
|
|
static size_t const size = length * sizeof(src[0]);
|
|
|
|
void * dst = Thread_base::myself()->utcb()->base();
|
|
|
|
Genode::memcpy(dst, src, size);
|
|
|
|
Thread_state thread_state;
|
|
|
|
Cpu_state * const cpu_state = static_cast<Cpu_state *>(&thread_state);
|
|
|
|
if (Kernel::access_thread_regs(id(), length, 0, (addr_t *)cpu_state, 0)) {
|
|
|
|
throw Cpu_session::State_access_failed();
|
|
|
|
}
|
|
|
|
return thread_state;
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
void Platform_thread::state(Thread_state thread_state)
|
|
|
|
{
|
|
|
|
static addr_t const * const src = cpu_state_regs();
|
|
|
|
static size_t const length = cpu_state_regs_length();
|
|
|
|
static size_t const size = length * sizeof(src[0]);
|
|
|
|
void * dst = Thread_base::myself()->utcb()->base();
|
|
|
|
Genode::memcpy(dst, src, size);
|
|
|
|
Cpu_state * const cpu_state = static_cast<Cpu_state *>(&thread_state);
|
|
|
|
if (Kernel::access_thread_regs(id(), 0, length, 0, (addr_t *)cpu_state)) {
|
|
|
|
throw Cpu_session::State_access_failed();
|
|
|
|
}
|
|
|
|
};
|