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)  * Copyright (C) 2014 Freescale Semiconductor, Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6) #include <linux/cpuidle.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) #include <asm/cpuidle.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include "common.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include "cpuidle.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) static int imx6sl_enter_wait(struct cpuidle_device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 			    struct cpuidle_driver *drv, int index)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 	imx6_set_lpm(WAIT_UNCLOCKED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 	 * Software workaround for ERR005311, see function
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 	 * description for details.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 	imx6sl_set_wait_clk(true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 	cpu_do_idle();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	imx6sl_set_wait_clk(false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 	imx6_set_lpm(WAIT_CLOCKED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 	return index;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) static struct cpuidle_driver imx6sl_cpuidle_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	.name = "imx6sl_cpuidle",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	.owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 	.states = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 		/* WFI */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 		ARM_CPUIDLE_WFI_STATE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 		/* WAIT */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 		{
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 			.exit_latency = 50,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 			.target_residency = 75,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 			.flags = CPUIDLE_FLAG_TIMER_STOP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 			.enter = imx6sl_enter_wait,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 			.name = "WAIT",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 			.desc = "Clock off",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 		},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 	.state_count = 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	.safe_state_index = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) int __init imx6sl_cpuidle_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	return cpuidle_register(&imx6sl_cpuidle_driver, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) }