150 lines
3.0 KiB
C++
150 lines
3.0 KiB
C++
/*
|
|
* \brief Pager support for Pistachio
|
|
* \author Christian Helmuth
|
|
* \date 2006-06-14
|
|
*/
|
|
|
|
/*
|
|
* Copyright (C) 2006-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>
|
|
#include <base/sleep.h>
|
|
|
|
/* base-internal includes */
|
|
#include <base/internal/native_thread.h>
|
|
|
|
/* Core includes */
|
|
#include <ipc_pager.h>
|
|
#include <pager.h>
|
|
|
|
namespace Pistachio
|
|
{
|
|
#include <l4/message.h>
|
|
#include <l4/ipc.h>
|
|
#include <l4/schedule.h>
|
|
#include <l4/kdebug.h>
|
|
}
|
|
|
|
using namespace Genode;
|
|
using namespace Pistachio;
|
|
|
|
|
|
/*************
|
|
** Mapping **
|
|
*************/
|
|
|
|
Mapping::Mapping(addr_t dst_addr, addr_t src_addr,
|
|
Cache_attribute, bool io_mem, unsigned l2size,
|
|
bool rw, bool grant)
|
|
{
|
|
L4_Fpage_t fpage = L4_FpageLog2(src_addr, l2size);
|
|
|
|
fpage += rw ? L4_FullyAccessible : L4_Readable;
|
|
|
|
if (grant)
|
|
_grant_item = L4_GrantItem(fpage, dst_addr);
|
|
else
|
|
_map_item = L4_MapItem(fpage, dst_addr);
|
|
}
|
|
|
|
|
|
Mapping::Mapping() { _map_item = L4_MapItem(L4_Nilpage, 0); }
|
|
|
|
|
|
/***************
|
|
** IPC pager **
|
|
***************/
|
|
|
|
void Ipc_pager::wait_for_fault()
|
|
{
|
|
L4_MsgTag_t result;
|
|
L4_ThreadId_t sender = L4_nilthread;
|
|
bool failed;
|
|
|
|
do {
|
|
L4_Accept(L4_UntypedWordsAcceptor);
|
|
result = L4_Wait(&sender);
|
|
failed = L4_IpcFailed(result);
|
|
if (failed)
|
|
PERR("Page fault IPC error. (continuable)");
|
|
|
|
if (L4_UntypedWords(result) != 2) {
|
|
PERR("Malformed page-fault ipc. (sender = 0x%08lx)",
|
|
sender.raw);
|
|
failed = true;
|
|
}
|
|
|
|
} while (failed);
|
|
|
|
L4_Msg_t msg;
|
|
// TODO Error checking. Did we really receive 2 words?
|
|
L4_Store(result, &msg);
|
|
|
|
_pf_addr = L4_Get(&msg, 0);
|
|
_pf_ip = L4_Get(&msg, 1);
|
|
_flags = L4_Label(result);
|
|
|
|
_last = sender;
|
|
}
|
|
|
|
|
|
void Ipc_pager::reply_and_wait_for_fault()
|
|
{
|
|
/*
|
|
* XXX call memory-control if mapping has enabled write-combining
|
|
*/
|
|
|
|
L4_Msg_t msg;
|
|
L4_Accept(L4_UntypedWordsAcceptor);
|
|
L4_Clear(&msg);
|
|
|
|
/* this should work even if _map_item is a grant item */
|
|
L4_Append(&msg, _map_item);
|
|
L4_Load(&msg);
|
|
L4_MsgTag_t result = L4_ReplyWait(_last, &_last);
|
|
|
|
if (L4_IpcFailed(result)) {
|
|
PERR("Page fault IPC error. (continuable)");
|
|
wait_for_fault();
|
|
return;
|
|
}
|
|
|
|
if (L4_UntypedWords(result) != 2) {
|
|
PERR("Malformed page-fault ipc. (sender = 0x%08lx)", _last.raw);
|
|
wait_for_fault();
|
|
return;
|
|
}
|
|
|
|
L4_Clear(&msg);
|
|
// TODO Error checking. Did we really receive 2 words?
|
|
L4_Store(result, &msg);
|
|
|
|
_pf_addr = L4_Get(&msg, 0);
|
|
_pf_ip = L4_Get(&msg, 1);
|
|
_flags = L4_Label(result);
|
|
}
|
|
|
|
|
|
void Ipc_pager::acknowledge_wakeup()
|
|
{
|
|
PERR("acknowledge_wakeup called, not yet implemented");
|
|
// /* answer wakeup call from one of core's region-manager sessions */
|
|
// l4_msgdope_t result;
|
|
// l4_ipc_send(_last, L4_IPC_SHORT_MSG, 0, 0, L4_IPC_SEND_TIMEOUT_0, &result);
|
|
}
|
|
|
|
|
|
/**********************
|
|
** Pager entrypoint **
|
|
**********************/
|
|
|
|
Untyped_capability Pager_entrypoint::_pager_object_cap(unsigned long badge)
|
|
{
|
|
return Untyped_capability(native_thread().l4id, badge);
|
|
}
|