genode/repos/base-sel4/src/core/include/page_table_registry.h

/*
 * \brief   Associate page-table and frame selectors with virtual addresses
 * \author  Norman Feske
 * \date    2015-05-04
 */

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

#ifndef _CORE__INCLUDE__PAGE_TABLE_REGISTRY_H_
#define _CORE__INCLUDE__PAGE_TABLE_REGISTRY_H_

/* Genode includes */
#include <util/list.h>
#include <base/exception.h>
#include <base/tslab.h>

/* core includes */
#include <util.h>
#include <cap_sel_alloc.h>

namespace Genode { class Page_table_registry; }


class Genode::Page_table_registry
{
	public:

		class Lookup_failed : Exception { };

	private:

		/*
		 * XXX use AVL tree (with virtual address as key) instead of list
		 */

		class Page_table : public List<Page_table>::Element
		{
			public:

				struct Entry : List<Entry>::Element
				{
					addr_t   const addr;
					unsigned const sel;

					Entry(addr_t addr, unsigned sel) : addr(addr), sel(sel) { }
				};

				addr_t const addr;

				static constexpr bool verbose = false;

			private:

				List<Entry> _entries;

				static addr_t _page_frame_base(addr_t addr)
				{
					return addr & get_page_mask();
				}

				bool _entry_exists(addr_t addr) const
				{
					for (Entry const *e = _entries.first(); e; e = e->next()) {
						if (_page_frame_base(e->addr) == _page_frame_base(addr))
							return true;
					}
					return false;
				}

			public:

				class Lookup_failed : Exception { };

				Page_table(addr_t addr) : addr(addr) { }

				Entry &lookup(addr_t addr)
				{
					for (Entry *e = _entries.first(); e; e = e->next()) {
						if (_page_frame_base(e->addr) == _page_frame_base(addr))
							return *e;
					}
					throw Lookup_failed();
				}

				void insert_entry(Allocator &entry_slab, addr_t addr, unsigned sel)
				{
					if (_entry_exists(addr)) {
						PWRN("trying to insert page frame for 0x%lx twice", addr);
						return;
					}

					_entries.insert(new (entry_slab) Entry(addr, sel));
				}

				void remove_entry(Allocator &entry_slab, addr_t addr)
				{
					try {
						Entry &entry = lookup(addr);
						_entries.remove(&entry);
						destroy(entry_slab, &entry);
					} catch (Lookup_failed) {
						if (verbose)
							PWRN("trying to remove non-existing page frame for 0x%lx", addr);
					}
				}
		};

		struct Slab_block : Genode::Slab_block
		{
			long _data[4*1024];

			Slab_block(Genode::Slab &slab) : Genode::Slab_block(&slab) { }
		};

		template <typename T>
		struct Slab : Genode::Tslab<T, sizeof(Slab_block)>
		{
			Slab_block _initial_block { *this };

			Slab(Allocator &md_alloc)
			:
				Tslab<T, sizeof(Slab_block)>(&md_alloc, &_initial_block)
			{ }
		};

		Allocator              &_md_alloc;
		Slab<Page_table>        _page_table_slab;
		Slab<Page_table::Entry> _page_table_entry_slab;

		/* state variable to prevent nested attempts to extend the slab-pool */
		bool _extending_page_table_entry_slab = false;

		List<Page_table> _page_tables;

		static addr_t _page_table_base(addr_t addr)
		{
			return addr & ~(4*1024*1024 - 1);
		}

		bool _page_table_exists(addr_t addr) const
		{
			for (Page_table const *pt = _page_tables.first(); pt; pt = pt->next()) {
				if (_page_table_base(pt->addr) == _page_table_base(addr))
					return true;
			}
			return false;
		}

		Page_table &_lookup(addr_t addr)
		{
			for (Page_table *pt = _page_tables.first(); pt; pt = pt->next()) {
				if (_page_table_base(pt->addr) == _page_table_base(addr))
					return *pt;
			}
			PDBG("page-table lookup failed");
			throw Lookup_failed();
		}

		static constexpr bool verbose = false;

		void _preserve_page_table_entry_slab_space()
		{
			/*
			 * Eagerly extend the pool of slab blocks if we run out of slab
			 * entries.
			 *
			 * At all times we have to ensure that the slab allocator has
			 * enough free entries to host the meta data needed for mapping a
			 * new slab block because such a new slab block will indeed result
			 * in the creation of further page-table entries. We have to
			 * preserve at least as many slab entries as the number of
			 * page-table entries used by a single slab block.
			 *
			 * In the computation of 'PRESERVED', the 1 accounts for the bits
			 * truncated by the division by page size. The 3 accounts for the
			 * slab's built-in threshold for extending the slab, which we need
			 * to avoid triggering (as this would result in just another
			 * nesting level).
			 */
			enum { PRESERVED = sizeof(Slab_block)/get_page_size() + 1 + 3 };

			/* back out if there is still enough room */
			if (_page_table_entry_slab.num_free_entries_higher_than(PRESERVED))
				return;

			/* back out on a nested call, while extending the slab */
			if (_extending_page_table_entry_slab)
			 	return;

		 	_extending_page_table_entry_slab = true;

			try {
				/*
				 * Create new slab block. Note that we are entering a rat
				 * hole here as this operation will result in the nested
				 * call of 'map_local'.
				 */
				Slab_block *sb = new (_md_alloc) Slab_block(_page_table_entry_slab);

				_page_table_entry_slab.insert_sb(sb);

			} catch (Allocator::Out_of_memory) {

				/* this should never happen */
				PERR("Out of memory while allocating page-table meta data");
			}

			_extending_page_table_entry_slab = false;
		}

	public:

		/**
		 * Constructor
		 *
		 * \param md_alloc  backing store allocator for metadata
		 */
		Page_table_registry(Allocator &md_alloc)
		:
			_md_alloc(md_alloc),
			_page_table_slab(md_alloc),
			_page_table_entry_slab(md_alloc)
		{ }

		/**
		 * Register page table
		 *
		 * \param addr  virtual address
		 * \param sel   page-table selector
		 */
		void insert_page_table(addr_t addr, Cap_sel sel)
		{
			/* XXX sel is unused */

			if (_page_table_exists(addr)) {
				PWRN("trying to insert page table for 0x%lx twice", addr);
				return;
			}

			_page_tables.insert(new (_page_table_slab) Page_table(addr));
		}

		bool has_page_table_at(addr_t addr) const
		{
			return _page_table_exists(addr);
		}

		/**
		 * Register page table entry
		 *
		 * \param addr  virtual address
		 * \param sel   page frame selector
		 *
		 * \throw  Lookup_failed  no page table for given address
		 */
		void insert_page_table_entry(addr_t addr, unsigned sel)
		{
			_preserve_page_table_entry_slab_space();

			_lookup(addr).insert_entry(_page_table_entry_slab, addr, sel);
		}

		/**
		 * Discard the information about the given virtual address
		 */
		void forget_page_table_entry(addr_t addr)
		{
			try {
				Page_table &page_table = _lookup(addr);
				page_table.remove_entry(_page_table_entry_slab, addr);
			} catch (...) {
				if (verbose)
					PDBG("no PT entry found for virtual address 0x%lx", addr);
			}
		}

		/**
		 * Apply functor 'fn' to selector of specified virtual address
		 *
		 * \param addr  virtual address
		 *
		 * The functor is called with the selector of the page table entry
		 * (the copy of the phys frame selector) as argument.
		 */
		template <typename FN>
		void apply(addr_t addr, FN const &fn)
		{
			try {
				Page_table        &page_table = _lookup(addr);
				Page_table::Entry &entry      = page_table.lookup(addr);

				fn(entry.sel);
			} catch (...) {
				if (verbose)
					PDBG("no PT entry found for virtual address 0x%lx", addr);
			}
		}
};

#endif /* _CORE__INCLUDE__PAGE_TABLE_REGISTRY_H_ */