1 files changed, 99 insertions, 0 deletions
diff --git a/src/drivers/intel/mipi_camera/camera.c b/src/drivers/intel/mipi_camera/camera.c
new file mode 100644
index 0000000000..7752f0aff3
--- /dev/null
+++ b/src/drivers/intel/mipi_camera/camera.c
@@ -0,0 +1,99 @@
+/*
+ * This file is part of the coreboot project.
+ *
+ * Copyright (C) 2017 Intel Corporation.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; version 2 of the License.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#include <arch/acpi.h>
+#include <arch/acpi_device.h>
+#include <arch/acpigen.h>
+#include <console/console.h>
+#include <device/i2c.h>
+#include <device/device.h>
+#include <device/path.h>
+#include <string.h>
+#include "chip.h"
+
+static void camera_fill_ssdt(struct device *dev)
+{
+	struct drivers_intel_mipi_camera_config *config = dev->chip_info;
+	const char *scope = acpi_device_scope(dev);
+	struct acpi_i2c i2c = {
+		.address = dev->path.i2c.device,
+		.mode_10bit = dev->path.i2c.mode_10bit,
+		.speed = I2C_SPEED_FAST,
+		.resource = scope,
+	};
+
+	if (!dev->enabled || !scope)
+		return;
+
+	/* Device */
+	acpigen_write_scope(scope);
+	acpigen_write_device(acpi_device_name(dev));
+	acpigen_write_name_string("_HID", config->acpi_hid);
+	acpigen_write_name_integer("_UID", config->acpi_uid);
+	acpigen_write_name_string("_DDN", config->chip_name);
+	acpigen_write_STA(ACPI_STATUS_DEVICE_ALL_ON);
+
+	/* Resources */
+	acpigen_write_name("_CRS");
+	acpigen_write_resourcetemplate_header();
+	acpi_device_write_i2c(&i2c);
+	acpigen_write_resourcetemplate_footer();
+
+	/* Mark it as Camera related device */
+	acpigen_write_name_integer("CAMD", config->device_type);
+
+	/* Create Device specific data */
+	if (config->device_type == INTEL_ACPI_CAMERA_SENSOR) {
+		acpigen_write_method_serialized("SSDB", 0);
+		acpigen_write_return_byte_buffer((uint8_t *)&config->ssdb,
+						sizeof(config->ssdb));
+		acpigen_pop_len(); /* Method */
+	}
+
+	/* Fill Power Sequencing Data */
+	acpigen_write_method_serialized("PWDB", 0);
+	acpigen_write_return_byte_buffer((uint8_t *)&config->pwdb,
+			(sizeof(struct intel_pwdb) * config->num_pwdb_entries));
+	acpigen_pop_len(); /* Method */
+
+	acpigen_pop_len(); /* Device */
+	acpigen_pop_len(); /* Scope */
+	printk(BIOS_INFO, "%s: %s address 0%xh\n", acpi_device_path(dev),
+			dev->chip_ops->name, dev->path.i2c.device);
+}
+
+static const char *camera_acpi_name(struct device *dev)
+{
+	struct drivers_intel_mipi_camera_config *config = dev->chip_info;
+	return config->acpi_name;
+}
+
+static struct device_operations camera_ops = {
+	.read_resources			= DEVICE_NOOP,
+	.set_resources			= DEVICE_NOOP,
+	.enable_resources		= DEVICE_NOOP,
+	.acpi_name			= &camera_acpi_name,
+	.acpi_fill_ssdt_generator	= &camera_fill_ssdt,
+};
+
+static void camera_enable(struct device *dev)
+{
+	dev->ops = &camera_ops;
+}
+
+struct chip_operations drivers_intel_mipi_camera_ops = {
+	CHIP_NAME("Intel MIPI Camera Device")
+	.enable_dev = &camera_enable
+};