arch/arm/mach-imx/cpuidle-imx6sl.c

   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 }