2011-12-22 16:19:25 +01:00
|
|
|
/*
|
|
|
|
* \brief Implementation of IRQ session component
|
|
|
|
* \author Norman Feske
|
|
|
|
* \date 2009-10-02
|
|
|
|
*/
|
|
|
|
|
|
|
|
/*
|
2013-01-10 21:44:47 +01:00
|
|
|
* Copyright (C) 2009-2013 Genode Labs GmbH
|
2011-12-22 16:19:25 +01:00
|
|
|
*
|
|
|
|
* 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>
|
|
|
|
#include <base/sleep.h>
|
|
|
|
|
|
|
|
/* core includes */
|
|
|
|
#include <irq_root.h>
|
|
|
|
|
|
|
|
/* Codezero includes */
|
|
|
|
#include <codezero/syscalls.h>
|
|
|
|
|
|
|
|
|
2015-03-17 15:41:47 +01:00
|
|
|
namespace Genode {
|
|
|
|
typedef Irq_proxy<Thread<1024 * sizeof(addr_t)> > Irq_proxy_base;
|
|
|
|
class Irq_proxy_component;
|
|
|
|
}
|
|
|
|
|
2011-12-22 16:19:25 +01:00
|
|
|
using namespace Genode;
|
|
|
|
|
2015-03-17 15:41:47 +01:00
|
|
|
/**
|
|
|
|
* Platform-specific proxy code
|
|
|
|
*/
|
2011-12-22 16:19:25 +01:00
|
|
|
|
2015-03-17 15:41:47 +01:00
|
|
|
class Genode::Irq_proxy_component : public Irq_proxy_base
|
2011-12-22 16:19:25 +01:00
|
|
|
{
|
2015-03-17 15:41:47 +01:00
|
|
|
private:
|
|
|
|
|
|
|
|
bool _irq_attached;
|
|
|
|
|
|
|
|
protected:
|
|
|
|
|
|
|
|
bool _associate() { return true; }
|
|
|
|
|
|
|
|
void _wait_for_irq()
|
|
|
|
{
|
|
|
|
using namespace Codezero;
|
|
|
|
|
|
|
|
/* attach thread to IRQ when first called */
|
|
|
|
if (!_irq_attached) {
|
|
|
|
int ret = l4_irq_control(IRQ_CONTROL_REGISTER, 0, _irq_number);
|
|
|
|
if (ret < 0) {
|
|
|
|
PERR("l4_irq_control(IRQ_CONTROL_REGISTER) returned %d", ret);
|
|
|
|
sleep_forever();
|
|
|
|
}
|
|
|
|
_irq_attached = true;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* block for IRQ */
|
|
|
|
int ret = l4_irq_control(IRQ_CONTROL_WAIT, 0, _irq_number);
|
|
|
|
if (ret < 0)
|
|
|
|
PWRN("l4_irq_control(IRQ_CONTROL_WAIT) returned %d", ret);
|
|
|
|
}
|
|
|
|
|
|
|
|
void _ack_irq() { }
|
|
|
|
|
|
|
|
public:
|
|
|
|
|
|
|
|
Irq_proxy_component(long irq_number)
|
|
|
|
:
|
|
|
|
Irq_proxy(irq_number),
|
|
|
|
_irq_attached(false)
|
|
|
|
{
|
|
|
|
_start();
|
2011-12-22 16:19:25 +01:00
|
|
|
}
|
2015-03-17 15:41:47 +01:00
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
/***************************
|
|
|
|
** IRQ session component **
|
|
|
|
***************************/
|
|
|
|
|
|
|
|
|
|
|
|
void Irq_session_component::ack_irq()
|
|
|
|
{
|
|
|
|
if (!_proxy) {
|
|
|
|
PERR("Expected to find IRQ proxy for IRQ %02x", _irq_number);
|
|
|
|
return;
|
2011-12-22 16:19:25 +01:00
|
|
|
}
|
|
|
|
|
2015-03-17 15:41:47 +01:00
|
|
|
_proxy->ack_irq();
|
2011-12-22 16:19:25 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
|
2015-03-17 15:41:47 +01:00
|
|
|
Irq_session_component::Irq_session_component(Range_allocator *irq_alloc,
|
2011-12-22 16:19:25 +01:00
|
|
|
const char *args)
|
|
|
|
:
|
2015-03-17 15:41:47 +01:00
|
|
|
_irq_alloc(irq_alloc)
|
2011-12-22 16:19:25 +01:00
|
|
|
{
|
|
|
|
long irq_number = Arg_string::find_arg(args, "irq_number").long_value(-1);
|
2015-03-17 15:41:47 +01:00
|
|
|
if (irq_number == -1) {
|
|
|
|
PERR("invalid IRQ number requested");
|
|
|
|
|
|
|
|
throw Root::Unavailable();
|
|
|
|
}
|
|
|
|
|
|
|
|
/* check if IRQ thread was started before */
|
|
|
|
_proxy = Irq_proxy_component::get_irq_proxy<Irq_proxy_component>(irq_number, irq_alloc);
|
|
|
|
if (!_proxy) {
|
2011-12-22 16:19:25 +01:00
|
|
|
PERR("unavailable IRQ %lx requested", irq_number);
|
2015-03-17 15:41:47 +01:00
|
|
|
throw Root::Unavailable();
|
2011-12-22 16:19:25 +01:00
|
|
|
}
|
2015-03-17 15:41:47 +01:00
|
|
|
|
2011-12-22 16:19:25 +01:00
|
|
|
_irq_number = irq_number;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
Irq_session_component::~Irq_session_component()
|
|
|
|
{
|
2015-03-17 15:41:47 +01:00
|
|
|
if (!_proxy) return;
|
|
|
|
|
|
|
|
if (_irq_sigh.valid())
|
|
|
|
_proxy->remove_sharer(&_irq_sigh);
|
2011-12-22 16:19:25 +01:00
|
|
|
}
|
|
|
|
|
2015-03-17 13:28:20 +01:00
|
|
|
|
2015-03-17 15:41:47 +01:00
|
|
|
void Irq_session_component::sigh(Genode::Signal_context_capability sigh)
|
2015-03-17 13:28:20 +01:00
|
|
|
{
|
2015-03-17 15:41:47 +01:00
|
|
|
if (!_proxy) {
|
|
|
|
PERR("signal handler got not registered - irq thread unavailable");
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
Genode::Signal_context_capability old = _irq_sigh;
|
|
|
|
|
|
|
|
if (old.valid() && !sigh.valid())
|
|
|
|
_proxy->remove_sharer(&_irq_sigh);
|
|
|
|
|
|
|
|
_irq_sigh = sigh;
|
|
|
|
|
|
|
|
if (!old.valid() && sigh.valid())
|
|
|
|
_proxy->add_sharer(&_irq_sigh);
|
2015-03-17 13:28:20 +01:00
|
|
|
}
|