|
@@ -0,0 +1,92 @@
|
|
|
+/*
|
|
|
+ * ACPI support for CMOS RTC Address Space access
|
|
|
+ *
|
|
|
+ * Copyright (C) 2013, Intel Corporation
|
|
|
+ * Authors: Lan Tianyu <tianyu.lan@intel.com>
|
|
|
+ *
|
|
|
+ * This program is free software; you can redistribute it and/or modify
|
|
|
+ * it under the terms of the GNU General Public License version 2 as
|
|
|
+ * published by the Free Software Foundation.
|
|
|
+ */
|
|
|
+
|
|
|
+#include <linux/acpi.h>
|
|
|
+#include <linux/device.h>
|
|
|
+#include <linux/err.h>
|
|
|
+#include <linux/kernel.h>
|
|
|
+#include <linux/module.h>
|
|
|
+#include <asm-generic/rtc.h>
|
|
|
+
|
|
|
+#include "internal.h"
|
|
|
+
|
|
|
+#define PREFIX "ACPI: "
|
|
|
+
|
|
|
+ACPI_MODULE_NAME("cmos rtc");
|
|
|
+
|
|
|
+static const struct acpi_device_id acpi_cmos_rtc_ids[] = {
|
|
|
+ { "PNP0B00" },
|
|
|
+ { "PNP0B01" },
|
|
|
+ { "PNP0B02" },
|
|
|
+ {}
|
|
|
+};
|
|
|
+
|
|
|
+static acpi_status
|
|
|
+acpi_cmos_rtc_space_handler(u32 function, acpi_physical_address address,
|
|
|
+ u32 bits, u64 *value64,
|
|
|
+ void *handler_context, void *region_context)
|
|
|
+{
|
|
|
+ int i;
|
|
|
+ u8 *value = (u8 *)&value64;
|
|
|
+
|
|
|
+ if (address > 0xff || !value64)
|
|
|
+ return AE_BAD_PARAMETER;
|
|
|
+
|
|
|
+ if (function != ACPI_WRITE && function != ACPI_READ)
|
|
|
+ return AE_BAD_PARAMETER;
|
|
|
+
|
|
|
+ spin_lock_irq(&rtc_lock);
|
|
|
+
|
|
|
+ for (i = 0; i < DIV_ROUND_UP(bits, 8); ++i, ++address, ++value)
|
|
|
+ if (function == ACPI_READ)
|
|
|
+ *value = CMOS_READ(address);
|
|
|
+ else
|
|
|
+ CMOS_WRITE(*value, address);
|
|
|
+
|
|
|
+ spin_unlock_irq(&rtc_lock);
|
|
|
+
|
|
|
+ return AE_OK;
|
|
|
+}
|
|
|
+
|
|
|
+static int acpi_install_cmos_rtc_space_handler(struct acpi_device *adev,
|
|
|
+ const struct acpi_device_id *id)
|
|
|
+{
|
|
|
+ acpi_status status;
|
|
|
+
|
|
|
+ status = acpi_install_address_space_handler(adev->handle,
|
|
|
+ ACPI_ADR_SPACE_CMOS,
|
|
|
+ &acpi_cmos_rtc_space_handler,
|
|
|
+ NULL, NULL);
|
|
|
+ if (ACPI_FAILURE(status)) {
|
|
|
+ pr_err(PREFIX "Error installing CMOS-RTC region handler\n");
|
|
|
+ return -ENODEV;
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static void acpi_remove_cmos_rtc_space_handler(struct acpi_device *adev)
|
|
|
+{
|
|
|
+ if (ACPI_FAILURE(acpi_remove_address_space_handler(adev->handle,
|
|
|
+ ACPI_ADR_SPACE_CMOS, &acpi_cmos_rtc_space_handler)))
|
|
|
+ pr_err(PREFIX "Error removing CMOS-RTC region handler\n");
|
|
|
+}
|
|
|
+
|
|
|
+static struct acpi_scan_handler cmos_rtc_handler = {
|
|
|
+ .ids = acpi_cmos_rtc_ids,
|
|
|
+ .attach = acpi_install_cmos_rtc_space_handler,
|
|
|
+ .detach = acpi_remove_cmos_rtc_space_handler,
|
|
|
+};
|
|
|
+
|
|
|
+void __init acpi_cmos_rtc_init(void)
|
|
|
+{
|
|
|
+ acpi_scan_add_handler(&cmos_rtc_handler);
|
|
|
+}
|