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