118 lines
3.3 KiB
C++
118 lines
3.3 KiB
C++
/*
|
|
* \brief Core implementation of the IO_MEM session interface
|
|
* \author Christian Helmuth
|
|
* \date 2006-08-01
|
|
*/
|
|
|
|
/*
|
|
* 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.
|
|
*/
|
|
|
|
#include <util/string.h>
|
|
#include <util/arg_string.h>
|
|
#include <root/root.h>
|
|
#include <dataspace_component.h>
|
|
#include <io_mem_session_component.h>
|
|
#include <base/allocator_avl.h>
|
|
#include "util.h"
|
|
|
|
using namespace Genode;
|
|
|
|
|
|
static const bool verbose = false;
|
|
|
|
|
|
Io_mem_session_component::Dataspace_attr
|
|
Io_mem_session_component::_prepare_io_mem(const char *args,
|
|
Range_allocator *ram_alloc)
|
|
{
|
|
addr_t req_base = Arg_string::find_arg(args, "base").ulong_value(0);
|
|
size_t req_size = Arg_string::find_arg(args, "size").ulong_value(0);
|
|
|
|
/* align base and size on page boundaries */
|
|
addr_t end = align_addr(req_base + req_size, get_page_size_log2());
|
|
addr_t base = req_base & ~(get_page_size() - 1);
|
|
size_t size = end - base;
|
|
|
|
_write_combined = false;
|
|
|
|
Arg a = Arg_string::find_arg(args, "wc");
|
|
if (a.valid())
|
|
_write_combined = a.bool_value(0);
|
|
|
|
/* check for RAM collision */
|
|
int ret;
|
|
if ((ret = ram_alloc->remove_range(base, size))) {
|
|
PERR("I/O memory [%lx,%lx) used by RAM allocator (%d)", base, base + size, ret);
|
|
return Dataspace_attr();
|
|
}
|
|
|
|
/* allocate region */
|
|
switch (_io_mem_alloc->alloc_addr(req_size, req_base).value) {
|
|
case Range_allocator::Alloc_return::RANGE_CONFLICT:
|
|
PERR("I/O memory [%lx,%lx) not available", req_base, req_base + req_size);
|
|
return Dataspace_attr();
|
|
|
|
case Range_allocator::Alloc_return::OUT_OF_METADATA:
|
|
PERR("I/O memory allocator ran out of meta data");
|
|
return Dataspace_attr();
|
|
|
|
case Range_allocator::Alloc_return::OK: break;
|
|
}
|
|
|
|
/* request local mapping */
|
|
addr_t local_addr = _map_local(base, size);
|
|
|
|
if (verbose)
|
|
PDBG("I/O mem [%lx,%lx) => [%lx,%lx)%s",
|
|
base, base + size, local_addr, local_addr + size,
|
|
_write_combined ? " (write-combined)" : "");
|
|
|
|
return Dataspace_attr(size, local_addr, base, _write_combined, req_base);
|
|
}
|
|
|
|
|
|
Io_mem_session_component::Io_mem_session_component(Range_allocator *io_mem_alloc,
|
|
Range_allocator *ram_alloc,
|
|
Rpc_entrypoint *ds_ep,
|
|
const char *args)
|
|
:
|
|
_io_mem_alloc(io_mem_alloc),
|
|
_ds(_prepare_io_mem(args, ram_alloc)),
|
|
_ds_ep(ds_ep)
|
|
{
|
|
if (!_ds.valid()) {
|
|
PERR("Local MMIO mapping failed!");
|
|
|
|
_ds_cap = Io_mem_dataspace_capability();
|
|
throw Root::Invalid_args();
|
|
}
|
|
|
|
_ds_cap = static_cap_cast<Io_mem_dataspace>(_ds_ep->manage(&_ds));
|
|
}
|
|
|
|
|
|
Io_mem_session_component::~Io_mem_session_component()
|
|
{
|
|
if (verbose)
|
|
PDBG("I/O mem free [%lx,%lx)", _ds.phys_addr(), _ds.phys_addr() + _ds.size());
|
|
|
|
/* dissolve IO_MEM dataspace from service entry point */
|
|
_ds_ep->dissolve(&_ds);
|
|
|
|
/* flush local mapping of IO_MEM */
|
|
_unmap_local(_ds.core_local_addr(), _ds.size());
|
|
|
|
/*
|
|
* The Dataspace will remove itself from all RM sessions when its
|
|
* destructor is called. Thereby, it will get unmapped from all RM
|
|
* clients that currently have the dataspace attached.
|
|
*/
|
|
|
|
/* free region in IO_MEM allocator */
|
|
_io_mem_alloc->free(reinterpret_cast<void *>(_ds.req_base));
|
|
}
|