110 lines
2.9 KiB
C++
110 lines
2.9 KiB
C++
/**
|
|
* \brief Core implementation of the CPU session interface extension
|
|
* \author Stefan Kalkowski
|
|
* \date 2011-04-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/printf.h>
|
|
|
|
/* Core includes */
|
|
#include <cpu_session_component.h>
|
|
#include <platform.h>
|
|
|
|
/* Fiasco.OC includes */
|
|
namespace Fiasco {
|
|
#include <l4/sys/thread.h>
|
|
#include <l4/sys/factory.h>
|
|
}
|
|
|
|
static Genode::Avl_tree<Genode::Cpu_session_irqs> _irq_tree;
|
|
|
|
Genode::Ram_dataspace_capability Genode::Cpu_session_component::utcb(Genode::Thread_capability thread_cap)
|
|
{
|
|
using namespace Genode;
|
|
PERR("%s: Not implemented", __PRETTY_FUNCTION__);
|
|
return Ram_dataspace_capability();
|
|
}
|
|
|
|
|
|
void Genode::Cpu_session_component::enable_vcpu(Genode::Thread_capability thread_cap,
|
|
Genode::addr_t vcpu_state)
|
|
{
|
|
using namespace Genode;
|
|
using namespace Fiasco;
|
|
|
|
Object_pool<Cpu_thread_component>::Guard thread(_thread_ep->lookup_and_lock(thread_cap));
|
|
if (!thread) return;
|
|
|
|
Native_thread tid = thread->platform_thread()->thread().local.dst();
|
|
|
|
l4_msgtag_t tag = l4_thread_vcpu_control(tid, vcpu_state);
|
|
if (l4_msgtag_has_error(tag))
|
|
PWRN("l4_thread_vcpu_control failed");
|
|
}
|
|
|
|
|
|
Genode::Native_capability
|
|
Genode::Cpu_session_component::native_cap(Genode::Thread_capability cap)
|
|
{
|
|
using namespace Genode;
|
|
|
|
Object_pool<Cpu_thread_component>::Guard thread(_thread_ep->lookup_and_lock(cap));
|
|
if (!thread) return Native_capability();
|
|
|
|
return thread->platform_thread()->thread().local;
|
|
}
|
|
|
|
|
|
Genode::Native_capability Genode::Cpu_session_component::alloc_irq()
|
|
{
|
|
using namespace Fiasco;
|
|
using namespace Genode;
|
|
|
|
/* find irq object container of this cpu-session */
|
|
Cpu_session_irqs* node = _irq_tree.first();
|
|
if (node)
|
|
node = node->find_by_session(this);
|
|
|
|
/* if not found, we've to create one */
|
|
if (!node) {
|
|
node = new (&_md_alloc) Cpu_session_irqs(this);
|
|
_irq_tree.insert(node);
|
|
}
|
|
|
|
/* construct irq kernel-object */
|
|
Cap_index* i = cap_map()->insert(platform_specific()->cap_id_alloc()->alloc());
|
|
l4_msgtag_t res = l4_factory_create_irq(L4_BASE_FACTORY_CAP, i->kcap());
|
|
if (l4_error(res)) {
|
|
PWRN("Allocation of irq object failed!");
|
|
return Genode::Native_capability();
|
|
}
|
|
|
|
/* construct cap and hold a reference in the irq container object */
|
|
Genode::Native_capability cap(i);
|
|
return (node->add(cap)) ? cap : Genode::Native_capability();
|
|
}
|
|
|
|
|
|
void Genode::Cpu_session_component::single_step(Genode::Thread_capability thread_cap, bool enable)
|
|
{
|
|
using namespace Genode;
|
|
|
|
Object_pool<Cpu_thread_component>::Guard thread(_thread_ep->lookup_and_lock(thread_cap));
|
|
if (!thread) return;
|
|
|
|
Native_thread tid = thread->platform_thread()->thread().local.dst();
|
|
|
|
enum { THREAD_SINGLE_STEP = 0x40000 };
|
|
int flags = enable ? THREAD_SINGLE_STEP : 0;
|
|
|
|
Fiasco::l4_thread_ex_regs(tid, ~0UL, ~0UL, flags);
|
|
}
|