Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  * ACPI support for CMOS RTC Address Space access
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5)  * Copyright (C) 2013, Intel Corporation
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6)  * Authors: Lan Tianyu <tianyu.lan@intel.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) #include <linux/acpi.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/err.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/mc146818rtc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include "internal.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) static const struct acpi_device_id acpi_cmos_rtc_ids[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 	{ "PNP0B00" },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 	{ "PNP0B01" },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 	{ "PNP0B02" },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 	{}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) static acpi_status
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) acpi_cmos_rtc_space_handler(u32 function, acpi_physical_address address,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 		      u32 bits, u64 *value64,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 		      void *handler_context, void *region_context)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	u8 *value = (u8 *)value64;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 	if (address > 0xff || !value64)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 		return AE_BAD_PARAMETER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 	if (function != ACPI_WRITE && function != ACPI_READ)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 		return AE_BAD_PARAMETER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 	spin_lock_irq(&rtc_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 	for (i = 0; i < DIV_ROUND_UP(bits, 8); ++i, ++address, ++value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 		if (function == ACPI_READ)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 			*value = CMOS_READ(address);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 		else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 			CMOS_WRITE(*value, address);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 	spin_unlock_irq(&rtc_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 	return AE_OK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) static int acpi_install_cmos_rtc_space_handler(struct acpi_device *adev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 		const struct acpi_device_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) 	acpi_status status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 	status = acpi_install_address_space_handler(adev->handle,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 			ACPI_ADR_SPACE_CMOS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 			&acpi_cmos_rtc_space_handler,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 			NULL, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 	if (ACPI_FAILURE(status)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 		pr_err(PREFIX "Error installing CMOS-RTC region handler\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 	return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) static void acpi_remove_cmos_rtc_space_handler(struct acpi_device *adev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) 	if (ACPI_FAILURE(acpi_remove_address_space_handler(adev->handle,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) 			ACPI_ADR_SPACE_CMOS, &acpi_cmos_rtc_space_handler)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) 		pr_err(PREFIX "Error removing CMOS-RTC region handler\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) static struct acpi_scan_handler cmos_rtc_handler = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) 	.ids = acpi_cmos_rtc_ids,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) 	.attach = acpi_install_cmos_rtc_space_handler,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) 	.detach = acpi_remove_cmos_rtc_space_handler,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) void __init acpi_cmos_rtc_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) 	acpi_scan_add_handler(&cmos_rtc_handler);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) }