/*
 * \brief  hw-specific implementation of core-local RM session
 * \author Norman Feske
 * \author Stefan Kalkowski
 * \date   2014-02-26
 *
 * Taken from OKL4-specific imlementation
 */

/*
 * Copyright (C) 2014 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.
 */

/* core includes */
#include <platform.h>
#include <core_region_map.h>
#include <map_local.h>
#include <util.h>
#include <base/heap.h>

using namespace Genode;

Region_map::Local_addr
Core_region_map::attach(Dataspace_capability ds_cap, size_t size,
                        off_t offset, bool use_local_addr,
                        Region_map::Local_addr, bool executable)
{
	auto lambda = [&] (Dataspace_component *ds) -> Local_addr {
		if (!ds)
			throw Invalid_dataspace();

		if (size == 0)
			size = ds->size();

		size_t page_rounded_size = (size + get_page_size() - 1) & get_page_mask();

		if (use_local_addr) {
			PERR("Parameter 'use_local_addr' not supported within core");
			return nullptr;
		}

		if (offset) {
			PERR("Parameter 'offset' not supported within core");
			return nullptr;
		}

		/* allocate range in core's virtual address space */
		void *virt_addr;
		if (!platform()->region_alloc()->alloc_aligned(page_rounded_size,
			                                           &virt_addr,
			                                           get_page_size_log2()).is_ok()) {
			PERR("Could not allocate virtual address range in core of size %zd\n",
			     page_rounded_size);
			return nullptr;
		}

		/* map the dataspace's physical pages to corresponding virtual addresses */
		unsigned num_pages = page_rounded_size >> get_page_size_log2();
		Page_flags const flags = Page_flags::apply_mapping(ds->writable(),
		                                                   ds->cacheability(),
		                                                   ds->is_io_mem());
		if (!map_local(ds->phys_addr(), (addr_t)virt_addr, num_pages, flags))
			return nullptr;

		return virt_addr;
	};
	return _ds_ep->apply(ds_cap, lambda);
}