From patchwork Tue Jul 30 07:00:03 2013 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Dongsheng Wang X-Patchwork-Id: 263208 Return-Path: X-Original-To: patchwork-incoming@ozlabs.org Delivered-To: patchwork-incoming@ozlabs.org Received: from ozlabs.org (localhost [IPv6:::1]) by ozlabs.org (Postfix) with ESMTP id 50BD12C0205 for ; Tue, 30 Jul 2013 17:53:01 +1000 (EST) Received: from co1outboundpool.messaging.microsoft.com (co1ehsobe001.messaging.microsoft.com [216.32.180.184]) (using TLSv1 with cipher AES128-SHA (128/128 bits)) (Client CN "mail.global.frontbridge.com", Issuer "MSIT Machine Auth CA 2" (not verified)) by ozlabs.org (Postfix) with ESMTPS id 1B1852C00BE for ; Tue, 30 Jul 2013 17:52:30 +1000 (EST) Received: from mail149-co1-R.bigfish.com (10.243.78.242) by CO1EHSOBE011.bigfish.com (10.243.66.74) with Microsoft SMTP Server id 14.1.225.22; Tue, 30 Jul 2013 07:52:26 +0000 Received: from mail149-co1 (localhost [127.0.0.1]) by mail149-co1-R.bigfish.com (Postfix) with ESMTP id 9EDD1C800F3; Tue, 30 Jul 2013 07:52:26 +0000 (UTC) X-Forefront-Antispam-Report: CIP:70.37.183.190; KIP:(null); UIP:(null); IPV:NLI; H:mail.freescale.net; RD:none; EFVD:NLI X-SpamScore: 3 X-BigFish: VS3(zzc8kzz1f42h208ch1ee6h1de0h1fdah2073h1202h1e76h1d1ah1d2ah1fc6hzz1de098h8275bh1de097hz2dh2a8h668h839hd24he5bhf0ah1288h12a5h12a9h12bdh12e5h137ah139eh13b6h1441h1504h1537h162dh1631h1758h1898h18e1h1946h19b5h1ad9h1b0ah1d0ch1d2eh1d3fh1dc1h1dfeh1dffh1e23h1155h) Received: from mail149-co1 (localhost.localdomain [127.0.0.1]) by mail149-co1 (MessageSwitch) id 1375170745115891_4159; Tue, 30 Jul 2013 07:52:25 +0000 (UTC) Received: from CO1EHSMHS002.bigfish.com (unknown [10.243.78.227]) by mail149-co1.bigfish.com (Postfix) with ESMTP id 1869AA00047; Tue, 30 Jul 2013 07:52:25 +0000 (UTC) Received: from mail.freescale.net (70.37.183.190) by CO1EHSMHS002.bigfish.com (10.243.66.12) with Microsoft SMTP Server (TLS) id 14.16.227.3; Tue, 30 Jul 2013 07:52:25 +0000 Received: from az84smr01.freescale.net (10.64.34.197) by 039-SN1MMR1-002.039d.mgd.msft.net (10.84.1.15) with Microsoft SMTP Server (TLS) id 14.3.136.1; Tue, 30 Jul 2013 07:52:24 +0000 Received: from rock.am.freescale.net (rock.ap.freescale.net [10.193.20.106]) by az84smr01.freescale.net (8.14.3/8.14.0) with ESMTP id r6U7qFLM006303; Tue, 30 Jul 2013 00:52:16 -0700 From: Dongsheng Wang To: , , Subject: [PATCH] cpuidle: add freescale e500 family porcessors idle support Date: Tue, 30 Jul 2013 15:00:03 +0800 Message-ID: <1375167603-16722-1-git-send-email-dongsheng.wang@freescale.com> X-Mailer: git-send-email 1.8.0 MIME-Version: 1.0 X-OriginatorOrg: freescale.com X-FOPE-CONNECTOR: Id%0$Dn%*$RO%0$TLS%0$FQDN%$TlsDn% Cc: chenhui.zhao@freescale.com, linux-pm@vger.kernel.org, Wang Dongsheng , linuxppc-dev@lists.ozlabs.org X-BeenThere: linuxppc-dev@lists.ozlabs.org X-Mailman-Version: 2.1.15 Precedence: list List-Id: Linux on PowerPC Developers Mail List List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Errors-To: linuxppc-dev-bounces+patchwork-incoming=ozlabs.org@lists.ozlabs.org Sender: "Linuxppc-dev" From: Wang Dongsheng Add cpuidle support for e500 family, using cpuidle framework to manage various low power modes. The new implementation will remain compatible with original idle method. Initially, this supports PW10, and subsequent patches will support PW20/DOZE/NAP. Signed-off-by: Wang Dongsheng --- This patch keep using cpuidle_register_device(), because we need to support cpu hotplug. I will fix "device" issue in this driver, after Deepthi Dharwar add a hotplug handler into cpuidle freamwork. diff --git a/arch/powerpc/include/asm/machdep.h b/arch/powerpc/include/asm/machdep.h index 8b48090..cbdbe25 100644 --- a/arch/powerpc/include/asm/machdep.h +++ b/arch/powerpc/include/asm/machdep.h @@ -271,6 +271,16 @@ extern void power7_idle(void); extern void ppc6xx_idle(void); extern void book3e_idle(void); +/* Wait for Interrupt */ +static inline void fsl_cpuidle_wait(void) +{ +#ifdef CONFIG_PPC64 + book3e_idle(); +#else + e500_idle(); +#endif +} + /* * ppc_md contains a copy of the machine description structure for the * current platform. machine_id contains the initial address where the diff --git a/drivers/cpuidle/Kconfig b/drivers/cpuidle/Kconfig index b3fb81d..7ed114b 100644 --- a/drivers/cpuidle/Kconfig +++ b/drivers/cpuidle/Kconfig @@ -35,6 +35,11 @@ depends on ARM source "drivers/cpuidle/Kconfig.arm" endmenu +menu "PowerPC CPU Idle Drivers" +depends on PPC32 || PPC64 +source "drivers/cpuidle/Kconfig.powerpc" +endmenu + endif config ARCH_NEEDS_CPU_IDLE_COUPLED diff --git a/drivers/cpuidle/Kconfig.powerpc b/drivers/cpuidle/Kconfig.powerpc new file mode 100644 index 0000000..9f3f5ef --- /dev/null +++ b/drivers/cpuidle/Kconfig.powerpc @@ -0,0 +1,9 @@ +# +# PowerPC CPU Idle drivers +# + +config PPC_E500_CPUIDLE + bool "CPU Idle Driver for E500 family processors" + depends on FSL_SOC_BOOKE + help + Select this to enable cpuidle on e500 family processors. diff --git a/drivers/cpuidle/Makefile b/drivers/cpuidle/Makefile index 0b9d200..0dde3db 100644 --- a/drivers/cpuidle/Makefile +++ b/drivers/cpuidle/Makefile @@ -11,3 +11,7 @@ obj-$(CONFIG_ARM_HIGHBANK_CPUIDLE) += cpuidle-calxeda.o obj-$(CONFIG_ARM_KIRKWOOD_CPUIDLE) += cpuidle-kirkwood.o obj-$(CONFIG_ARM_ZYNQ_CPUIDLE) += cpuidle-zynq.o obj-$(CONFIG_ARM_U8500_CPUIDLE) += cpuidle-ux500.o + +################################################################################## +# PowerPC platform drivers +obj-$(CONFIG_PPC_E500_CPUIDLE) += cpuidle-e500.o diff --git a/drivers/cpuidle/cpuidle-e500.c b/drivers/cpuidle/cpuidle-e500.c new file mode 100644 index 0000000..1919cea --- /dev/null +++ b/drivers/cpuidle/cpuidle-e500.c @@ -0,0 +1,222 @@ +/* + * Copyright 2013 Freescale Semiconductor, Inc. + * + * CPU Idle driver for Freescale PowerPC e500 family processors. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + * + * Author: Wang Dongsheng + */ + +#include +#include +#include +#include +#include +#include + +#include + +static struct cpuidle_driver e500_idle_driver = { + .name = "e500_idle", + .owner = THIS_MODULE, +}; + +static struct cpuidle_device __percpu *e500_cpuidle_devices; + +static void e500_cpuidle(void) +{ + /* + * This would call on the cpuidle framework, and the back-end + * driver to go to idle states. + */ + if (cpuidle_idle_call()) { + /* + * On error, execute default handler + * to go into low thread priority and possibly + * low power mode. + */ + HMT_low(); + HMT_very_low(); + } +} + +static int pw10_enter(struct cpuidle_device *dev, + struct cpuidle_driver *drv, int index) +{ + fsl_cpuidle_wait(); + return index; +} + +static struct cpuidle_state fsl_pw_idle_states[] = { + { + .name = "pw10", + .desc = "pw10", + .flags = CPUIDLE_FLAG_TIME_VALID, + .exit_latency = 0, + .target_residency = 0, + .enter = &pw10_enter + }, +}; + +static int cpu_hotplug_notify(struct notifier_block *n, + unsigned long action, void *hcpu) +{ + unsigned long hotcpu = (unsigned long)hcpu; + struct cpuidle_device *dev = + per_cpu_ptr(e500_cpuidle_devices, hotcpu); + + if (dev && cpuidle_get_driver()) { + switch (action) { + case CPU_ONLINE: + case CPU_ONLINE_FROZEN: + cpuidle_pause_and_lock(); + cpuidle_enable_device(dev); + cpuidle_resume_and_unlock(); + break; + + case CPU_DEAD: + case CPU_DEAD_FROZEN: + cpuidle_pause_and_lock(); + cpuidle_disable_device(dev); + cpuidle_resume_and_unlock(); + break; + + default: + return NOTIFY_DONE; + } + } + + return NOTIFY_OK; +} + +static struct notifier_block cpu_hotplug_notifier = { + .notifier_call = cpu_hotplug_notify, +}; + +/* + * e500_idle_devices_init(void) + * allocate, initialize and register cpuidle device + */ +static int e500_idle_devices_init(void) +{ + int i; + struct cpuidle_driver *drv = &e500_idle_driver; + struct cpuidle_device *dev; + + e500_cpuidle_devices = alloc_percpu(struct cpuidle_device); + if (!e500_cpuidle_devices) + return -ENOMEM; + + for_each_possible_cpu(i) { + dev = per_cpu_ptr(e500_cpuidle_devices, i); + dev->state_count = drv->state_count; + dev->cpu = i; + + if (cpuidle_register_device(dev)) { + pr_err("cpuidle_register_device %d failed!\n", i); + return -EIO; + } + } + + return 0; +} + +/* + * e500_idle_devices_uninit(void) + * unregister cpuidle devices and de-allocate memory + */ +static void e500_idle_devices_uninit(void) +{ + int i; + struct cpuidle_device *dev; + + if (!e500_cpuidle_devices) + return; + + for_each_possible_cpu(i) { + dev = per_cpu_ptr(e500_cpuidle_devices, i); + cpuidle_unregister_device(dev); + } + + free_percpu(e500_cpuidle_devices); +} + +static void e500_cpuidle_driver_init(unsigned int max_idle_state, + struct cpuidle_state *cpuidle_state_table) +{ + int idle_state; + struct cpuidle_driver *drv = &e500_idle_driver; + + drv->state_count = 0; + + for (idle_state = 0; idle_state < max_idle_state; ++idle_state) { + if (!cpuidle_state_table[idle_state].enter) + break; + + drv->states[drv->state_count] = cpuidle_state_table[idle_state]; + drv->state_count++; + } +} + +static int cpu_is_feature(unsigned long feature) +{ + return (cur_cpu_spec->cpu_features == feature); +} + +static int __init e500_idle_init(void) +{ + struct cpuidle_state *cpuidle_state_table = NULL; + struct cpuidle_driver *drv = &e500_idle_driver; + int err; + unsigned int max_idle_state = 0; + + if (cpuidle_disable != IDLE_NO_OVERRIDE) + return -ENODEV; + + if (cpu_is_feature(CPU_FTRS_E500MC) || cpu_is_feature(CPU_FTRS_E5500) || + cpu_is_feature(CPU_FTRS_E6500)) { + cpuidle_state_table = fsl_pw_idle_states; + max_idle_state = ARRAY_SIZE(fsl_pw_idle_states); + } + + if (!cpuidle_state_table || !max_idle_state) + return -EPERM; + + e500_cpuidle_driver_init(max_idle_state, cpuidle_state_table); + + if (!drv->state_count) + return -EPERM; + + err = cpuidle_register_driver(drv); + if (err) { + pr_err("Register e500 family cpuidle driver failed.\n"); + + return err; + } + + err = e500_idle_devices_init(); + if (err) + goto out; + + err = register_cpu_notifier(&cpu_hotplug_notifier); + if (err) + goto out; + + ppc_md.power_save = e500_cpuidle; + + pr_info("e500_idle_driver registered.\n"); + + return 0; + +out: + e500_idle_devices_uninit(); + cpuidle_unregister_driver(drv); + + pr_err("Register e500 family cpuidle driver failed.\n"); + + return err; +} +device_initcall(e500_idle_init);