1 files changed, 135 insertions, 0 deletions
diff --git a/src/drivers/intel/gma/acpi.c b/src/drivers/intel/gma/acpi.c
new file mode 100644
index 0000000000..c3a9b8a266
--- /dev/null
+++ b/src/drivers/intel/gma/acpi.c
@@ -0,0 +1,135 @@
+/*
+ * Copyright (C) 2014 Vladimir Serbinenko
+ * Subject to the GNU GPL v2, or (at your option) any later version.
+ */
+
+#include <arch/acpi.h>
+#include <arch/acpigen.h>
+#include <string.h>
+#include "i915.h"
+
+void
+drivers_intel_gma_displays_ssdt_generate(const struct i915_gpu_controller_info *conf)
+{
+	size_t i;
+	const char *names[] = { "UNK", "VGA", "TV", "DVI", "LCD" };
+	int counters[ARRAY_SIZE(names)];
+
+	memset(counters, 0, sizeof(counters));
+
+	acpigen_write_scope("\\_SB.PCI0.GFX0");
+
+	/*
+	Method (_DOD, 0)
+	{
+		Return (Package() {
+				0x5a5a5a5a,
+				0x5a5a5a5a,
+				0x5a5a5a5a
+			})
+	}
+	*/
+	acpigen_write_method("_DOD", 0);
+	acpigen_emit_byte(0xa4); /* ReturnOp.  */
+	acpigen_write_package(conf->ndid);
+
+	for (i = 0; i < conf->ndid; i++) {
+		acpigen_write_dword (conf->did[i] | 0x80010000);
+	}
+	acpigen_pop_len(); /* End Package. */
+	acpigen_pop_len(); /* End Method. */
+
+	for (i = 0; i < conf->ndid; i++) {
+		char name[10];
+		char *ptr;
+		int kind;
+		kind = (conf->did[i] >> 8) & 0xf;
+		if (kind >= ARRAY_SIZE(names)) {
+			kind = 0;
+		}
+		strcpy(name, names[kind]);
+		for (ptr = name; *ptr; ptr++);
+		*ptr++ = counters[kind] + '0';
+		*ptr++ = '\0';
+		counters[kind]++;
+		acpigen_write_device(name);
+		/* Name (_ADR, 0x0410) */
+		acpigen_write_name_dword("_ADR", conf->did[i] & 0xffff);
+
+		/* ACPI brightness for LCD.  */
+		if (kind == 4) {
+			/*
+			  Method (_BCL, 0, NotSerialized)
+			  {
+			  	Return (^^XBCL())
+			  }
+			*/
+			acpigen_write_method("_BCL", 0);
+			acpigen_emit_byte(0xa4); /* ReturnOp.  */
+			acpigen_emit_namestring("^^XBCL");
+			acpigen_pop_len();
+
+			/*
+			  Method (_BCM, 1, NotSerialized)
+			  {
+			  	^^XBCM(Arg0)
+			  }
+			*/
+			acpigen_write_method("_BCM", 1);
+			acpigen_emit_namestring("^^XBCM");
+			acpigen_emit_byte(0x68); /* Arg0Op.  */
+			acpigen_pop_len();
+
+			/*
+			  Method (_BQC, 0, NotSerialized)
+			  {
+			  	Return (^^XBQC())
+			  }
+			*/
+			acpigen_write_method("_BQC", 0);
+			acpigen_emit_byte(0xa4); /* ReturnOp.  */
+			acpigen_emit_namestring("^^XBQC");
+			acpigen_pop_len();
+		}
+
+		/*
+		Method(_DCS, 0)
+		{
+			Return (^^XDCS(<device number>))
+		}
+		*/
+		acpigen_write_method("_DCS", 0);
+		acpigen_emit_byte(0xa4); /* ReturnOp.  */
+		acpigen_emit_namestring("^^XDCS");
+		acpigen_write_byte(i);
+		acpigen_pop_len();
+
+		/*
+		Method(_DGS, 0)
+		{
+			Return (^^XDGS(<device number>))
+		}
+		*/
+		acpigen_write_method("_DGS", 0);
+		acpigen_emit_byte(0xa4); /* ReturnOp.  */
+		acpigen_emit_namestring("^^XDGS");
+		acpigen_write_byte(i);
+		acpigen_pop_len();
+
+		/*
+		Method(_DSS, 1)
+		{
+			^^XDSS(0x5a, Arg0)
+		}
+		*/
+		acpigen_write_method("_DSS", 0);
+		acpigen_emit_namestring("^^XDSS");
+		acpigen_write_byte(i);
+		acpigen_emit_byte(0x68); /* Arg0Op.  */
+		acpigen_pop_len();
+
+		acpigen_pop_len();
+	}
+
+	acpigen_pop_len();
+}