2019-06-04 16:11:33 +08:00
|
|
|
// SPDX-License-Identifier: GPL-2.0-only
|
2012-12-04 22:55:14 +08:00
|
|
|
/*
|
|
|
|
* Copyright (C) 2012 Freescale Semiconductor, Inc.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/cpuidle.h>
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <asm/cpuidle.h>
|
|
|
|
|
2016-06-21 20:13:11 +08:00
|
|
|
#include <soc/imx/cpuidle.h>
|
|
|
|
|
2012-12-04 22:55:15 +08:00
|
|
|
#include "common.h"
|
2012-12-04 22:55:14 +08:00
|
|
|
#include "cpuidle.h"
|
2014-06-20 13:44:05 +08:00
|
|
|
#include "hardware.h"
|
2012-12-04 22:55:14 +08:00
|
|
|
|
ARM: imx6q: cpuidle: fix bug that CPU might not wake up at expected time
In the current cpuidle implementation for i.MX6q, the CPU that sets
'WAIT_UNCLOCKED' and the CPU that returns to 'WAIT_CLOCKED' are always
the same. While the CPU that sets 'WAIT_UNCLOCKED' is in IDLE state of
"WAIT", if the other CPU wakes up and enters IDLE state of "WFI"
istead of "WAIT", this CPU can not wake up at expired time.
Because, in the case of "WFI", the CPU must be waked up by the local
timer interrupt. But, while 'WAIT_UNCLOCKED' is set, the local timer
is stopped, when all CPUs execute "wfi" instruction. As a result, the
local timer interrupt is not fired.
In this situation, this CPU will wake up by IRQ different from local
timer. (e.g. broacast timer)
So, this fix changes CPU to return to 'WAIT_CLOCKED'.
Signed-off-by: Kohji Okuno <okuno.kohji@jp.panasonic.com>
Fixes: e5f9dec8ff5f ("ARM: imx6q: support WAIT mode using cpuidle")
Cc: <stable@vger.kernel.org>
Signed-off-by: Shawn Guo <shawnguo@kernel.org>
2019-02-26 10:34:13 +08:00
|
|
|
static int num_idle_cpus = 0;
|
2019-05-29 23:42:29 +08:00
|
|
|
static DEFINE_RAW_SPINLOCK(cpuidle_lock);
|
2012-12-04 22:55:15 +08:00
|
|
|
|
|
|
|
static int imx6q_enter_wait(struct cpuidle_device *dev,
|
|
|
|
struct cpuidle_driver *drv, int index)
|
|
|
|
{
|
2019-05-29 23:42:29 +08:00
|
|
|
raw_spin_lock(&cpuidle_lock);
|
ARM: imx6q: cpuidle: fix bug that CPU might not wake up at expected time
In the current cpuidle implementation for i.MX6q, the CPU that sets
'WAIT_UNCLOCKED' and the CPU that returns to 'WAIT_CLOCKED' are always
the same. While the CPU that sets 'WAIT_UNCLOCKED' is in IDLE state of
"WAIT", if the other CPU wakes up and enters IDLE state of "WFI"
istead of "WAIT", this CPU can not wake up at expired time.
Because, in the case of "WFI", the CPU must be waked up by the local
timer interrupt. But, while 'WAIT_UNCLOCKED' is set, the local timer
is stopped, when all CPUs execute "wfi" instruction. As a result, the
local timer interrupt is not fired.
In this situation, this CPU will wake up by IRQ different from local
timer. (e.g. broacast timer)
So, this fix changes CPU to return to 'WAIT_CLOCKED'.
Signed-off-by: Kohji Okuno <okuno.kohji@jp.panasonic.com>
Fixes: e5f9dec8ff5f ("ARM: imx6q: support WAIT mode using cpuidle")
Cc: <stable@vger.kernel.org>
Signed-off-by: Shawn Guo <shawnguo@kernel.org>
2019-02-26 10:34:13 +08:00
|
|
|
if (++num_idle_cpus == num_online_cpus())
|
2015-04-25 22:59:19 +08:00
|
|
|
imx6_set_lpm(WAIT_UNCLOCKED);
|
2019-05-29 23:42:29 +08:00
|
|
|
raw_spin_unlock(&cpuidle_lock);
|
2012-12-04 22:55:15 +08:00
|
|
|
|
|
|
|
cpu_do_idle();
|
ARM: imx6q: cpuidle: fix bug that CPU might not wake up at expected time
In the current cpuidle implementation for i.MX6q, the CPU that sets
'WAIT_UNCLOCKED' and the CPU that returns to 'WAIT_CLOCKED' are always
the same. While the CPU that sets 'WAIT_UNCLOCKED' is in IDLE state of
"WAIT", if the other CPU wakes up and enters IDLE state of "WFI"
istead of "WAIT", this CPU can not wake up at expired time.
Because, in the case of "WFI", the CPU must be waked up by the local
timer interrupt. But, while 'WAIT_UNCLOCKED' is set, the local timer
is stopped, when all CPUs execute "wfi" instruction. As a result, the
local timer interrupt is not fired.
In this situation, this CPU will wake up by IRQ different from local
timer. (e.g. broacast timer)
So, this fix changes CPU to return to 'WAIT_CLOCKED'.
Signed-off-by: Kohji Okuno <okuno.kohji@jp.panasonic.com>
Fixes: e5f9dec8ff5f ("ARM: imx6q: support WAIT mode using cpuidle")
Cc: <stable@vger.kernel.org>
Signed-off-by: Shawn Guo <shawnguo@kernel.org>
2019-02-26 10:34:13 +08:00
|
|
|
|
2019-05-29 23:42:29 +08:00
|
|
|
raw_spin_lock(&cpuidle_lock);
|
ARM: imx6q: cpuidle: fix bug that CPU might not wake up at expected time
In the current cpuidle implementation for i.MX6q, the CPU that sets
'WAIT_UNCLOCKED' and the CPU that returns to 'WAIT_CLOCKED' are always
the same. While the CPU that sets 'WAIT_UNCLOCKED' is in IDLE state of
"WAIT", if the other CPU wakes up and enters IDLE state of "WFI"
istead of "WAIT", this CPU can not wake up at expired time.
Because, in the case of "WFI", the CPU must be waked up by the local
timer interrupt. But, while 'WAIT_UNCLOCKED' is set, the local timer
is stopped, when all CPUs execute "wfi" instruction. As a result, the
local timer interrupt is not fired.
In this situation, this CPU will wake up by IRQ different from local
timer. (e.g. broacast timer)
So, this fix changes CPU to return to 'WAIT_CLOCKED'.
Signed-off-by: Kohji Okuno <okuno.kohji@jp.panasonic.com>
Fixes: e5f9dec8ff5f ("ARM: imx6q: support WAIT mode using cpuidle")
Cc: <stable@vger.kernel.org>
Signed-off-by: Shawn Guo <shawnguo@kernel.org>
2019-02-26 10:34:13 +08:00
|
|
|
if (num_idle_cpus-- == num_online_cpus())
|
|
|
|
imx6_set_lpm(WAIT_CLOCKED);
|
2019-05-29 23:42:29 +08:00
|
|
|
raw_spin_unlock(&cpuidle_lock);
|
2012-12-04 22:55:15 +08:00
|
|
|
|
|
|
|
return index;
|
|
|
|
}
|
|
|
|
|
2012-12-04 22:55:14 +08:00
|
|
|
static struct cpuidle_driver imx6q_cpuidle_driver = {
|
|
|
|
.name = "imx6q_cpuidle",
|
|
|
|
.owner = THIS_MODULE,
|
2012-12-04 22:55:15 +08:00
|
|
|
.states = {
|
|
|
|
/* WFI */
|
|
|
|
ARM_CPUIDLE_WFI_STATE,
|
|
|
|
/* WAIT */
|
|
|
|
{
|
|
|
|
.exit_latency = 50,
|
|
|
|
.target_residency = 75,
|
2014-11-12 23:03:50 +08:00
|
|
|
.flags = CPUIDLE_FLAG_TIMER_STOP,
|
2012-12-04 22:55:15 +08:00
|
|
|
.enter = imx6q_enter_wait,
|
|
|
|
.name = "WAIT",
|
|
|
|
.desc = "Clock off",
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.state_count = 2,
|
|
|
|
.safe_state_index = 0,
|
2012-12-04 22:55:14 +08:00
|
|
|
};
|
|
|
|
|
2016-06-04 00:31:19 +08:00
|
|
|
/*
|
|
|
|
* i.MX6 Q/DL has an erratum (ERR006687) that prevents the FEC from waking the
|
|
|
|
* CPUs when they are in wait(unclocked) state. As the hardware workaround isn't
|
|
|
|
* applicable to all boards, disable the deeper idle state when the workaround
|
|
|
|
* isn't present and the FEC is in use.
|
|
|
|
*/
|
|
|
|
void imx6q_cpuidle_fec_irqs_used(void)
|
|
|
|
{
|
2019-11-18 19:11:24 +08:00
|
|
|
cpuidle_driver_state_disabled(&imx6q_cpuidle_driver, 1, true);
|
2016-06-04 00:31:19 +08:00
|
|
|
}
|
2016-06-21 10:30:44 +08:00
|
|
|
EXPORT_SYMBOL_GPL(imx6q_cpuidle_fec_irqs_used);
|
2016-06-04 00:31:19 +08:00
|
|
|
|
|
|
|
void imx6q_cpuidle_fec_irqs_unused(void)
|
|
|
|
{
|
2019-11-18 19:11:24 +08:00
|
|
|
cpuidle_driver_state_disabled(&imx6q_cpuidle_driver, 1, false);
|
2016-06-04 00:31:19 +08:00
|
|
|
}
|
2016-06-21 10:30:44 +08:00
|
|
|
EXPORT_SYMBOL_GPL(imx6q_cpuidle_fec_irqs_unused);
|
2016-06-04 00:31:19 +08:00
|
|
|
|
2012-12-04 22:55:14 +08:00
|
|
|
int __init imx6q_cpuidle_init(void)
|
|
|
|
{
|
2014-01-07 18:00:40 +08:00
|
|
|
/* Set INT_MEM_CLK_LPM bit to get a reliable WAIT mode support */
|
2016-08-29 21:49:56 +08:00
|
|
|
imx6_set_int_mem_clk_lpm(true);
|
2012-12-04 22:55:15 +08:00
|
|
|
|
2013-04-23 16:54:45 +08:00
|
|
|
return cpuidle_register(&imx6q_cpuidle_driver, NULL);
|
2012-12-04 22:55:14 +08:00
|
|
|
}
|