From 5424628ebdefc2c5703030aca81a0faf3b5a3e26 Mon Sep 17 00:00:00 2001
From: Stefan Kalkowski <stefan.kalkowski@genode-labs.com>
Date: Tue, 19 Apr 2016 15:37:27 +0200
Subject: [PATCH] intel_fb: add Framebuffer controller example

Issue #1974.
---
 repos/dde_linux/run/intel_fb.run              |  46 ++++++-
 .../src/test/framebuffer/intel/main.cc        | 127 ++++++++++++++++++
 .../src/test/framebuffer/intel/target.mk      |   3 +
 3 files changed, 173 insertions(+), 3 deletions(-)
 create mode 100644 repos/dde_linux/src/test/framebuffer/intel/main.cc
 create mode 100644 repos/dde_linux/src/test/framebuffer/intel/target.mk

diff --git a/repos/dde_linux/run/intel_fb.run b/repos/dde_linux/run/intel_fb.run
index 647fef9a11..887e25814b 100644
--- a/repos/dde_linux/run/intel_fb.run
+++ b/repos/dde_linux/run/intel_fb.run
@@ -48,8 +48,38 @@ append config {
 	<start name="report_rom">
 		<resource name="RAM" quantum="2M"/>
 		<provides> <service name="Report" /> <service name="ROM" /> </provides>
-		<config verbose="yes"> <rom/> </config>
+		<config verbose="yes">
+			<policy label="intel_fb_controller -> connectors" report="intel_fb_drv -> connectors"/>
+		</config>
 	</start>
+
+	<start name="config_fs" priority="-1">
+		<binary name="ram_fs"/>
+		<resource name="RAM" quantum="8M"/>
+		<provides> <service name="File_system"/> </provides>
+		<config>
+			<content>
+				<inline name="fb_drv.config">
+<config buffered="yes">
+	<report connectors="yes"/>
+</config>
+				</inline>
+			</content>
+			<policy label="config_rom" root="/"/>
+			<policy label="intel_fb_controller" root="/" writeable="yes"/>
+		</config>
+	</start>
+
+	<start name="config_rom" priority="-1">
+		<binary name="fs_rom"/>
+		<resource name="RAM" quantum="4M"/>
+		<provides><service name="ROM"/></provides>
+		<route>
+			<service name="File_system"> <child name="config_fs" /> </service>
+			<any-service> <parent/> <any-child/> </any-service>
+		</route>
+	</start>
+
 	<start name="intel_fb_drv">
 		<resource name="RAM" quantum="20M"/>
 		<provides><service name="Framebuffer"/></provides>
@@ -58,6 +88,16 @@ append config {
 			<any-service> <parent/> <any-child /> </any-service>
 		</route>
 	</start>
+
+	<start name="intel_fb_controller">
+		<resource name="RAM" quantum="1M"/>
+		<route>
+			<service name="File_system">            <child name="config_fs"/> </service>
+			<service name="ROM" label="connectors"> <child name="report_rom"/> </service>
+			<any-service> <parent/> <any-child/> </any-service>
+		</route>
+	</start>
+
 	<start name="test-framebuffer">
 		<resource name="RAM" quantum="10M"/>
 	</start>
@@ -71,8 +111,8 @@ install_config $config
 
 # generic modules
 set boot_modules {
-	core init timer intel_fb_drv
-	test-framebuffer report_rom
+	core init timer intel_fb_drv intel_fb_controller
+	test-framebuffer report_rom ram_fs fs_rom
 }
 
 append_platform_drv_boot_modules
diff --git a/repos/dde_linux/src/test/framebuffer/intel/main.cc b/repos/dde_linux/src/test/framebuffer/intel/main.cc
new file mode 100644
index 0000000000..9dde78c974
--- /dev/null
+++ b/repos/dde_linux/src/test/framebuffer/intel/main.cc
@@ -0,0 +1,127 @@
+/*
+ * \brief  Test controller for Intel framebuffer driver
+ * \author Stefan Kalkowski
+ * \date   2016-04-19
+ */
+
+/*
+ * Copyright (C) 2016 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 <base/allocator_avl.h>
+#include <base/component.h>
+#include <base/heap.h>
+#include <base/log.h>
+#include <file_system_session/connection.h>
+#include <file_system/util.h>
+#include <os/attached_rom_dataspace.h>
+#include <util/xml_generator.h>
+#include <util/xml_node.h>
+
+using namespace Genode;
+
+
+struct Framebuffer_controller
+{
+	Attached_rom_dataspace                 rom;
+	Signal_handler<Framebuffer_controller> rom_sigh;
+	Heap                                   heap;
+	Allocator_avl                          fs_alloc;
+	File_system::Connection                fs;
+
+	void update_connector_config(Xml_generator & xml, Xml_node & node);
+	void update_fb_config(Xml_node & report);
+	void report_changed();
+
+	Framebuffer_controller(Env &env)
+	: rom("connectors"),
+	  rom_sigh(env.ep(), *this, &Framebuffer_controller::report_changed),
+	  heap(env.ram(), env.rm()),
+	  fs_alloc(&heap),
+	  fs(fs_alloc, 128*1024, "")
+	{
+		rom.sigh(rom_sigh);
+	}
+};
+
+
+void Framebuffer_controller::update_connector_config(Xml_generator & xml,
+                                                     Xml_node & node)
+{
+	xml.node("connector", [&] {
+		String<64> name;
+		node.attribute("name").value(&name);
+		xml.attribute("name", name.string());
+
+		bool connected = node.attribute_value("connected", false);
+		xml.attribute("enabled", connected ? "true" : "false");
+
+		unsigned long width = 0, height = 0;
+		node.for_each_sub_node("mode", [&] (Xml_node &mode) {
+			unsigned long w, h;
+			w = mode.attribute_value<unsigned long>("width", 0);
+			h = mode.attribute_value<unsigned long>("height", 0);
+			if (w > width) {
+				width = w;
+				height = h;
+			}
+		});
+
+		if (width && height) {
+			xml.attribute("width", width);
+			xml.attribute("height", height);
+		}
+	});
+}
+
+
+void Framebuffer_controller::update_fb_config(Xml_node & report)
+{
+	try {
+		static char buf[4096];
+
+		Xml_generator xml(buf, sizeof(buf), "config", [&] {
+			xml.attribute("buffered", "yes");
+			xml.node("report", [&] {
+				xml.attribute("connectors", "yes");
+			});
+
+			report.for_each_sub_node("connector", [&] (Xml_node &node) {
+			                         update_connector_config(xml, node); });
+		});
+		buf[xml.used()] = 0;
+
+		File_system::Dir_handle root_dir = fs.dir("/", false);
+		File_system::File_handle file =
+			fs.file(root_dir, "fb_drv.config", File_system::READ_WRITE, false);
+		if (File_system::write(fs, file, buf, xml.used()) == 0)
+			error("Could not write config");
+		fs.close(file);
+	} catch (...) {
+		error("Cannot update config");
+	}
+}
+
+
+void Framebuffer_controller::report_changed()
+{
+	rom.update();
+	if (!rom.is_valid()) return;
+
+	Xml_node report(rom.local_addr<char>(), rom.size());
+	update_fb_config(report);
+}
+
+
+void Component::construct(Genode::Env &env)
+{
+	log("--- Framebuffer controller ---\n");
+	static Framebuffer_controller controller(env);
+}
+
+
+size_t Component::stack_size() {
+	return 4*1024*sizeof(long); }
diff --git a/repos/dde_linux/src/test/framebuffer/intel/target.mk b/repos/dde_linux/src/test/framebuffer/intel/target.mk
new file mode 100644
index 0000000000..d13e873cb3
--- /dev/null
+++ b/repos/dde_linux/src/test/framebuffer/intel/target.mk
@@ -0,0 +1,3 @@
+TARGET   = intel_fb_controller
+LIBS     = base
+SRC_CC   = main.cc