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