blob: f1a5da44591dcd1b415b57e638165318bc13e793 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * processor_idle - idle state submodule to the ACPI processor driver
3 *
4 * Copyright (C) 2001, 2002 Andy Grover <andrew.grover@intel.com>
5 * Copyright (C) 2001, 2002 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com>
Dominik Brodowskic5ab81c2006-06-24 19:37:00 -04006 * Copyright (C) 2004, 2005 Dominik Brodowski <linux@brodo.de>
Linus Torvalds1da177e2005-04-16 15:20:36 -07007 * Copyright (C) 2004 Anil S Keshavamurthy <anil.s.keshavamurthy@intel.com>
8 * - Added processor hotplug support
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -04009 * Copyright (C) 2005 Venkatesh Pallipadi <venkatesh.pallipadi@intel.com>
10 * - Added support for C3 on SMP
Linus Torvalds1da177e2005-04-16 15:20:36 -070011 *
12 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
13 *
14 * This program is free software; you can redistribute it and/or modify
15 * it under the terms of the GNU General Public License as published by
16 * the Free Software Foundation; either version 2 of the License, or (at
17 * your option) any later version.
18 *
19 * This program is distributed in the hope that it will be useful, but
20 * WITHOUT ANY WARRANTY; without even the implied warranty of
21 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
22 * General Public License for more details.
23 *
24 * You should have received a copy of the GNU General Public License along
25 * with this program; if not, write to the Free Software Foundation, Inc.,
26 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
27 *
28 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
29 */
30
31#include <linux/kernel.h>
32#include <linux/module.h>
33#include <linux/init.h>
34#include <linux/cpufreq.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090035#include <linux/slab.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070036#include <linux/acpi.h>
37#include <linux/dmi.h>
38#include <linux/moduleparam.h>
Tim Schmielau4e57b682005-10-30 15:03:48 -080039#include <linux/sched.h> /* need_resched() */
Jean Pihete8db0be2011-08-25 15:35:03 +020040#include <linux/pm_qos.h>
Thomas Gleixnere9e2cdb2007-02-16 01:28:04 -080041#include <linux/clockchips.h>
Len Brown4f86d3a2007-10-03 18:58:00 -040042#include <linux/cpuidle.h>
Russell Kingba84be22009-01-06 14:41:07 -080043#include <linux/irqflags.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070044
Thomas Gleixner34349332007-02-16 01:27:54 -080045/*
46 * Include the apic definitions for x86 to have the APIC timer related defines
47 * available also for UP (on SMP it gets magically included via linux/smp.h).
48 * asm/acpi.h is not an option, as it would require more include magic. Also
49 * creating an empty asm-ia64/apic.h would just trade pest vs. cholera.
50 */
51#ifdef CONFIG_X86
52#include <asm/apic.h>
53#endif
54
Linus Torvalds1da177e2005-04-16 15:20:36 -070055#include <asm/io.h>
56#include <asm/uaccess.h>
57
58#include <acpi/acpi_bus.h>
59#include <acpi/processor.h>
Zhao Yakuic1e3b372008-06-24 17:58:53 +080060#include <asm/processor.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070061
Len Browna192a952009-07-28 16:45:54 -040062#define PREFIX "ACPI: "
63
Linus Torvalds1da177e2005-04-16 15:20:36 -070064#define ACPI_PROCESSOR_CLASS "processor"
Linus Torvalds1da177e2005-04-16 15:20:36 -070065#define _COMPONENT ACPI_PROCESSOR_COMPONENT
Len Brownf52fd662007-02-12 22:42:12 -050066ACPI_MODULE_NAME("processor_idle");
Ingo Molnar2aa44d02007-08-23 15:18:02 +020067#define PM_TIMER_TICK_NS (1000000000ULL/PM_TIMER_FREQUENCY)
Len Brown4f86d3a2007-10-03 18:58:00 -040068#define C2_OVERHEAD 1 /* 1us */
69#define C3_OVERHEAD 1 /* 1us */
Len Brown4f86d3a2007-10-03 18:58:00 -040070#define PM_TIMER_TICKS_TO_US(p) (((p) * 1000)/(PM_TIMER_FREQUENCY/1000))
Linus Torvalds1da177e2005-04-16 15:20:36 -070071
Len Brown4f86d3a2007-10-03 18:58:00 -040072static unsigned int max_cstate __read_mostly = ACPI_PROCESSOR_MAX_POWER;
73module_param(max_cstate, uint, 0000);
Andreas Mohrb6835052006-04-27 05:25:00 -040074static unsigned int nocst __read_mostly;
Linus Torvalds1da177e2005-04-16 15:20:36 -070075module_param(nocst, uint, 0000);
Len Brownd3e7e992010-07-22 17:23:10 -040076static int bm_check_disable __read_mostly;
77module_param(bm_check_disable, uint, 0000);
Linus Torvalds1da177e2005-04-16 15:20:36 -070078
Len Brown25de5712007-12-14 00:24:15 -050079static unsigned int latency_factor __read_mostly = 2;
Len Brown4963f622007-12-13 23:50:45 -050080module_param(latency_factor, uint, 0644);
Linus Torvalds1da177e2005-04-16 15:20:36 -070081
Daniel Lezcano3d339dc2012-09-17 23:01:56 +020082static DEFINE_PER_CPU(struct cpuidle_device *, acpi_cpuidle_device);
83
Thomas Renningerd1896042010-11-03 17:06:14 +010084static int disabled_by_idle_boot_param(void)
85{
86 return boot_option_idle_override == IDLE_POLL ||
87 boot_option_idle_override == IDLE_FORCE_MWAIT ||
88 boot_option_idle_override == IDLE_HALT;
89}
90
Linus Torvalds1da177e2005-04-16 15:20:36 -070091/*
92 * IBM ThinkPad R40e crashes mysteriously when going into C2 or C3.
93 * For now disable this. Probably a bug somewhere else.
94 *
95 * To skip this limit, boot/load with a large max_cstate limit.
96 */
Jeff Garzik18552562007-10-03 15:15:40 -040097static int set_max_cstate(const struct dmi_system_id *id)
Linus Torvalds1da177e2005-04-16 15:20:36 -070098{
99 if (max_cstate > ACPI_PROCESSOR_MAX_POWER)
100 return 0;
101
Len Brown3d356002005-08-03 00:22:52 -0400102 printk(KERN_NOTICE PREFIX "%s detected - limiting to C%ld max_cstate."
Len Brown4be44fc2005-08-05 00:44:28 -0400103 " Override with \"processor.max_cstate=%d\"\n", id->ident,
104 (long)id->driver_data, ACPI_PROCESSOR_MAX_POWER + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105
Len Brown3d356002005-08-03 00:22:52 -0400106 max_cstate = (long)id->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107
108 return 0;
109}
110
Ashok Raj7ded5682006-02-03 21:51:23 +0100111/* Actually this shouldn't be __cpuinitdata, would be better to fix the
112 callers to only run once -AK */
113static struct dmi_system_id __cpuinitdata processor_power_dmi_table[] = {
Thomas Rosner876c1842006-01-06 01:31:00 -0500114 { set_max_cstate, "Clevo 5600D", {
115 DMI_MATCH(DMI_BIOS_VENDOR,"Phoenix Technologies LTD"),
116 DMI_MATCH(DMI_BIOS_VERSION,"SHE845M0.86C.0013.D.0302131307")},
Len Brown4be44fc2005-08-05 00:44:28 -0400117 (void *)2},
Arjan van de Ven370d5cd2010-01-27 15:25:39 -0800118 { set_max_cstate, "Pavilion zv5000", {
119 DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"),
120 DMI_MATCH(DMI_PRODUCT_NAME,"Pavilion zv5000 (DS502A#ABA)")},
121 (void *)1},
122 { set_max_cstate, "Asus L8400B", {
123 DMI_MATCH(DMI_SYS_VENDOR, "ASUSTeK Computer Inc."),
124 DMI_MATCH(DMI_PRODUCT_NAME,"L8400B series Notebook PC")},
125 (void *)1},
Linus Torvalds1da177e2005-04-16 15:20:36 -0700126 {},
127};
128
Len Brown4f86d3a2007-10-03 18:58:00 -0400129
venkatesh.pallipadi@intel.com2e906652008-01-31 17:35:03 -0800130/*
131 * Callers should disable interrupts before the call and enable
132 * interrupts after return.
133 */
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500134static void acpi_safe_halt(void)
135{
136 current_thread_info()->status &= ~TS_POLLING;
137 /*
138 * TS_POLLING-cleared state must be visible before we
139 * test NEED_RESCHED:
140 */
141 smp_mb();
Venki Pallipadi71e93d12008-03-13 17:18:19 -0700142 if (!need_resched()) {
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500143 safe_halt();
Venki Pallipadi71e93d12008-03-13 17:18:19 -0700144 local_irq_disable();
145 }
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500146 current_thread_info()->status |= TS_POLLING;
147}
148
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800149#ifdef ARCH_APICTIMER_STOPS_ON_C3
150
151/*
152 * Some BIOS implementations switch to C3 in the published C2 state.
Linus Torvalds296d93c2007-03-23 08:03:47 -0700153 * This seems to be a common problem on AMD boxen, but other vendors
154 * are affected too. We pick the most conservative approach: we assume
155 * that the local APIC stops in both C2 and C3.
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800156 */
Len Brown7e275cc2009-05-15 02:08:44 -0400157static void lapic_timer_check_state(int state, struct acpi_processor *pr,
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800158 struct acpi_processor_cx *cx)
159{
160 struct acpi_processor_power *pwr = &pr->power;
Thomas Gleixnere585bef2007-03-23 16:08:01 +0100161 u8 type = local_apic_timer_c2_ok ? ACPI_STATE_C3 : ACPI_STATE_C2;
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800162
Venkatesh Pallipadidb954b52009-04-06 18:51:29 -0700163 if (cpu_has(&cpu_data(pr->id), X86_FEATURE_ARAT))
164 return;
165
Len Brown02c68a02011-04-01 16:59:53 -0400166 if (amd_e400_c1e_detected)
Shaohua Li87ad57ba2009-05-19 16:09:42 +0800167 type = ACPI_STATE_C1;
168
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800169 /*
170 * Check, if one of the previous states already marked the lapic
171 * unstable
172 */
173 if (pwr->timer_broadcast_on_state < state)
174 return;
175
Thomas Gleixnere585bef2007-03-23 16:08:01 +0100176 if (cx->type >= type)
Linus Torvalds296d93c2007-03-23 08:03:47 -0700177 pr->power.timer_broadcast_on_state = state;
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800178}
179
Hidetoshi Seto918aae42009-12-14 17:10:06 +0900180static void __lapic_timer_propagate_broadcast(void *arg)
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800181{
Suresh Siddhaf833bab2009-08-17 14:34:59 -0700182 struct acpi_processor *pr = (struct acpi_processor *) arg;
Thomas Gleixnere9e2cdb2007-02-16 01:28:04 -0800183 unsigned long reason;
184
185 reason = pr->power.timer_broadcast_on_state < INT_MAX ?
186 CLOCK_EVT_NOTIFY_BROADCAST_ON : CLOCK_EVT_NOTIFY_BROADCAST_OFF;
187
188 clockevents_notify(reason, &pr->id);
Thomas Gleixnere9e2cdb2007-02-16 01:28:04 -0800189}
190
Hidetoshi Seto918aae42009-12-14 17:10:06 +0900191static void lapic_timer_propagate_broadcast(struct acpi_processor *pr)
192{
193 smp_call_function_single(pr->id, __lapic_timer_propagate_broadcast,
194 (void *)pr, 1);
195}
196
Thomas Gleixnere9e2cdb2007-02-16 01:28:04 -0800197/* Power(C) State timer broadcast control */
Len Brown7e275cc2009-05-15 02:08:44 -0400198static void lapic_timer_state_broadcast(struct acpi_processor *pr,
Thomas Gleixnere9e2cdb2007-02-16 01:28:04 -0800199 struct acpi_processor_cx *cx,
200 int broadcast)
201{
Thomas Gleixnere9e2cdb2007-02-16 01:28:04 -0800202 int state = cx - pr->power.states;
203
204 if (state >= pr->power.timer_broadcast_on_state) {
205 unsigned long reason;
206
207 reason = broadcast ? CLOCK_EVT_NOTIFY_BROADCAST_ENTER :
208 CLOCK_EVT_NOTIFY_BROADCAST_EXIT;
209 clockevents_notify(reason, &pr->id);
210 }
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800211}
212
213#else
214
Len Brown7e275cc2009-05-15 02:08:44 -0400215static void lapic_timer_check_state(int state, struct acpi_processor *pr,
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800216 struct acpi_processor_cx *cstate) { }
Len Brown7e275cc2009-05-15 02:08:44 -0400217static void lapic_timer_propagate_broadcast(struct acpi_processor *pr) { }
218static void lapic_timer_state_broadcast(struct acpi_processor *pr,
Thomas Gleixnere9e2cdb2007-02-16 01:28:04 -0800219 struct acpi_processor_cx *cx,
220 int broadcast)
221{
222}
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800223
224#endif
225
Len Brown815ab0f2009-05-07 22:19:45 -0400226static u32 saved_bm_rld;
227
228static void acpi_idle_bm_rld_save(void)
229{
230 acpi_read_bit_register(ACPI_BITREG_BUS_MASTER_RLD, &saved_bm_rld);
231}
232static void acpi_idle_bm_rld_restore(void)
233{
234 u32 resumed_bm_rld;
235
236 acpi_read_bit_register(ACPI_BITREG_BUS_MASTER_RLD, &resumed_bm_rld);
237
238 if (resumed_bm_rld != saved_bm_rld)
239 acpi_write_bit_register(ACPI_BITREG_BUS_MASTER_RLD, saved_bm_rld);
240}
Thomas Gleixnerb04e7bd2007-09-22 22:29:05 +0000241
Rafael J. Wysockie8110b62012-06-27 23:26:26 +0200242int acpi_processor_suspend(struct device *dev)
Thomas Gleixnerb04e7bd2007-09-22 22:29:05 +0000243{
Len Brown815ab0f2009-05-07 22:19:45 -0400244 acpi_idle_bm_rld_save();
Thomas Gleixnerb04e7bd2007-09-22 22:29:05 +0000245 return 0;
246}
247
Rafael J. Wysockie8110b62012-06-27 23:26:26 +0200248int acpi_processor_resume(struct device *dev)
Thomas Gleixnerb04e7bd2007-09-22 22:29:05 +0000249{
Len Brown815ab0f2009-05-07 22:19:45 -0400250 acpi_idle_bm_rld_restore();
Thomas Gleixnerb04e7bd2007-09-22 22:29:05 +0000251 return 0;
252}
253
John Stultz592913e2010-07-13 17:56:20 -0700254#if defined(CONFIG_X86)
Len Brown520daf72009-05-14 17:27:38 -0400255static void tsc_check_state(int state)
Andi Kleenddb25f92008-01-30 13:32:41 +0100256{
257 switch (boot_cpu_data.x86_vendor) {
258 case X86_VENDOR_AMD:
Venki Pallipadi40fb1712008-11-17 16:11:37 -0800259 case X86_VENDOR_INTEL:
Andi Kleenddb25f92008-01-30 13:32:41 +0100260 /*
261 * AMD Fam10h TSC will tick in all
262 * C/P/S0/S1 states when this bit is set.
263 */
Venki Pallipadi40fb1712008-11-17 16:11:37 -0800264 if (boot_cpu_has(X86_FEATURE_NONSTOP_TSC))
Len Brown520daf72009-05-14 17:27:38 -0400265 return;
Venki Pallipadi40fb1712008-11-17 16:11:37 -0800266
Andi Kleenddb25f92008-01-30 13:32:41 +0100267 /*FALL THROUGH*/
Andi Kleenddb25f92008-01-30 13:32:41 +0100268 default:
Len Brown520daf72009-05-14 17:27:38 -0400269 /* TSC could halt in idle, so notify users */
270 if (state > ACPI_STATE_C1)
271 mark_tsc_unstable("TSC halts in idle");
Andi Kleenddb25f92008-01-30 13:32:41 +0100272 }
273}
Len Brown520daf72009-05-14 17:27:38 -0400274#else
275static void tsc_check_state(int state) { return; }
Andi Kleenddb25f92008-01-30 13:32:41 +0100276#endif
277
Len Brown4be44fc2005-08-05 00:44:28 -0400278static int acpi_processor_get_power_info_fadt(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700279{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700280
281 if (!pr)
Patrick Mocheld550d982006-06-27 00:41:40 -0400282 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700283
284 if (!pr->pblk)
Patrick Mocheld550d982006-06-27 00:41:40 -0400285 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700286
Linus Torvalds1da177e2005-04-16 15:20:36 -0700287 /* if info is obtained from pblk/fadt, type equals state */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700288 pr->power.states[ACPI_STATE_C2].type = ACPI_STATE_C2;
289 pr->power.states[ACPI_STATE_C3].type = ACPI_STATE_C3;
290
Venkatesh Pallipadi4c033552005-09-15 12:20:00 -0400291#ifndef CONFIG_HOTPLUG_CPU
292 /*
293 * Check for P_LVL2_UP flag before entering C2 and above on
Len Brown4f86d3a2007-10-03 18:58:00 -0400294 * an SMP system.
Venkatesh Pallipadi4c033552005-09-15 12:20:00 -0400295 */
Alexey Starikovskiyad71860a2007-02-02 19:48:19 +0300296 if ((num_online_cpus() > 1) &&
Alexey Starikovskiycee324b2007-02-02 19:48:22 +0300297 !(acpi_gbl_FADT.flags & ACPI_FADT_C2_MP_SUPPORTED))
Patrick Mocheld550d982006-06-27 00:41:40 -0400298 return -ENODEV;
Venkatesh Pallipadi4c033552005-09-15 12:20:00 -0400299#endif
300
Linus Torvalds1da177e2005-04-16 15:20:36 -0700301 /* determine C2 and C3 address from pblk */
302 pr->power.states[ACPI_STATE_C2].address = pr->pblk + 4;
303 pr->power.states[ACPI_STATE_C3].address = pr->pblk + 5;
304
305 /* determine latencies from FADT */
Bob Mooreba494be2012-07-12 09:40:10 +0800306 pr->power.states[ACPI_STATE_C2].latency = acpi_gbl_FADT.c2_latency;
307 pr->power.states[ACPI_STATE_C3].latency = acpi_gbl_FADT.c3_latency;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700308
Len Brown5d76b6f2010-01-19 22:41:14 -0500309 /*
310 * FADT specified C2 latency must be less than or equal to
311 * 100 microseconds.
312 */
Bob Mooreba494be2012-07-12 09:40:10 +0800313 if (acpi_gbl_FADT.c2_latency > ACPI_PROCESSOR_MAX_C2_LATENCY) {
Len Brown5d76b6f2010-01-19 22:41:14 -0500314 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
Bob Mooreba494be2012-07-12 09:40:10 +0800315 "C2 latency too large [%d]\n", acpi_gbl_FADT.c2_latency));
Len Brown5d76b6f2010-01-19 22:41:14 -0500316 /* invalidate C2 */
317 pr->power.states[ACPI_STATE_C2].address = 0;
318 }
319
Len Browna6d72c12010-01-19 23:10:04 -0500320 /*
321 * FADT supplied C3 latency must be less than or equal to
322 * 1000 microseconds.
323 */
Bob Mooreba494be2012-07-12 09:40:10 +0800324 if (acpi_gbl_FADT.c3_latency > ACPI_PROCESSOR_MAX_C3_LATENCY) {
Len Browna6d72c12010-01-19 23:10:04 -0500325 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
Bob Mooreba494be2012-07-12 09:40:10 +0800326 "C3 latency too large [%d]\n", acpi_gbl_FADT.c3_latency));
Len Browna6d72c12010-01-19 23:10:04 -0500327 /* invalidate C3 */
328 pr->power.states[ACPI_STATE_C3].address = 0;
329 }
330
Linus Torvalds1da177e2005-04-16 15:20:36 -0700331 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
332 "lvl2[0x%08x] lvl3[0x%08x]\n",
333 pr->power.states[ACPI_STATE_C2].address,
334 pr->power.states[ACPI_STATE_C3].address));
335
Patrick Mocheld550d982006-06-27 00:41:40 -0400336 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700337}
338
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700339static int acpi_processor_get_power_info_default(struct acpi_processor *pr)
Venkatesh Pallipadiacf05f42005-03-31 23:23:15 -0500340{
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700341 if (!pr->power.states[ACPI_STATE_C1].valid) {
342 /* set the first C-State to C1 */
343 /* all processors need to support C1 */
344 pr->power.states[ACPI_STATE_C1].type = ACPI_STATE_C1;
345 pr->power.states[ACPI_STATE_C1].valid = 1;
Venkatesh Pallipadi0fda6b42008-04-09 21:31:46 -0400346 pr->power.states[ACPI_STATE_C1].entry_method = ACPI_CSTATE_HALT;
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700347 }
348 /* the C0 state only exists as a filler in our array */
Venkatesh Pallipadiacf05f42005-03-31 23:23:15 -0500349 pr->power.states[ACPI_STATE_C0].valid = 1;
Patrick Mocheld550d982006-06-27 00:41:40 -0400350 return 0;
Venkatesh Pallipadiacf05f42005-03-31 23:23:15 -0500351}
352
Len Brown4be44fc2005-08-05 00:44:28 -0400353static int acpi_processor_get_power_info_cst(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700354{
Len Brown4be44fc2005-08-05 00:44:28 -0400355 acpi_status status = 0;
Lin Ming439913f2010-01-28 10:53:19 +0800356 u64 count;
Janosch Machowinskicf824782005-08-20 08:02:00 -0400357 int current_count;
Len Brown4be44fc2005-08-05 00:44:28 -0400358 int i;
359 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
360 union acpi_object *cst;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700361
Linus Torvalds1da177e2005-04-16 15:20:36 -0700362
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363 if (nocst)
Patrick Mocheld550d982006-06-27 00:41:40 -0400364 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700365
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700366 current_count = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700367
368 status = acpi_evaluate_object(pr->handle, "_CST", NULL, &buffer);
369 if (ACPI_FAILURE(status)) {
370 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No _CST, giving up\n"));
Patrick Mocheld550d982006-06-27 00:41:40 -0400371 return -ENODEV;
Len Brown4be44fc2005-08-05 00:44:28 -0400372 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700373
Jan Engelhardt50dd0962006-10-01 00:28:50 +0200374 cst = buffer.pointer;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700375
376 /* There must be at least 2 elements */
377 if (!cst || (cst->type != ACPI_TYPE_PACKAGE) || cst->package.count < 2) {
Len Brown64684632006-06-26 23:41:38 -0400378 printk(KERN_ERR PREFIX "not enough elements in _CST\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700379 status = -EFAULT;
380 goto end;
381 }
382
383 count = cst->package.elements[0].integer.value;
384
385 /* Validate number of power states. */
386 if (count < 1 || count != cst->package.count - 1) {
Len Brown64684632006-06-26 23:41:38 -0400387 printk(KERN_ERR PREFIX "count given by _CST is not valid\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700388 status = -EFAULT;
389 goto end;
390 }
391
Linus Torvalds1da177e2005-04-16 15:20:36 -0700392 /* Tell driver that at least _CST is supported. */
393 pr->flags.has_cst = 1;
394
395 for (i = 1; i <= count; i++) {
396 union acpi_object *element;
397 union acpi_object *obj;
398 struct acpi_power_register *reg;
399 struct acpi_processor_cx cx;
400
401 memset(&cx, 0, sizeof(cx));
402
Jan Engelhardt50dd0962006-10-01 00:28:50 +0200403 element = &(cst->package.elements[i]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404 if (element->type != ACPI_TYPE_PACKAGE)
405 continue;
406
407 if (element->package.count != 4)
408 continue;
409
Jan Engelhardt50dd0962006-10-01 00:28:50 +0200410 obj = &(element->package.elements[0]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700411
412 if (obj->type != ACPI_TYPE_BUFFER)
413 continue;
414
Len Brown4be44fc2005-08-05 00:44:28 -0400415 reg = (struct acpi_power_register *)obj->buffer.pointer;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416
417 if (reg->space_id != ACPI_ADR_SPACE_SYSTEM_IO &&
Len Brown4be44fc2005-08-05 00:44:28 -0400418 (reg->space_id != ACPI_ADR_SPACE_FIXED_HARDWARE))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700419 continue;
420
Linus Torvalds1da177e2005-04-16 15:20:36 -0700421 /* There should be an easy way to extract an integer... */
Jan Engelhardt50dd0962006-10-01 00:28:50 +0200422 obj = &(element->package.elements[1]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700423 if (obj->type != ACPI_TYPE_INTEGER)
424 continue;
425
426 cx.type = obj->integer.value;
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700427 /*
428 * Some buggy BIOSes won't list C1 in _CST -
429 * Let acpi_processor_get_power_info_default() handle them later
430 */
431 if (i == 1 && cx.type != ACPI_STATE_C1)
432 current_count++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700433
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700434 cx.address = reg->address;
435 cx.index = current_count + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700436
venkatesh.pallipadi@intel.combc71bec2008-01-31 17:35:04 -0800437 cx.entry_method = ACPI_CSTATE_SYSTEMIO;
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700438 if (reg->space_id == ACPI_ADR_SPACE_FIXED_HARDWARE) {
439 if (acpi_processor_ffh_cstate_probe
440 (pr->id, &cx, reg) == 0) {
venkatesh.pallipadi@intel.combc71bec2008-01-31 17:35:04 -0800441 cx.entry_method = ACPI_CSTATE_FFH;
442 } else if (cx.type == ACPI_STATE_C1) {
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700443 /*
444 * C1 is a special case where FIXED_HARDWARE
445 * can be handled in non-MWAIT way as well.
446 * In that case, save this _CST entry info.
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700447 * Otherwise, ignore this info and continue.
448 */
venkatesh.pallipadi@intel.combc71bec2008-01-31 17:35:04 -0800449 cx.entry_method = ACPI_CSTATE_HALT;
Venkatesh Pallipadi4fcb2fc2008-02-11 17:46:31 -0800450 snprintf(cx.desc, ACPI_CX_DESC_LEN, "ACPI HLT");
venkatesh.pallipadi@intel.combc71bec2008-01-31 17:35:04 -0800451 } else {
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700452 continue;
453 }
Zhao Yakuida5e09a2008-06-24 18:01:09 +0800454 if (cx.type == ACPI_STATE_C1 &&
Thomas Renningerd1896042010-11-03 17:06:14 +0100455 (boot_option_idle_override == IDLE_NOMWAIT)) {
Zhao Yakuic1e3b372008-06-24 17:58:53 +0800456 /*
457 * In most cases the C1 space_id obtained from
458 * _CST object is FIXED_HARDWARE access mode.
459 * But when the option of idle=halt is added,
460 * the entry_method type should be changed from
461 * CSTATE_FFH to CSTATE_HALT.
Zhao Yakuida5e09a2008-06-24 18:01:09 +0800462 * When the option of idle=nomwait is added,
463 * the C1 entry_method type should be
464 * CSTATE_HALT.
Zhao Yakuic1e3b372008-06-24 17:58:53 +0800465 */
466 cx.entry_method = ACPI_CSTATE_HALT;
467 snprintf(cx.desc, ACPI_CX_DESC_LEN, "ACPI HLT");
468 }
Venkatesh Pallipadi4fcb2fc2008-02-11 17:46:31 -0800469 } else {
470 snprintf(cx.desc, ACPI_CX_DESC_LEN, "ACPI IOPORT 0x%x",
471 cx.address);
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700472 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700473
Venkatesh Pallipadi0fda6b42008-04-09 21:31:46 -0400474 if (cx.type == ACPI_STATE_C1) {
475 cx.valid = 1;
476 }
Venkatesh Pallipadi4fcb2fc2008-02-11 17:46:31 -0800477
Jan Engelhardt50dd0962006-10-01 00:28:50 +0200478 obj = &(element->package.elements[2]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700479 if (obj->type != ACPI_TYPE_INTEGER)
480 continue;
481
482 cx.latency = obj->integer.value;
483
Jan Engelhardt50dd0962006-10-01 00:28:50 +0200484 obj = &(element->package.elements[3]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700485 if (obj->type != ACPI_TYPE_INTEGER)
486 continue;
487
Janosch Machowinskicf824782005-08-20 08:02:00 -0400488 current_count++;
489 memcpy(&(pr->power.states[current_count]), &cx, sizeof(cx));
490
491 /*
492 * We support total ACPI_PROCESSOR_MAX_POWER - 1
493 * (From 1 through ACPI_PROCESSOR_MAX_POWER - 1)
494 */
495 if (current_count >= (ACPI_PROCESSOR_MAX_POWER - 1)) {
496 printk(KERN_WARNING
497 "Limiting number of power states to max (%d)\n",
498 ACPI_PROCESSOR_MAX_POWER);
499 printk(KERN_WARNING
500 "Please increase ACPI_PROCESSOR_MAX_POWER if needed.\n");
501 break;
502 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700503 }
504
Len Brown4be44fc2005-08-05 00:44:28 -0400505 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d power states\n",
Janosch Machowinskicf824782005-08-20 08:02:00 -0400506 current_count));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507
508 /* Validate number of power states discovered */
Janosch Machowinskicf824782005-08-20 08:02:00 -0400509 if (current_count < 2)
Venkatesh Pallipadi6d93c642005-09-15 12:19:00 -0400510 status = -EFAULT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700511
Len Brown4be44fc2005-08-05 00:44:28 -0400512 end:
Len Brown02438d82006-06-30 03:19:10 -0400513 kfree(buffer.pointer);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514
Patrick Mocheld550d982006-06-27 00:41:40 -0400515 return status;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700516}
517
Len Brown4be44fc2005-08-05 00:44:28 -0400518static void acpi_processor_power_verify_c3(struct acpi_processor *pr,
519 struct acpi_processor_cx *cx)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700520{
Pallipadi, Venkateshee1ca482009-05-21 17:09:10 -0700521 static int bm_check_flag = -1;
522 static int bm_control_flag = -1;
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400523
Linus Torvalds1da177e2005-04-16 15:20:36 -0700524
525 if (!cx->address)
Patrick Mocheld550d982006-06-27 00:41:40 -0400526 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700527
528 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700529 * PIIX4 Erratum #18: We don't support C3 when Type-F (fast)
530 * DMA transfers are used by any ISA device to avoid livelock.
531 * Note that we could disable Type-F DMA (as recommended by
532 * the erratum), but this is known to disrupt certain ISA
533 * devices thus we take the conservative approach.
534 */
535 else if (errata.piix4.fdma) {
536 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
Len Brown4be44fc2005-08-05 00:44:28 -0400537 "C3 not supported on PIIX4 with Type-F DMA\n"));
Patrick Mocheld550d982006-06-27 00:41:40 -0400538 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700539 }
540
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400541 /* All the logic here assumes flags.bm_check is same across all CPUs */
Pallipadi, Venkateshee1ca482009-05-21 17:09:10 -0700542 if (bm_check_flag == -1) {
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400543 /* Determine whether bm_check is needed based on CPU */
544 acpi_processor_power_init_bm_check(&(pr->flags), pr->id);
545 bm_check_flag = pr->flags.bm_check;
Pallipadi, Venkateshee1ca482009-05-21 17:09:10 -0700546 bm_control_flag = pr->flags.bm_control;
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400547 } else {
548 pr->flags.bm_check = bm_check_flag;
Pallipadi, Venkateshee1ca482009-05-21 17:09:10 -0700549 pr->flags.bm_control = bm_control_flag;
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400550 }
551
552 if (pr->flags.bm_check) {
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400553 if (!pr->flags.bm_control) {
Venki Pallipadied3110e2007-07-31 12:04:31 -0700554 if (pr->flags.has_cst != 1) {
555 /* bus mastering control is necessary */
556 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
557 "C3 support requires BM control\n"));
558 return;
559 } else {
560 /* Here we enter C3 without bus mastering */
561 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
562 "C3 support without BM control\n"));
563 }
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400564 }
565 } else {
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400566 /*
567 * WBINVD should be set in fadt, for C3 state to be
568 * supported on when bm_check is not required.
569 */
Alexey Starikovskiycee324b2007-02-02 19:48:22 +0300570 if (!(acpi_gbl_FADT.flags & ACPI_FADT_WBINVD)) {
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400571 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
Len Brown4be44fc2005-08-05 00:44:28 -0400572 "Cache invalidation should work properly"
573 " for C3 to be enabled on SMP systems\n"));
Patrick Mocheld550d982006-06-27 00:41:40 -0400574 return;
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400575 }
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400576 }
577
Linus Torvalds1da177e2005-04-16 15:20:36 -0700578 /*
579 * Otherwise we've met all of our C3 requirements.
580 * Normalize the C3 latency to expidite policy. Enable
581 * checking of bus mastering status (bm_check) so we can
582 * use this in our C3 policy
583 */
584 cx->valid = 1;
Len Brown4f86d3a2007-10-03 18:58:00 -0400585
Len Brown31878dd2009-01-28 18:28:09 -0500586 /*
587 * On older chipsets, BM_RLD needs to be set
588 * in order for Bus Master activity to wake the
589 * system from C3. Newer chipsets handle DMA
590 * during C3 automatically and BM_RLD is a NOP.
591 * In either case, the proper way to
592 * handle BM_RLD is to set it and leave it set.
593 */
Bob Moore50ffba12009-02-23 15:02:07 +0800594 acpi_write_bit_register(ACPI_BITREG_BUS_MASTER_RLD, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700595
Patrick Mocheld550d982006-06-27 00:41:40 -0400596 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700597}
598
Linus Torvalds1da177e2005-04-16 15:20:36 -0700599static int acpi_processor_power_verify(struct acpi_processor *pr)
600{
601 unsigned int i;
602 unsigned int working = 0;
Venkatesh Pallipadi6eb0a0f2006-01-11 22:44:21 +0100603
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800604 pr->power.timer_broadcast_on_state = INT_MAX;
Venkatesh Pallipadi6eb0a0f2006-01-11 22:44:21 +0100605
Len Browna0bf2842009-05-15 01:29:31 -0400606 for (i = 1; i < ACPI_PROCESSOR_MAX_POWER && i <= max_cstate; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700607 struct acpi_processor_cx *cx = &pr->power.states[i];
608
609 switch (cx->type) {
610 case ACPI_STATE_C1:
611 cx->valid = 1;
612 break;
613
614 case ACPI_STATE_C2:
Len Brownd22edd22010-01-19 23:29:09 -0500615 if (!cx->address)
616 break;
617 cx->valid = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700618 break;
619
620 case ACPI_STATE_C3:
621 acpi_processor_power_verify_c3(pr, cx);
622 break;
623 }
Len Brown7e275cc2009-05-15 02:08:44 -0400624 if (!cx->valid)
625 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700626
Len Brown7e275cc2009-05-15 02:08:44 -0400627 lapic_timer_check_state(i, pr, cx);
628 tsc_check_state(cx->type);
629 working++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700630 }
631
Hidetoshi Seto918aae42009-12-14 17:10:06 +0900632 lapic_timer_propagate_broadcast(pr);
Andi Kleenbd663342006-03-25 16:31:07 +0100633
Linus Torvalds1da177e2005-04-16 15:20:36 -0700634 return (working);
635}
636
Len Brown4be44fc2005-08-05 00:44:28 -0400637static int acpi_processor_get_power_info(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700638{
639 unsigned int i;
640 int result;
641
Linus Torvalds1da177e2005-04-16 15:20:36 -0700642
643 /* NOTE: the idle thread may not be running while calling
644 * this function */
645
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700646 /* Zero initialize all the C-states info. */
647 memset(pr->power.states, 0, sizeof(pr->power.states));
648
Linus Torvalds1da177e2005-04-16 15:20:36 -0700649 result = acpi_processor_get_power_info_cst(pr);
Venkatesh Pallipadi6d93c642005-09-15 12:19:00 -0400650 if (result == -ENODEV)
Darrick J. Wongc5a114f2006-10-19 23:28:28 -0700651 result = acpi_processor_get_power_info_fadt(pr);
Venkatesh Pallipadi6d93c642005-09-15 12:19:00 -0400652
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700653 if (result)
654 return result;
655
656 acpi_processor_get_power_info_default(pr);
657
Janosch Machowinskicf824782005-08-20 08:02:00 -0400658 pr->power.count = acpi_processor_power_verify(pr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700659
Linus Torvalds1da177e2005-04-16 15:20:36 -0700660 /*
661 * if one state of type C2 or C3 is available, mark this
662 * CPU as being "idle manageable"
663 */
664 for (i = 1; i < ACPI_PROCESSOR_MAX_POWER; i++) {
Venkatesh Pallipadiacf05f42005-03-31 23:23:15 -0500665 if (pr->power.states[i].valid) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700666 pr->power.count = i;
Linus Torvalds2203d6e2005-11-18 07:29:51 -0800667 if (pr->power.states[i].type >= ACPI_STATE_C2)
668 pr->flags.power = 1;
Venkatesh Pallipadiacf05f42005-03-31 23:23:15 -0500669 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700670 }
671
Patrick Mocheld550d982006-06-27 00:41:40 -0400672 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700673}
674
Len Brown4f86d3a2007-10-03 18:58:00 -0400675/**
676 * acpi_idle_bm_check - checks if bus master activity was detected
677 */
678static int acpi_idle_bm_check(void)
679{
680 u32 bm_status = 0;
681
Len Brownd3e7e992010-07-22 17:23:10 -0400682 if (bm_check_disable)
683 return 0;
684
Bob Moore50ffba12009-02-23 15:02:07 +0800685 acpi_read_bit_register(ACPI_BITREG_BUS_MASTER_STATUS, &bm_status);
Len Brown4f86d3a2007-10-03 18:58:00 -0400686 if (bm_status)
Bob Moore50ffba12009-02-23 15:02:07 +0800687 acpi_write_bit_register(ACPI_BITREG_BUS_MASTER_STATUS, 1);
Len Brown4f86d3a2007-10-03 18:58:00 -0400688 /*
689 * PIIX4 Erratum #18: Note that BM_STS doesn't always reflect
690 * the true state of bus mastering activity; forcing us to
691 * manually check the BMIDEA bit of each IDE channel.
692 */
693 else if (errata.piix4.bmisx) {
694 if ((inb_p(errata.piix4.bmisx + 0x02) & 0x01)
695 || (inb_p(errata.piix4.bmisx + 0x0A) & 0x01))
696 bm_status = 1;
697 }
698 return bm_status;
699}
700
701/**
Len Brown4f86d3a2007-10-03 18:58:00 -0400702 * acpi_idle_do_entry - a helper function that does C2 and C3 type entry
703 * @cx: cstate data
venkatesh.pallipadi@intel.combc71bec2008-01-31 17:35:04 -0800704 *
705 * Caller disables interrupt before call and enables interrupt after return.
Len Brown4f86d3a2007-10-03 18:58:00 -0400706 */
707static inline void acpi_idle_do_entry(struct acpi_processor_cx *cx)
708{
Steven Rostedtdcf30992008-07-25 18:00:42 -0400709 /* Don't trace irqs off for idle */
710 stop_critical_timings();
venkatesh.pallipadi@intel.combc71bec2008-01-31 17:35:04 -0800711 if (cx->entry_method == ACPI_CSTATE_FFH) {
Len Brown4f86d3a2007-10-03 18:58:00 -0400712 /* Call into architectural FFH based C-state */
713 acpi_processor_ffh_cstate_enter(cx);
venkatesh.pallipadi@intel.combc71bec2008-01-31 17:35:04 -0800714 } else if (cx->entry_method == ACPI_CSTATE_HALT) {
715 acpi_safe_halt();
Len Brown4f86d3a2007-10-03 18:58:00 -0400716 } else {
Len Brown4f86d3a2007-10-03 18:58:00 -0400717 /* IO port based C-state */
718 inb(cx->address);
719 /* Dummy wait op - must do something useless after P_LVL2 read
720 because chipsets cannot guarantee that STPCLK# signal
721 gets asserted in time to freeze execution properly. */
Andi Kleencfa806f2010-07-20 15:18:36 -0700722 inl(acpi_gbl_FADT.xpm_timer_block.address);
Len Brown4f86d3a2007-10-03 18:58:00 -0400723 }
Steven Rostedtdcf30992008-07-25 18:00:42 -0400724 start_critical_timings();
Len Brown4f86d3a2007-10-03 18:58:00 -0400725}
726
727/**
728 * acpi_idle_enter_c1 - enters an ACPI C1 state-type
729 * @dev: the target CPU
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530730 * @drv: cpuidle driver containing cpuidle state info
Deepthi Dharware978aa72011-10-28 16:20:09 +0530731 * @index: index of target state
Len Brown4f86d3a2007-10-03 18:58:00 -0400732 *
733 * This is equivalent to the HALT instruction.
734 */
735static int acpi_idle_enter_c1(struct cpuidle_device *dev,
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530736 struct cpuidle_driver *drv, int index)
Len Brown4f86d3a2007-10-03 18:58:00 -0400737{
738 struct acpi_processor *pr;
Deepthi Dharwar42027352011-10-28 16:20:33 +0530739 struct cpuidle_state_usage *state_usage = &dev->states_usage[index];
740 struct acpi_processor_cx *cx = cpuidle_get_statedata(state_usage);
venkatesh.pallipadi@intel.com9b12e182008-01-31 17:35:05 -0800741
Christoph Lameter4a6f4fe2010-12-06 11:16:24 -0600742 pr = __this_cpu_read(processors);
Len Brown4f86d3a2007-10-03 18:58:00 -0400743
744 if (unlikely(!pr))
Deepthi Dharware978aa72011-10-28 16:20:09 +0530745 return -EINVAL;
Len Brown4f86d3a2007-10-03 18:58:00 -0400746
Len Brown7e275cc2009-05-15 02:08:44 -0400747 lapic_timer_state_broadcast(pr, cx, 1);
venkatesh.pallipadi@intel.combc71bec2008-01-31 17:35:04 -0800748 acpi_idle_do_entry(cx);
Len Brown4f86d3a2007-10-03 18:58:00 -0400749
Len Brown7e275cc2009-05-15 02:08:44 -0400750 lapic_timer_state_broadcast(pr, cx, 0);
Len Brown4f86d3a2007-10-03 18:58:00 -0400751
Deepthi Dharware978aa72011-10-28 16:20:09 +0530752 return index;
Len Brown4f86d3a2007-10-03 18:58:00 -0400753}
754
Boris Ostrovsky1a022e32012-03-13 19:55:09 +0100755
756/**
757 * acpi_idle_play_dead - enters an ACPI state for long-term idle (i.e. off-lining)
758 * @dev: the target CPU
759 * @index: the index of suggested state
760 */
761static int acpi_idle_play_dead(struct cpuidle_device *dev, int index)
762{
763 struct cpuidle_state_usage *state_usage = &dev->states_usage[index];
764 struct acpi_processor_cx *cx = cpuidle_get_statedata(state_usage);
765
766 ACPI_FLUSH_CPU_CACHE();
767
768 while (1) {
769
770 if (cx->entry_method == ACPI_CSTATE_HALT)
Luck, Tony54f70072012-04-03 09:37:28 -0700771 safe_halt();
Boris Ostrovsky1a022e32012-03-13 19:55:09 +0100772 else if (cx->entry_method == ACPI_CSTATE_SYSTEMIO) {
773 inb(cx->address);
774 /* See comment in acpi_idle_do_entry() */
775 inl(acpi_gbl_FADT.xpm_timer_block.address);
776 } else
777 return -ENODEV;
778 }
779
780 /* Never reached */
781 return 0;
782}
783
Len Brown4f86d3a2007-10-03 18:58:00 -0400784/**
785 * acpi_idle_enter_simple - enters an ACPI state without BM handling
786 * @dev: the target CPU
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530787 * @drv: cpuidle driver with cpuidle state information
Deepthi Dharware978aa72011-10-28 16:20:09 +0530788 * @index: the index of suggested state
Len Brown4f86d3a2007-10-03 18:58:00 -0400789 */
790static int acpi_idle_enter_simple(struct cpuidle_device *dev,
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530791 struct cpuidle_driver *drv, int index)
Len Brown4f86d3a2007-10-03 18:58:00 -0400792{
793 struct acpi_processor *pr;
Deepthi Dharwar42027352011-10-28 16:20:33 +0530794 struct cpuidle_state_usage *state_usage = &dev->states_usage[index];
795 struct acpi_processor_cx *cx = cpuidle_get_statedata(state_usage);
Venkatesh Pallipadi50629112007-11-19 19:49:00 -0500796
Christoph Lameter4a6f4fe2010-12-06 11:16:24 -0600797 pr = __this_cpu_read(processors);
Len Brown4f86d3a2007-10-03 18:58:00 -0400798
799 if (unlikely(!pr))
Deepthi Dharware978aa72011-10-28 16:20:09 +0530800 return -EINVAL;
Len Browne1964412007-10-04 01:23:47 -0400801
Pallipadi, Venkateshd306ebc2010-02-10 10:35:31 -0800802 if (cx->entry_method != ACPI_CSTATE_FFH) {
803 current_thread_info()->status &= ~TS_POLLING;
804 /*
805 * TS_POLLING-cleared state must be visible before we test
806 * NEED_RESCHED:
807 */
808 smp_mb();
Len Brown4f86d3a2007-10-03 18:58:00 -0400809
Len Brown02cf4f92010-05-24 14:27:44 -0400810 if (unlikely(need_resched())) {
811 current_thread_info()->status |= TS_POLLING;
Deepthi Dharware978aa72011-10-28 16:20:09 +0530812 return -EINVAL;
Len Brown02cf4f92010-05-24 14:27:44 -0400813 }
Len Brown4f86d3a2007-10-03 18:58:00 -0400814 }
815
Thomas Gleixnere17bcb42007-12-07 19:16:17 +0100816 /*
817 * Must be done before busmaster disable as we might need to
818 * access HPET !
819 */
Len Brown7e275cc2009-05-15 02:08:44 -0400820 lapic_timer_state_broadcast(pr, cx, 1);
Thomas Gleixnere17bcb42007-12-07 19:16:17 +0100821
Len Brown4f86d3a2007-10-03 18:58:00 -0400822 if (cx->type == ACPI_STATE_C3)
823 ACPI_FLUSH_CPU_CACHE();
824
Venkatesh Pallipadi50629112007-11-19 19:49:00 -0500825 /* Tell the scheduler that we are going deep-idle: */
826 sched_clock_idle_sleep_event();
Len Brown4f86d3a2007-10-03 18:58:00 -0400827 acpi_idle_do_entry(cx);
Len Brown4f86d3a2007-10-03 18:58:00 -0400828
Julius Wernera474a512012-11-27 14:17:58 +0100829 sched_clock_idle_wakeup_event(0);
Deepthi Dharware978aa72011-10-28 16:20:09 +0530830
Len Brown02cf4f92010-05-24 14:27:44 -0400831 if (cx->entry_method != ACPI_CSTATE_FFH)
832 current_thread_info()->status |= TS_POLLING;
Len Brown4f86d3a2007-10-03 18:58:00 -0400833
Len Brown7e275cc2009-05-15 02:08:44 -0400834 lapic_timer_state_broadcast(pr, cx, 0);
Deepthi Dharware978aa72011-10-28 16:20:09 +0530835 return index;
Len Brown4f86d3a2007-10-03 18:58:00 -0400836}
837
838static int c3_cpu_count;
Thomas Gleixnere12f65f2009-07-25 18:14:37 +0200839static DEFINE_RAW_SPINLOCK(c3_lock);
Len Brown4f86d3a2007-10-03 18:58:00 -0400840
841/**
842 * acpi_idle_enter_bm - enters C3 with proper BM handling
843 * @dev: the target CPU
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530844 * @drv: cpuidle driver containing state data
Deepthi Dharware978aa72011-10-28 16:20:09 +0530845 * @index: the index of suggested state
Len Brown4f86d3a2007-10-03 18:58:00 -0400846 *
847 * If BM is detected, the deepest non-C3 idle state is entered instead.
848 */
849static int acpi_idle_enter_bm(struct cpuidle_device *dev,
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530850 struct cpuidle_driver *drv, int index)
Len Brown4f86d3a2007-10-03 18:58:00 -0400851{
852 struct acpi_processor *pr;
Deepthi Dharwar42027352011-10-28 16:20:33 +0530853 struct cpuidle_state_usage *state_usage = &dev->states_usage[index];
854 struct acpi_processor_cx *cx = cpuidle_get_statedata(state_usage);
Venkatesh Pallipadi50629112007-11-19 19:49:00 -0500855
Christoph Lameter4a6f4fe2010-12-06 11:16:24 -0600856 pr = __this_cpu_read(processors);
Len Brown4f86d3a2007-10-03 18:58:00 -0400857
858 if (unlikely(!pr))
Deepthi Dharware978aa72011-10-28 16:20:09 +0530859 return -EINVAL;
Len Brown4f86d3a2007-10-03 18:58:00 -0400860
Len Brown718be4a2010-07-22 16:54:27 -0400861 if (!cx->bm_sts_skip && acpi_idle_bm_check()) {
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530862 if (drv->safe_state_index >= 0) {
863 return drv->states[drv->safe_state_index].enter(dev,
864 drv, drv->safe_state_index);
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500865 } else {
Preeti U Murthy8651f972012-07-09 10:12:56 +0200866 acpi_safe_halt();
Deepthi Dharwar75cc5232012-06-25 23:59:54 +0200867 return -EBUSY;
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500868 }
869 }
870
Pallipadi, Venkateshd306ebc2010-02-10 10:35:31 -0800871 if (cx->entry_method != ACPI_CSTATE_FFH) {
872 current_thread_info()->status &= ~TS_POLLING;
873 /*
874 * TS_POLLING-cleared state must be visible before we test
875 * NEED_RESCHED:
876 */
877 smp_mb();
Len Brown4f86d3a2007-10-03 18:58:00 -0400878
Len Brown02cf4f92010-05-24 14:27:44 -0400879 if (unlikely(need_resched())) {
880 current_thread_info()->status |= TS_POLLING;
Deepthi Dharware978aa72011-10-28 16:20:09 +0530881 return -EINVAL;
Len Brown02cf4f92010-05-24 14:27:44 -0400882 }
Len Brown4f86d3a2007-10-03 18:58:00 -0400883 }
884
Venki Pallipadi996520c2008-03-24 14:24:10 -0700885 acpi_unlazy_tlb(smp_processor_id());
886
Venkatesh Pallipadi50629112007-11-19 19:49:00 -0500887 /* Tell the scheduler that we are going deep-idle: */
888 sched_clock_idle_sleep_event();
Len Brown4f86d3a2007-10-03 18:58:00 -0400889 /*
890 * Must be done before busmaster disable as we might need to
891 * access HPET !
892 */
Len Brown7e275cc2009-05-15 02:08:44 -0400893 lapic_timer_state_broadcast(pr, cx, 1);
Len Brown4f86d3a2007-10-03 18:58:00 -0400894
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500895 /*
896 * disable bus master
897 * bm_check implies we need ARB_DIS
898 * !bm_check implies we need cache flush
899 * bm_control implies whether we can do ARB_DIS
900 *
901 * That leaves a case where bm_check is set and bm_control is
902 * not set. In that case we cannot do much, we enter C3
903 * without doing anything.
904 */
905 if (pr->flags.bm_check && pr->flags.bm_control) {
Thomas Gleixnere12f65f2009-07-25 18:14:37 +0200906 raw_spin_lock(&c3_lock);
Len Brown4f86d3a2007-10-03 18:58:00 -0400907 c3_cpu_count++;
908 /* Disable bus master arbitration when all CPUs are in C3 */
909 if (c3_cpu_count == num_online_cpus())
Bob Moore50ffba12009-02-23 15:02:07 +0800910 acpi_write_bit_register(ACPI_BITREG_ARB_DISABLE, 1);
Thomas Gleixnere12f65f2009-07-25 18:14:37 +0200911 raw_spin_unlock(&c3_lock);
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500912 } else if (!pr->flags.bm_check) {
913 ACPI_FLUSH_CPU_CACHE();
914 }
Len Brown4f86d3a2007-10-03 18:58:00 -0400915
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500916 acpi_idle_do_entry(cx);
Len Brown4f86d3a2007-10-03 18:58:00 -0400917
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500918 /* Re-enable bus master arbitration */
919 if (pr->flags.bm_check && pr->flags.bm_control) {
Thomas Gleixnere12f65f2009-07-25 18:14:37 +0200920 raw_spin_lock(&c3_lock);
Bob Moore50ffba12009-02-23 15:02:07 +0800921 acpi_write_bit_register(ACPI_BITREG_ARB_DISABLE, 0);
Len Brown4f86d3a2007-10-03 18:58:00 -0400922 c3_cpu_count--;
Thomas Gleixnere12f65f2009-07-25 18:14:37 +0200923 raw_spin_unlock(&c3_lock);
Len Brown4f86d3a2007-10-03 18:58:00 -0400924 }
925
Julius Wernera474a512012-11-27 14:17:58 +0100926 sched_clock_idle_wakeup_event(0);
Deepthi Dharware978aa72011-10-28 16:20:09 +0530927
Len Brown02cf4f92010-05-24 14:27:44 -0400928 if (cx->entry_method != ACPI_CSTATE_FFH)
929 current_thread_info()->status |= TS_POLLING;
Len Brown4f86d3a2007-10-03 18:58:00 -0400930
Len Brown7e275cc2009-05-15 02:08:44 -0400931 lapic_timer_state_broadcast(pr, cx, 0);
Deepthi Dharware978aa72011-10-28 16:20:09 +0530932 return index;
Len Brown4f86d3a2007-10-03 18:58:00 -0400933}
934
935struct cpuidle_driver acpi_idle_driver = {
936 .name = "acpi_idle",
937 .owner = THIS_MODULE,
Julius Wernera474a512012-11-27 14:17:58 +0100938 .en_core_tk_irqen = 1,
Len Brown4f86d3a2007-10-03 18:58:00 -0400939};
940
941/**
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530942 * acpi_processor_setup_cpuidle_cx - prepares and configures CPUIDLE
943 * device i.e. per-cpu data
944 *
Len Brown4f86d3a2007-10-03 18:58:00 -0400945 * @pr: the ACPI processor
946 */
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530947static int acpi_processor_setup_cpuidle_cx(struct acpi_processor *pr)
Len Brown4f86d3a2007-10-03 18:58:00 -0400948{
venkatesh.pallipadi@intel.com9a0b8412008-01-31 17:35:06 -0800949 int i, count = CPUIDLE_DRIVER_STATE_START;
Len Brown4f86d3a2007-10-03 18:58:00 -0400950 struct acpi_processor_cx *cx;
Deepthi Dharwar42027352011-10-28 16:20:33 +0530951 struct cpuidle_state_usage *state_usage;
Daniel Lezcano3d339dc2012-09-17 23:01:56 +0200952 struct cpuidle_device *dev = per_cpu(acpi_cpuidle_device, pr->id);
Len Brown4f86d3a2007-10-03 18:58:00 -0400953
954 if (!pr->flags.power_setup_done)
955 return -EINVAL;
956
957 if (pr->flags.power == 0) {
958 return -EINVAL;
959 }
960
Venkatesh Pallipadidcb84f32008-05-19 19:09:27 -0400961 dev->cpu = pr->id;
Venkatesh Pallipadi4fcb2fc2008-02-11 17:46:31 -0800962
Len Brown615dfd92009-04-23 23:21:29 -0400963 if (max_cstate == 0)
964 max_cstate = 1;
965
Len Brown4f86d3a2007-10-03 18:58:00 -0400966 for (i = 1; i < ACPI_PROCESSOR_MAX_POWER && i <= max_cstate; i++) {
967 cx = &pr->power.states[i];
Deepthi Dharwar42027352011-10-28 16:20:33 +0530968 state_usage = &dev->states_usage[count];
Len Brown4f86d3a2007-10-03 18:58:00 -0400969
970 if (!cx->valid)
971 continue;
972
973#ifdef CONFIG_HOTPLUG_CPU
974 if ((cx->type != ACPI_STATE_C1) && (num_online_cpus() > 1) &&
975 !pr->flags.has_cst &&
976 !(acpi_gbl_FADT.flags & ACPI_FADT_C2_MP_SUPPORTED))
977 continue;
978#endif
Len Brown4f86d3a2007-10-03 18:58:00 -0400979
Deepthi Dharwar42027352011-10-28 16:20:33 +0530980 cpuidle_set_statedata(state_usage, cx);
Len Brown4f86d3a2007-10-03 18:58:00 -0400981
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530982 count++;
983 if (count == CPUIDLE_STATE_MAX)
984 break;
985 }
986
987 dev->state_count = count;
988
989 if (!count)
990 return -EINVAL;
991
992 return 0;
993}
994
995/**
996 * acpi_processor_setup_cpuidle states- prepares and configures cpuidle
997 * global state data i.e. idle routines
998 *
999 * @pr: the ACPI processor
1000 */
1001static int acpi_processor_setup_cpuidle_states(struct acpi_processor *pr)
1002{
1003 int i, count = CPUIDLE_DRIVER_STATE_START;
1004 struct acpi_processor_cx *cx;
1005 struct cpuidle_state *state;
1006 struct cpuidle_driver *drv = &acpi_idle_driver;
1007
1008 if (!pr->flags.power_setup_done)
1009 return -EINVAL;
1010
1011 if (pr->flags.power == 0)
1012 return -EINVAL;
1013
1014 drv->safe_state_index = -1;
1015 for (i = 0; i < CPUIDLE_STATE_MAX; i++) {
1016 drv->states[i].name[0] = '\0';
1017 drv->states[i].desc[0] = '\0';
1018 }
1019
1020 if (max_cstate == 0)
1021 max_cstate = 1;
1022
1023 for (i = 1; i < ACPI_PROCESSOR_MAX_POWER && i <= max_cstate; i++) {
1024 cx = &pr->power.states[i];
1025
1026 if (!cx->valid)
1027 continue;
1028
1029#ifdef CONFIG_HOTPLUG_CPU
1030 if ((cx->type != ACPI_STATE_C1) && (num_online_cpus() > 1) &&
1031 !pr->flags.has_cst &&
1032 !(acpi_gbl_FADT.flags & ACPI_FADT_C2_MP_SUPPORTED))
1033 continue;
1034#endif
1035
1036 state = &drv->states[count];
Len Brown4f86d3a2007-10-03 18:58:00 -04001037 snprintf(state->name, CPUIDLE_NAME_LEN, "C%d", i);
Venkatesh Pallipadi4fcb2fc2008-02-11 17:46:31 -08001038 strncpy(state->desc, cx->desc, CPUIDLE_DESC_LEN);
Len Brown4f86d3a2007-10-03 18:58:00 -04001039 state->exit_latency = cx->latency;
Len Brown4963f622007-12-13 23:50:45 -05001040 state->target_residency = cx->latency * latency_factor;
Len Brown4f86d3a2007-10-03 18:58:00 -04001041
1042 state->flags = 0;
1043 switch (cx->type) {
1044 case ACPI_STATE_C1:
Venki Pallipadi8e92b662008-02-29 10:24:32 -08001045 if (cx->entry_method == ACPI_CSTATE_FFH)
1046 state->flags |= CPUIDLE_FLAG_TIME_VALID;
1047
Len Brown4f86d3a2007-10-03 18:58:00 -04001048 state->enter = acpi_idle_enter_c1;
Boris Ostrovsky1a022e32012-03-13 19:55:09 +01001049 state->enter_dead = acpi_idle_play_dead;
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301050 drv->safe_state_index = count;
Len Brown4f86d3a2007-10-03 18:58:00 -04001051 break;
1052
1053 case ACPI_STATE_C2:
Len Brown4f86d3a2007-10-03 18:58:00 -04001054 state->flags |= CPUIDLE_FLAG_TIME_VALID;
1055 state->enter = acpi_idle_enter_simple;
Boris Ostrovsky1a022e32012-03-13 19:55:09 +01001056 state->enter_dead = acpi_idle_play_dead;
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301057 drv->safe_state_index = count;
Len Brown4f86d3a2007-10-03 18:58:00 -04001058 break;
1059
1060 case ACPI_STATE_C3:
Len Brown4f86d3a2007-10-03 18:58:00 -04001061 state->flags |= CPUIDLE_FLAG_TIME_VALID;
Len Brown4f86d3a2007-10-03 18:58:00 -04001062 state->enter = pr->flags.bm_check ?
1063 acpi_idle_enter_bm :
1064 acpi_idle_enter_simple;
1065 break;
1066 }
1067
1068 count++;
venkatesh.pallipadi@intel.com9a0b8412008-01-31 17:35:06 -08001069 if (count == CPUIDLE_STATE_MAX)
1070 break;
Len Brown4f86d3a2007-10-03 18:58:00 -04001071 }
1072
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301073 drv->state_count = count;
Len Brown4f86d3a2007-10-03 18:58:00 -04001074
1075 if (!count)
1076 return -EINVAL;
1077
Len Brown4f86d3a2007-10-03 18:58:00 -04001078 return 0;
1079}
1080
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301081int acpi_processor_hotplug(struct acpi_processor *pr)
Len Brown4f86d3a2007-10-03 18:58:00 -04001082{
Venkatesh Pallipadidcb84f32008-05-19 19:09:27 -04001083 int ret = 0;
Wei Yongjune8b1b592012-10-08 08:40:42 +08001084 struct cpuidle_device *dev;
Len Brown4f86d3a2007-10-03 18:58:00 -04001085
Thomas Renningerd1896042010-11-03 17:06:14 +01001086 if (disabled_by_idle_boot_param())
Venkatesh Pallipadi36a91352008-04-30 13:57:15 -04001087 return 0;
1088
Len Brown4f86d3a2007-10-03 18:58:00 -04001089 if (!pr)
1090 return -EINVAL;
1091
1092 if (nocst) {
1093 return -ENODEV;
1094 }
1095
1096 if (!pr->flags.power_setup_done)
1097 return -ENODEV;
1098
Wei Yongjune8b1b592012-10-08 08:40:42 +08001099 dev = per_cpu(acpi_cpuidle_device, pr->id);
Len Brown4f86d3a2007-10-03 18:58:00 -04001100 cpuidle_pause_and_lock();
Daniel Lezcano3d339dc2012-09-17 23:01:56 +02001101 cpuidle_disable_device(dev);
Len Brown4f86d3a2007-10-03 18:58:00 -04001102 acpi_processor_get_power_info(pr);
Venkatesh Pallipadidcb84f32008-05-19 19:09:27 -04001103 if (pr->flags.power) {
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301104 acpi_processor_setup_cpuidle_cx(pr);
Daniel Lezcano3d339dc2012-09-17 23:01:56 +02001105 ret = cpuidle_enable_device(dev);
Venkatesh Pallipadidcb84f32008-05-19 19:09:27 -04001106 }
Len Brown4f86d3a2007-10-03 18:58:00 -04001107 cpuidle_resume_and_unlock();
1108
1109 return ret;
1110}
1111
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301112int acpi_processor_cst_has_changed(struct acpi_processor *pr)
1113{
1114 int cpu;
1115 struct acpi_processor *_pr;
Daniel Lezcano3d339dc2012-09-17 23:01:56 +02001116 struct cpuidle_device *dev;
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301117
1118 if (disabled_by_idle_boot_param())
1119 return 0;
1120
1121 if (!pr)
1122 return -EINVAL;
1123
1124 if (nocst)
1125 return -ENODEV;
1126
1127 if (!pr->flags.power_setup_done)
1128 return -ENODEV;
1129
1130 /*
1131 * FIXME: Design the ACPI notification to make it once per
1132 * system instead of once per-cpu. This condition is a hack
1133 * to make the code that updates C-States be called once.
1134 */
1135
Paul E. McKenney95056262012-02-28 13:27:44 -08001136 if (pr->id == 0 && cpuidle_get_driver() == &acpi_idle_driver) {
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301137
1138 cpuidle_pause_and_lock();
1139 /* Protect against cpu-hotplug */
1140 get_online_cpus();
1141
1142 /* Disable all cpuidle devices */
1143 for_each_online_cpu(cpu) {
1144 _pr = per_cpu(processors, cpu);
1145 if (!_pr || !_pr->flags.power_setup_done)
1146 continue;
Daniel Lezcano3d339dc2012-09-17 23:01:56 +02001147 dev = per_cpu(acpi_cpuidle_device, cpu);
1148 cpuidle_disable_device(dev);
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301149 }
1150
1151 /* Populate Updated C-state information */
1152 acpi_processor_setup_cpuidle_states(pr);
1153
1154 /* Enable all cpuidle devices */
1155 for_each_online_cpu(cpu) {
1156 _pr = per_cpu(processors, cpu);
1157 if (!_pr || !_pr->flags.power_setup_done)
1158 continue;
1159 acpi_processor_get_power_info(_pr);
1160 if (_pr->flags.power) {
1161 acpi_processor_setup_cpuidle_cx(_pr);
Daniel Lezcano3d339dc2012-09-17 23:01:56 +02001162 dev = per_cpu(acpi_cpuidle_device, cpu);
1163 cpuidle_enable_device(dev);
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301164 }
1165 }
1166 put_online_cpus();
1167 cpuidle_resume_and_unlock();
1168 }
1169
1170 return 0;
1171}
1172
1173static int acpi_processor_registered;
1174
Daniel Lezcano38a991b2012-09-15 22:42:54 +02001175int __cpuinit acpi_processor_power_init(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001176{
Len Brown4be44fc2005-08-05 00:44:28 -04001177 acpi_status status = 0;
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301178 int retval;
Daniel Lezcano3d339dc2012-09-17 23:01:56 +02001179 struct cpuidle_device *dev;
Andreas Mohrb6835052006-04-27 05:25:00 -04001180 static int first_run;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001181
Thomas Renningerd1896042010-11-03 17:06:14 +01001182 if (disabled_by_idle_boot_param())
Venkatesh Pallipadi36a91352008-04-30 13:57:15 -04001183 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001184
1185 if (!first_run) {
1186 dmi_check_system(processor_power_dmi_table);
Alexey Starikovskiyc1c30632007-11-26 20:42:19 +01001187 max_cstate = acpi_processor_cstate_check(max_cstate);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001188 if (max_cstate < ACPI_C_STATES_MAX)
Len Brown4be44fc2005-08-05 00:44:28 -04001189 printk(KERN_NOTICE
1190 "ACPI: processor limited to max C-state %d\n",
1191 max_cstate);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001192 first_run++;
1193 }
1194
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -04001195 if (!pr)
Patrick Mocheld550d982006-06-27 00:41:40 -04001196 return -EINVAL;
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -04001197
Alexey Starikovskiycee324b2007-02-02 19:48:22 +03001198 if (acpi_gbl_FADT.cst_control && !nocst) {
Len Brown4be44fc2005-08-05 00:44:28 -04001199 status =
Alexey Starikovskiycee324b2007-02-02 19:48:22 +03001200 acpi_os_write_port(acpi_gbl_FADT.smi_command, acpi_gbl_FADT.cst_control, 8);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001201 if (ACPI_FAILURE(status)) {
Thomas Renningera6fc6722006-06-26 23:58:43 -04001202 ACPI_EXCEPTION((AE_INFO, status,
1203 "Notifying BIOS of _CST ability failed"));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001204 }
1205 }
1206
Linus Torvalds1da177e2005-04-16 15:20:36 -07001207 acpi_processor_get_power_info(pr);
Len Brown4f86d3a2007-10-03 18:58:00 -04001208 pr->flags.power_setup_done = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001209
1210 /*
1211 * Install the idle handler if processor power management is supported.
1212 * Note that we use previously set idle handler will be used on
1213 * platforms that only support C1.
1214 */
Venkatesh Pallipadi36a91352008-04-30 13:57:15 -04001215 if (pr->flags.power) {
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301216 /* Register acpi_idle_driver if not already registered */
1217 if (!acpi_processor_registered) {
1218 acpi_processor_setup_cpuidle_states(pr);
1219 retval = cpuidle_register_driver(&acpi_idle_driver);
1220 if (retval)
1221 return retval;
1222 printk(KERN_DEBUG "ACPI: %s registered with cpuidle\n",
1223 acpi_idle_driver.name);
1224 }
Daniel Lezcano3d339dc2012-09-17 23:01:56 +02001225
1226 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
1227 if (!dev)
1228 return -ENOMEM;
1229 per_cpu(acpi_cpuidle_device, pr->id) = dev;
1230
1231 acpi_processor_setup_cpuidle_cx(pr);
1232
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301233 /* Register per-cpu cpuidle_device. Cpuidle driver
1234 * must already be registered before registering device
1235 */
Daniel Lezcano3d339dc2012-09-17 23:01:56 +02001236 retval = cpuidle_register_device(dev);
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301237 if (retval) {
1238 if (acpi_processor_registered == 0)
1239 cpuidle_unregister_driver(&acpi_idle_driver);
1240 return retval;
1241 }
1242 acpi_processor_registered++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001243 }
Patrick Mocheld550d982006-06-27 00:41:40 -04001244 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001245}
1246
Daniel Lezcano38a991b2012-09-15 22:42:54 +02001247int acpi_processor_power_exit(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001248{
Daniel Lezcano3d339dc2012-09-17 23:01:56 +02001249 struct cpuidle_device *dev = per_cpu(acpi_cpuidle_device, pr->id);
1250
Thomas Renningerd1896042010-11-03 17:06:14 +01001251 if (disabled_by_idle_boot_param())
Venkatesh Pallipadi36a91352008-04-30 13:57:15 -04001252 return 0;
1253
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301254 if (pr->flags.power) {
Daniel Lezcano3d339dc2012-09-17 23:01:56 +02001255 cpuidle_unregister_device(dev);
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301256 acpi_processor_registered--;
1257 if (acpi_processor_registered == 0)
1258 cpuidle_unregister_driver(&acpi_idle_driver);
1259 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001260
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301261 pr->flags.power_setup_done = 0;
Patrick Mocheld550d982006-06-27 00:41:40 -04001262 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001263}