linux-vybrid_public/drivers/platform/x86/intel-smartconnect.c

/*
 *  Copyright 2013 Matthew Garrett <mjg59@srcf.ucam.org>
 *
 *  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; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  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.
 *
 *  You should have received a copy of the GNU General Public License along
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 *  51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
 */


#include <linux/init.h>
#include <linux/module.h>
#include <acpi/acpi_drivers.h>

MODULE_LICENSE("GPL");

static int smartconnect_acpi_init(struct acpi_device *acpi)
{
	struct acpi_object_list input;
	struct acpi_buffer output = { ACPI_ALLOCATE_BUFFER, NULL };
	union acpi_object *result;
	union acpi_object param;
	acpi_status status;

	status = acpi_evaluate_object(acpi->handle, "GAOS", NULL, &output);
	if (!ACPI_SUCCESS(status))
		return -EINVAL;

	result = output.pointer;

	if (result->type != ACPI_TYPE_INTEGER) {
		kfree(result);
		return -EINVAL;
	}

	if (result->integer.value & 0x1) {
		param.type = ACPI_TYPE_INTEGER;
		param.integer.value = 0;

		input.count = 1;
		input.pointer = &param;

		dev_info(&acpi->dev, "Disabling Intel Smart Connect\n");
		status = acpi_evaluate_object(acpi->handle, "SAOS", &input,
					      NULL);
	}

	kfree(result);

	return 0;
}

static const struct acpi_device_id smartconnect_ids[] = {
	{"INT33A0", 0},
	{"", 0}
};

static struct acpi_driver smartconnect_driver = {
	.owner = THIS_MODULE,
	.name = "intel_smart_connect",
	.class = "intel_smart_connect",
	.ids = smartconnect_ids,
	.ops = {
		.add = smartconnect_acpi_init,
	},
};

static int smartconnect_init(void)
{
	return acpi_bus_register_driver(&smartconnect_driver);
}

static void smartconnect_exit(void)
{
	acpi_bus_unregister_driver(&smartconnect_driver);
}

module_init(smartconnect_init);
module_exit(smartconnect_exit);

MODULE_DEVICE_TABLE(acpi, smartconnect_ids);