genode/repos/os/src/drivers/ahci/main.cc

/**
 * \brief  Block driver session creation
 * \author Sebastian Sumpf
 * \date   2015-09-29
 */

/*
 * Copyright (C) 2016-2017 Genode Labs GmbH
 *
 * This file is part of the Genode OS framework, which is distributed
 * under the terms of the GNU Affero General Public License version 3.
 */

/* Genode includes */
#include <base/attached_rom_dataspace.h>
#include <base/component.h>
#include <base/heap.h>
#include <base/log.h>
#include <block/component.h>
#include <os/session_policy.h>
#include <util/xml_node.h>
#include <os/reporter.h>

/* local includes */
#include <ahci.h>


namespace Block {
	class Factory;
	class Root_multiple_clients;
	class Main;
}


struct Block::Factory : Driver_factory
{
	long device_num;

	Block::Driver *create()
	{
		return Ahci_driver::claim_port(device_num);
	}

	void destroy(Block::Driver *driver)
	{
		Ahci_driver::free_port(device_num);
	}

	Factory(long device_num) : device_num(device_num) { }
};


class Session_component : public Block::Session_component
{
	public:

		Session_component(Block::Driver_factory &driver_factory,
		                  Genode::Entrypoint    &ep,
		                  Genode::Region_map    &rm,
		                  Genode::size_t         buf_size)
		: Block::Session_component(driver_factory, ep, rm, buf_size) { }

		Block::Driver_factory &factory() { return _driver_factory; }
};


class Block::Root_multiple_clients : public Root_component< ::Session_component>,
                                     public Ahci_root
{
	private:

		Genode::Env       &_env;
		Genode::Allocator &_alloc;
		Genode::Xml_node   _config;

		long _device_num(Session_label const &label, char *model, char *sn, size_t bufs_len)
		{
			long num = -1;

			try {
				Session_policy policy(label, _config);

				/* try read device port number attribute */
				try { policy.attribute("device").value(&num); }
				catch (...) { }

				/* try read device model and serial number attributes */
				model[0] = sn[0] = 0;
				policy.attribute("model").value(model, bufs_len);
				policy.attribute("serial").value(sn, bufs_len);

			} catch (...) { }

			return num;
		}

	protected:

		::Session_component *_create_session(const char *args)
		{
			Session_label const label = label_from_args(args);

			size_t ram_quota =
					Arg_string::find_arg(args, "ram_quota").ulong_value(0);
			size_t tx_buf_size =
				Arg_string::find_arg(args, "tx_buf_size").ulong_value(0);

			if (!tx_buf_size)
				throw Service_denied();

			size_t session_size = sizeof(::Session_component)
			                    + sizeof(Factory) +	tx_buf_size;

			if (max((size_t)4096, session_size) > ram_quota) {
				error("insufficient 'ram_quota' from '", label, "',"
				      " got ", ram_quota, ", need ", session_size);
				throw Insufficient_ram_quota();
			}

			/* Search for configured device */
			char model_buf[64], sn_buf[64];

			long num = _device_num(label, model_buf, sn_buf, sizeof(model_buf));
			/* prefer model/serial routing */
			if ((model_buf[0] != 0) && (sn_buf[0] != 0))
				num = Ahci_driver::device_number(model_buf, sn_buf);

			if (num < 0) {
				error("rejecting session request, no matching policy for '", label, "'",
				      model_buf[0] == 0 ? ""
				      : " (model=", Cstring(model_buf), " serial=", Cstring(sn_buf), ")");
				throw Service_denied();
			}

			if (!Ahci_driver::avail(num)) {
				error("Device ", num, " not available");
				throw Service_denied();
			}

			Block::Factory *factory = new (&_alloc) Block::Factory(num);
			::Session_component *session = new (&_alloc)
				::Session_component(*factory, _env.ep(), _env.rm(), tx_buf_size);
			log("session opened at device ", num, " for '", label, "'");
			return session;
		}

		void _destroy_session(::Session_component *session)
		{
			Driver_factory &factory = session->factory();
			Genode::destroy(&_alloc, session);
			Genode::destroy(&_alloc, &factory);
		}

	public:

		Root_multiple_clients(Genode::Env &env, Genode::Allocator &alloc,
		                      Genode::Xml_node config)
		:
			Root_component(&env.ep().rpc_ep(), &alloc),
			_env(env), _alloc(alloc), _config(config)
		{ }

		Genode::Entrypoint &entrypoint() override { return _env.ep(); }

		void announce() override
		{
			_env.parent().announce(_env.ep().manage(*this));
		}
};


struct Block::Main
{
	Genode::Env  &env;
	Genode::Heap  heap { env.ram(), env.rm() };

	Genode::Attached_rom_dataspace config { env, "config" };

	Genode::Constructible<Genode::Reporter> reporter;

	Block::Root_multiple_clients root;

	Signal_handler<Main> device_identified {
		env.ep(), *this, &Main::handle_device_identified };

	Main(Genode::Env &env)
	: env(env), root(env, heap, config.xml())
	{
		Genode::log("--- Starting AHCI driver ---");
		bool support_atapi  = config.xml().attribute_value("atapi", false);
		try {
			Ahci_driver::init(env, heap, root, support_atapi, device_identified);
		} catch (Ahci_driver::Missing_controller) {
			Genode::error("no AHCI controller found");
			env.parent().exit(~0);
		} catch (Genode::Service_denied) {
			Genode::error("hardware access denied");
			env.parent().exit(~0);
		}
	}

	void handle_device_identified()
	{
		try {
			Xml_node report = config.xml().sub_node("report");
			if (report.attribute_value("ports", false)) {
				reporter.construct(env, "ports");
				reporter->enabled(true);
				Ahci_driver::report_ports(*reporter);
			}
		} catch (Genode::Xml_node::Nonexistent_sub_node) { }
	}
};


void Component::construct(Genode::Env &env) { static Block::Main server(env); }