blob: 9e57b06d1f24aee0fc0700c1f2580b2da8c1c23e [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
Thomas Renningerd1896042010-11-03 17:06:14 +010082static int disabled_by_idle_boot_param(void)
83{
84 return boot_option_idle_override == IDLE_POLL ||
85 boot_option_idle_override == IDLE_FORCE_MWAIT ||
86 boot_option_idle_override == IDLE_HALT;
87}
88
Linus Torvalds1da177e2005-04-16 15:20:36 -070089/*
90 * IBM ThinkPad R40e crashes mysteriously when going into C2 or C3.
91 * For now disable this. Probably a bug somewhere else.
92 *
93 * To skip this limit, boot/load with a large max_cstate limit.
94 */
Jeff Garzik18552562007-10-03 15:15:40 -040095static int set_max_cstate(const struct dmi_system_id *id)
Linus Torvalds1da177e2005-04-16 15:20:36 -070096{
97 if (max_cstate > ACPI_PROCESSOR_MAX_POWER)
98 return 0;
99
Len Brown3d356002005-08-03 00:22:52 -0400100 printk(KERN_NOTICE PREFIX "%s detected - limiting to C%ld max_cstate."
Len Brown4be44fc2005-08-05 00:44:28 -0400101 " Override with \"processor.max_cstate=%d\"\n", id->ident,
102 (long)id->driver_data, ACPI_PROCESSOR_MAX_POWER + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103
Len Brown3d356002005-08-03 00:22:52 -0400104 max_cstate = (long)id->driver_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105
106 return 0;
107}
108
Ashok Raj7ded5682006-02-03 21:51:23 +0100109/* Actually this shouldn't be __cpuinitdata, would be better to fix the
110 callers to only run once -AK */
111static struct dmi_system_id __cpuinitdata processor_power_dmi_table[] = {
Thomas Rosner876c1842006-01-06 01:31:00 -0500112 { set_max_cstate, "Clevo 5600D", {
113 DMI_MATCH(DMI_BIOS_VENDOR,"Phoenix Technologies LTD"),
114 DMI_MATCH(DMI_BIOS_VERSION,"SHE845M0.86C.0013.D.0302131307")},
Len Brown4be44fc2005-08-05 00:44:28 -0400115 (void *)2},
Arjan van de Ven370d5cd2010-01-27 15:25:39 -0800116 { set_max_cstate, "Pavilion zv5000", {
117 DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"),
118 DMI_MATCH(DMI_PRODUCT_NAME,"Pavilion zv5000 (DS502A#ABA)")},
119 (void *)1},
120 { set_max_cstate, "Asus L8400B", {
121 DMI_MATCH(DMI_SYS_VENDOR, "ASUSTeK Computer Inc."),
122 DMI_MATCH(DMI_PRODUCT_NAME,"L8400B series Notebook PC")},
123 (void *)1},
Linus Torvalds1da177e2005-04-16 15:20:36 -0700124 {},
125};
126
Len Brown4f86d3a2007-10-03 18:58:00 -0400127
venkatesh.pallipadi@intel.com2e906652008-01-31 17:35:03 -0800128/*
129 * Callers should disable interrupts before the call and enable
130 * interrupts after return.
131 */
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500132static void acpi_safe_halt(void)
133{
134 current_thread_info()->status &= ~TS_POLLING;
135 /*
136 * TS_POLLING-cleared state must be visible before we
137 * test NEED_RESCHED:
138 */
139 smp_mb();
Venki Pallipadi71e93d12008-03-13 17:18:19 -0700140 if (!need_resched()) {
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500141 safe_halt();
Venki Pallipadi71e93d12008-03-13 17:18:19 -0700142 local_irq_disable();
143 }
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500144 current_thread_info()->status |= TS_POLLING;
145}
146
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800147#ifdef ARCH_APICTIMER_STOPS_ON_C3
148
149/*
150 * Some BIOS implementations switch to C3 in the published C2 state.
Linus Torvalds296d93c2007-03-23 08:03:47 -0700151 * This seems to be a common problem on AMD boxen, but other vendors
152 * are affected too. We pick the most conservative approach: we assume
153 * that the local APIC stops in both C2 and C3.
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800154 */
Len Brown7e275cc2009-05-15 02:08:44 -0400155static void lapic_timer_check_state(int state, struct acpi_processor *pr,
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800156 struct acpi_processor_cx *cx)
157{
158 struct acpi_processor_power *pwr = &pr->power;
Thomas Gleixnere585bef2007-03-23 16:08:01 +0100159 u8 type = local_apic_timer_c2_ok ? ACPI_STATE_C3 : ACPI_STATE_C2;
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800160
Venkatesh Pallipadidb954b52009-04-06 18:51:29 -0700161 if (cpu_has(&cpu_data(pr->id), X86_FEATURE_ARAT))
162 return;
163
Len Brown02c68a02011-04-01 16:59:53 -0400164 if (amd_e400_c1e_detected)
Shaohua Li87ad57ba2009-05-19 16:09:42 +0800165 type = ACPI_STATE_C1;
166
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800167 /*
168 * Check, if one of the previous states already marked the lapic
169 * unstable
170 */
171 if (pwr->timer_broadcast_on_state < state)
172 return;
173
Thomas Gleixnere585bef2007-03-23 16:08:01 +0100174 if (cx->type >= type)
Linus Torvalds296d93c2007-03-23 08:03:47 -0700175 pr->power.timer_broadcast_on_state = state;
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800176}
177
Hidetoshi Seto918aae42009-12-14 17:10:06 +0900178static void __lapic_timer_propagate_broadcast(void *arg)
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800179{
Suresh Siddhaf833bab2009-08-17 14:34:59 -0700180 struct acpi_processor *pr = (struct acpi_processor *) arg;
Thomas Gleixnere9e2cdb2007-02-16 01:28:04 -0800181 unsigned long reason;
182
183 reason = pr->power.timer_broadcast_on_state < INT_MAX ?
184 CLOCK_EVT_NOTIFY_BROADCAST_ON : CLOCK_EVT_NOTIFY_BROADCAST_OFF;
185
186 clockevents_notify(reason, &pr->id);
Thomas Gleixnere9e2cdb2007-02-16 01:28:04 -0800187}
188
Hidetoshi Seto918aae42009-12-14 17:10:06 +0900189static void lapic_timer_propagate_broadcast(struct acpi_processor *pr)
190{
191 smp_call_function_single(pr->id, __lapic_timer_propagate_broadcast,
192 (void *)pr, 1);
193}
194
Thomas Gleixnere9e2cdb2007-02-16 01:28:04 -0800195/* Power(C) State timer broadcast control */
Len Brown7e275cc2009-05-15 02:08:44 -0400196static void lapic_timer_state_broadcast(struct acpi_processor *pr,
Thomas Gleixnere9e2cdb2007-02-16 01:28:04 -0800197 struct acpi_processor_cx *cx,
198 int broadcast)
199{
Thomas Gleixnere9e2cdb2007-02-16 01:28:04 -0800200 int state = cx - pr->power.states;
201
202 if (state >= pr->power.timer_broadcast_on_state) {
203 unsigned long reason;
204
205 reason = broadcast ? CLOCK_EVT_NOTIFY_BROADCAST_ENTER :
206 CLOCK_EVT_NOTIFY_BROADCAST_EXIT;
207 clockevents_notify(reason, &pr->id);
208 }
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800209}
210
211#else
212
Len Brown7e275cc2009-05-15 02:08:44 -0400213static void lapic_timer_check_state(int state, struct acpi_processor *pr,
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800214 struct acpi_processor_cx *cstate) { }
Len Brown7e275cc2009-05-15 02:08:44 -0400215static void lapic_timer_propagate_broadcast(struct acpi_processor *pr) { }
216static void lapic_timer_state_broadcast(struct acpi_processor *pr,
Thomas Gleixnere9e2cdb2007-02-16 01:28:04 -0800217 struct acpi_processor_cx *cx,
218 int broadcast)
219{
220}
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800221
222#endif
223
Thomas Gleixnerb04e7bd2007-09-22 22:29:05 +0000224/*
225 * Suspend / resume control
226 */
Len Brown815ab0f2009-05-07 22:19:45 -0400227static u32 saved_bm_rld;
228
229static void acpi_idle_bm_rld_save(void)
230{
231 acpi_read_bit_register(ACPI_BITREG_BUS_MASTER_RLD, &saved_bm_rld);
232}
233static void acpi_idle_bm_rld_restore(void)
234{
235 u32 resumed_bm_rld;
236
237 acpi_read_bit_register(ACPI_BITREG_BUS_MASTER_RLD, &resumed_bm_rld);
238
239 if (resumed_bm_rld != saved_bm_rld)
240 acpi_write_bit_register(ACPI_BITREG_BUS_MASTER_RLD, saved_bm_rld);
241}
Thomas Gleixnerb04e7bd2007-09-22 22:29:05 +0000242
243int acpi_processor_suspend(struct acpi_device * device, pm_message_t state)
244{
Len Brown815ab0f2009-05-07 22:19:45 -0400245 acpi_idle_bm_rld_save();
Thomas Gleixnerb04e7bd2007-09-22 22:29:05 +0000246 return 0;
247}
248
249int acpi_processor_resume(struct acpi_device * device)
250{
Len Brown815ab0f2009-05-07 22:19:45 -0400251 acpi_idle_bm_rld_restore();
Thomas Gleixnerb04e7bd2007-09-22 22:29:05 +0000252 return 0;
253}
254
John Stultz592913e2010-07-13 17:56:20 -0700255#if defined(CONFIG_X86)
Len Brown520daf72009-05-14 17:27:38 -0400256static void tsc_check_state(int state)
Andi Kleenddb25f92008-01-30 13:32:41 +0100257{
258 switch (boot_cpu_data.x86_vendor) {
259 case X86_VENDOR_AMD:
Venki Pallipadi40fb1712008-11-17 16:11:37 -0800260 case X86_VENDOR_INTEL:
Andi Kleenddb25f92008-01-30 13:32:41 +0100261 /*
262 * AMD Fam10h TSC will tick in all
263 * C/P/S0/S1 states when this bit is set.
264 */
Venki Pallipadi40fb1712008-11-17 16:11:37 -0800265 if (boot_cpu_has(X86_FEATURE_NONSTOP_TSC))
Len Brown520daf72009-05-14 17:27:38 -0400266 return;
Venki Pallipadi40fb1712008-11-17 16:11:37 -0800267
Andi Kleenddb25f92008-01-30 13:32:41 +0100268 /*FALL THROUGH*/
Andi Kleenddb25f92008-01-30 13:32:41 +0100269 default:
Len Brown520daf72009-05-14 17:27:38 -0400270 /* TSC could halt in idle, so notify users */
271 if (state > ACPI_STATE_C1)
272 mark_tsc_unstable("TSC halts in idle");
Andi Kleenddb25f92008-01-30 13:32:41 +0100273 }
274}
Len Brown520daf72009-05-14 17:27:38 -0400275#else
276static void tsc_check_state(int state) { return; }
Andi Kleenddb25f92008-01-30 13:32:41 +0100277#endif
278
Len Brown4be44fc2005-08-05 00:44:28 -0400279static int acpi_processor_get_power_info_fadt(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700280{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700281
282 if (!pr)
Patrick Mocheld550d982006-06-27 00:41:40 -0400283 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700284
285 if (!pr->pblk)
Patrick Mocheld550d982006-06-27 00:41:40 -0400286 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700287
Linus Torvalds1da177e2005-04-16 15:20:36 -0700288 /* if info is obtained from pblk/fadt, type equals state */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700289 pr->power.states[ACPI_STATE_C2].type = ACPI_STATE_C2;
290 pr->power.states[ACPI_STATE_C3].type = ACPI_STATE_C3;
291
Venkatesh Pallipadi4c033552005-09-15 12:20:00 -0400292#ifndef CONFIG_HOTPLUG_CPU
293 /*
294 * Check for P_LVL2_UP flag before entering C2 and above on
Len Brown4f86d3a2007-10-03 18:58:00 -0400295 * an SMP system.
Venkatesh Pallipadi4c033552005-09-15 12:20:00 -0400296 */
Alexey Starikovskiyad71860a2007-02-02 19:48:19 +0300297 if ((num_online_cpus() > 1) &&
Alexey Starikovskiycee324b2007-02-02 19:48:22 +0300298 !(acpi_gbl_FADT.flags & ACPI_FADT_C2_MP_SUPPORTED))
Patrick Mocheld550d982006-06-27 00:41:40 -0400299 return -ENODEV;
Venkatesh Pallipadi4c033552005-09-15 12:20:00 -0400300#endif
301
Linus Torvalds1da177e2005-04-16 15:20:36 -0700302 /* determine C2 and C3 address from pblk */
303 pr->power.states[ACPI_STATE_C2].address = pr->pblk + 4;
304 pr->power.states[ACPI_STATE_C3].address = pr->pblk + 5;
305
306 /* determine latencies from FADT */
Alexey Starikovskiycee324b2007-02-02 19:48:22 +0300307 pr->power.states[ACPI_STATE_C2].latency = acpi_gbl_FADT.C2latency;
308 pr->power.states[ACPI_STATE_C3].latency = acpi_gbl_FADT.C3latency;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700309
Len Brown5d76b6f2010-01-19 22:41:14 -0500310 /*
311 * FADT specified C2 latency must be less than or equal to
312 * 100 microseconds.
313 */
314 if (acpi_gbl_FADT.C2latency > ACPI_PROCESSOR_MAX_C2_LATENCY) {
315 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
316 "C2 latency too large [%d]\n", acpi_gbl_FADT.C2latency));
317 /* invalidate C2 */
318 pr->power.states[ACPI_STATE_C2].address = 0;
319 }
320
Len Browna6d72c12010-01-19 23:10:04 -0500321 /*
322 * FADT supplied C3 latency must be less than or equal to
323 * 1000 microseconds.
324 */
325 if (acpi_gbl_FADT.C3latency > ACPI_PROCESSOR_MAX_C3_LATENCY) {
326 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
327 "C3 latency too large [%d]\n", acpi_gbl_FADT.C3latency));
328 /* invalidate C3 */
329 pr->power.states[ACPI_STATE_C3].address = 0;
330 }
331
Linus Torvalds1da177e2005-04-16 15:20:36 -0700332 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
333 "lvl2[0x%08x] lvl3[0x%08x]\n",
334 pr->power.states[ACPI_STATE_C2].address,
335 pr->power.states[ACPI_STATE_C3].address));
336
Patrick Mocheld550d982006-06-27 00:41:40 -0400337 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700338}
339
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700340static int acpi_processor_get_power_info_default(struct acpi_processor *pr)
Venkatesh Pallipadiacf05f42005-03-31 23:23:15 -0500341{
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700342 if (!pr->power.states[ACPI_STATE_C1].valid) {
343 /* set the first C-State to C1 */
344 /* all processors need to support C1 */
345 pr->power.states[ACPI_STATE_C1].type = ACPI_STATE_C1;
346 pr->power.states[ACPI_STATE_C1].valid = 1;
Venkatesh Pallipadi0fda6b42008-04-09 21:31:46 -0400347 pr->power.states[ACPI_STATE_C1].entry_method = ACPI_CSTATE_HALT;
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700348 }
349 /* the C0 state only exists as a filler in our array */
Venkatesh Pallipadiacf05f42005-03-31 23:23:15 -0500350 pr->power.states[ACPI_STATE_C0].valid = 1;
Patrick Mocheld550d982006-06-27 00:41:40 -0400351 return 0;
Venkatesh Pallipadiacf05f42005-03-31 23:23:15 -0500352}
353
Len Brown4be44fc2005-08-05 00:44:28 -0400354static int acpi_processor_get_power_info_cst(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700355{
Len Brown4be44fc2005-08-05 00:44:28 -0400356 acpi_status status = 0;
Lin Ming439913f2010-01-28 10:53:19 +0800357 u64 count;
Janosch Machowinskicf824782005-08-20 08:02:00 -0400358 int current_count;
Len Brown4be44fc2005-08-05 00:44:28 -0400359 int i;
360 struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
361 union acpi_object *cst;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700362
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363
Linus Torvalds1da177e2005-04-16 15:20:36 -0700364 if (nocst)
Patrick Mocheld550d982006-06-27 00:41:40 -0400365 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700366
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700367 current_count = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700368
369 status = acpi_evaluate_object(pr->handle, "_CST", NULL, &buffer);
370 if (ACPI_FAILURE(status)) {
371 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No _CST, giving up\n"));
Patrick Mocheld550d982006-06-27 00:41:40 -0400372 return -ENODEV;
Len Brown4be44fc2005-08-05 00:44:28 -0400373 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700374
Jan Engelhardt50dd0962006-10-01 00:28:50 +0200375 cst = buffer.pointer;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376
377 /* There must be at least 2 elements */
378 if (!cst || (cst->type != ACPI_TYPE_PACKAGE) || cst->package.count < 2) {
Len Brown64684632006-06-26 23:41:38 -0400379 printk(KERN_ERR PREFIX "not enough elements in _CST\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700380 status = -EFAULT;
381 goto end;
382 }
383
384 count = cst->package.elements[0].integer.value;
385
386 /* Validate number of power states. */
387 if (count < 1 || count != cst->package.count - 1) {
Len Brown64684632006-06-26 23:41:38 -0400388 printk(KERN_ERR PREFIX "count given by _CST is not valid\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700389 status = -EFAULT;
390 goto end;
391 }
392
Linus Torvalds1da177e2005-04-16 15:20:36 -0700393 /* Tell driver that at least _CST is supported. */
394 pr->flags.has_cst = 1;
395
396 for (i = 1; i <= count; i++) {
397 union acpi_object *element;
398 union acpi_object *obj;
399 struct acpi_power_register *reg;
400 struct acpi_processor_cx cx;
401
402 memset(&cx, 0, sizeof(cx));
403
Jan Engelhardt50dd0962006-10-01 00:28:50 +0200404 element = &(cst->package.elements[i]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700405 if (element->type != ACPI_TYPE_PACKAGE)
406 continue;
407
408 if (element->package.count != 4)
409 continue;
410
Jan Engelhardt50dd0962006-10-01 00:28:50 +0200411 obj = &(element->package.elements[0]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700412
413 if (obj->type != ACPI_TYPE_BUFFER)
414 continue;
415
Len Brown4be44fc2005-08-05 00:44:28 -0400416 reg = (struct acpi_power_register *)obj->buffer.pointer;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700417
418 if (reg->space_id != ACPI_ADR_SPACE_SYSTEM_IO &&
Len Brown4be44fc2005-08-05 00:44:28 -0400419 (reg->space_id != ACPI_ADR_SPACE_FIXED_HARDWARE))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700420 continue;
421
Linus Torvalds1da177e2005-04-16 15:20:36 -0700422 /* There should be an easy way to extract an integer... */
Jan Engelhardt50dd0962006-10-01 00:28:50 +0200423 obj = &(element->package.elements[1]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700424 if (obj->type != ACPI_TYPE_INTEGER)
425 continue;
426
427 cx.type = obj->integer.value;
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700428 /*
429 * Some buggy BIOSes won't list C1 in _CST -
430 * Let acpi_processor_get_power_info_default() handle them later
431 */
432 if (i == 1 && cx.type != ACPI_STATE_C1)
433 current_count++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700434
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700435 cx.address = reg->address;
436 cx.index = current_count + 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700437
venkatesh.pallipadi@intel.combc71bec2008-01-31 17:35:04 -0800438 cx.entry_method = ACPI_CSTATE_SYSTEMIO;
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700439 if (reg->space_id == ACPI_ADR_SPACE_FIXED_HARDWARE) {
440 if (acpi_processor_ffh_cstate_probe
441 (pr->id, &cx, reg) == 0) {
venkatesh.pallipadi@intel.combc71bec2008-01-31 17:35:04 -0800442 cx.entry_method = ACPI_CSTATE_FFH;
443 } else if (cx.type == ACPI_STATE_C1) {
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700444 /*
445 * C1 is a special case where FIXED_HARDWARE
446 * can be handled in non-MWAIT way as well.
447 * In that case, save this _CST entry info.
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700448 * Otherwise, ignore this info and continue.
449 */
venkatesh.pallipadi@intel.combc71bec2008-01-31 17:35:04 -0800450 cx.entry_method = ACPI_CSTATE_HALT;
Venkatesh Pallipadi4fcb2fc2008-02-11 17:46:31 -0800451 snprintf(cx.desc, ACPI_CX_DESC_LEN, "ACPI HLT");
venkatesh.pallipadi@intel.combc71bec2008-01-31 17:35:04 -0800452 } else {
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700453 continue;
454 }
Zhao Yakuida5e09a2008-06-24 18:01:09 +0800455 if (cx.type == ACPI_STATE_C1 &&
Thomas Renningerd1896042010-11-03 17:06:14 +0100456 (boot_option_idle_override == IDLE_NOMWAIT)) {
Zhao Yakuic1e3b372008-06-24 17:58:53 +0800457 /*
458 * In most cases the C1 space_id obtained from
459 * _CST object is FIXED_HARDWARE access mode.
460 * But when the option of idle=halt is added,
461 * the entry_method type should be changed from
462 * CSTATE_FFH to CSTATE_HALT.
Zhao Yakuida5e09a2008-06-24 18:01:09 +0800463 * When the option of idle=nomwait is added,
464 * the C1 entry_method type should be
465 * CSTATE_HALT.
Zhao Yakuic1e3b372008-06-24 17:58:53 +0800466 */
467 cx.entry_method = ACPI_CSTATE_HALT;
468 snprintf(cx.desc, ACPI_CX_DESC_LEN, "ACPI HLT");
469 }
Venkatesh Pallipadi4fcb2fc2008-02-11 17:46:31 -0800470 } else {
471 snprintf(cx.desc, ACPI_CX_DESC_LEN, "ACPI IOPORT 0x%x",
472 cx.address);
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700473 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700474
Venkatesh Pallipadi0fda6b42008-04-09 21:31:46 -0400475 if (cx.type == ACPI_STATE_C1) {
476 cx.valid = 1;
477 }
Venkatesh Pallipadi4fcb2fc2008-02-11 17:46:31 -0800478
Jan Engelhardt50dd0962006-10-01 00:28:50 +0200479 obj = &(element->package.elements[2]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700480 if (obj->type != ACPI_TYPE_INTEGER)
481 continue;
482
483 cx.latency = obj->integer.value;
484
Jan Engelhardt50dd0962006-10-01 00:28:50 +0200485 obj = &(element->package.elements[3]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700486 if (obj->type != ACPI_TYPE_INTEGER)
487 continue;
488
489 cx.power = obj->integer.value;
490
Janosch Machowinskicf824782005-08-20 08:02:00 -0400491 current_count++;
492 memcpy(&(pr->power.states[current_count]), &cx, sizeof(cx));
493
494 /*
495 * We support total ACPI_PROCESSOR_MAX_POWER - 1
496 * (From 1 through ACPI_PROCESSOR_MAX_POWER - 1)
497 */
498 if (current_count >= (ACPI_PROCESSOR_MAX_POWER - 1)) {
499 printk(KERN_WARNING
500 "Limiting number of power states to max (%d)\n",
501 ACPI_PROCESSOR_MAX_POWER);
502 printk(KERN_WARNING
503 "Please increase ACPI_PROCESSOR_MAX_POWER if needed.\n");
504 break;
505 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700506 }
507
Len Brown4be44fc2005-08-05 00:44:28 -0400508 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d power states\n",
Janosch Machowinskicf824782005-08-20 08:02:00 -0400509 current_count));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700510
511 /* Validate number of power states discovered */
Janosch Machowinskicf824782005-08-20 08:02:00 -0400512 if (current_count < 2)
Venkatesh Pallipadi6d93c642005-09-15 12:19:00 -0400513 status = -EFAULT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514
Len Brown4be44fc2005-08-05 00:44:28 -0400515 end:
Len Brown02438d82006-06-30 03:19:10 -0400516 kfree(buffer.pointer);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700517
Patrick Mocheld550d982006-06-27 00:41:40 -0400518 return status;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700519}
520
Len Brown4be44fc2005-08-05 00:44:28 -0400521static void acpi_processor_power_verify_c3(struct acpi_processor *pr,
522 struct acpi_processor_cx *cx)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700523{
Pallipadi, Venkateshee1ca482009-05-21 17:09:10 -0700524 static int bm_check_flag = -1;
525 static int bm_control_flag = -1;
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400526
Linus Torvalds1da177e2005-04-16 15:20:36 -0700527
528 if (!cx->address)
Patrick Mocheld550d982006-06-27 00:41:40 -0400529 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700530
531 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -0700532 * PIIX4 Erratum #18: We don't support C3 when Type-F (fast)
533 * DMA transfers are used by any ISA device to avoid livelock.
534 * Note that we could disable Type-F DMA (as recommended by
535 * the erratum), but this is known to disrupt certain ISA
536 * devices thus we take the conservative approach.
537 */
538 else if (errata.piix4.fdma) {
539 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
Len Brown4be44fc2005-08-05 00:44:28 -0400540 "C3 not supported on PIIX4 with Type-F DMA\n"));
Patrick Mocheld550d982006-06-27 00:41:40 -0400541 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542 }
543
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400544 /* All the logic here assumes flags.bm_check is same across all CPUs */
Pallipadi, Venkateshee1ca482009-05-21 17:09:10 -0700545 if (bm_check_flag == -1) {
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400546 /* Determine whether bm_check is needed based on CPU */
547 acpi_processor_power_init_bm_check(&(pr->flags), pr->id);
548 bm_check_flag = pr->flags.bm_check;
Pallipadi, Venkateshee1ca482009-05-21 17:09:10 -0700549 bm_control_flag = pr->flags.bm_control;
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400550 } else {
551 pr->flags.bm_check = bm_check_flag;
Pallipadi, Venkateshee1ca482009-05-21 17:09:10 -0700552 pr->flags.bm_control = bm_control_flag;
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400553 }
554
555 if (pr->flags.bm_check) {
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400556 if (!pr->flags.bm_control) {
Venki Pallipadied3110e2007-07-31 12:04:31 -0700557 if (pr->flags.has_cst != 1) {
558 /* bus mastering control is necessary */
559 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
560 "C3 support requires BM control\n"));
561 return;
562 } else {
563 /* Here we enter C3 without bus mastering */
564 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
565 "C3 support without BM control\n"));
566 }
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400567 }
568 } else {
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400569 /*
570 * WBINVD should be set in fadt, for C3 state to be
571 * supported on when bm_check is not required.
572 */
Alexey Starikovskiycee324b2007-02-02 19:48:22 +0300573 if (!(acpi_gbl_FADT.flags & ACPI_FADT_WBINVD)) {
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400574 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
Len Brown4be44fc2005-08-05 00:44:28 -0400575 "Cache invalidation should work properly"
576 " for C3 to be enabled on SMP systems\n"));
Patrick Mocheld550d982006-06-27 00:41:40 -0400577 return;
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400578 }
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -0400579 }
580
Linus Torvalds1da177e2005-04-16 15:20:36 -0700581 /*
582 * Otherwise we've met all of our C3 requirements.
583 * Normalize the C3 latency to expidite policy. Enable
584 * checking of bus mastering status (bm_check) so we can
585 * use this in our C3 policy
586 */
587 cx->valid = 1;
Len Brown4f86d3a2007-10-03 18:58:00 -0400588
Len Brown4f86d3a2007-10-03 18:58:00 -0400589 cx->latency_ticks = cx->latency;
Len Brown31878dd2009-01-28 18:28:09 -0500590 /*
591 * On older chipsets, BM_RLD needs to be set
592 * in order for Bus Master activity to wake the
593 * system from C3. Newer chipsets handle DMA
594 * during C3 automatically and BM_RLD is a NOP.
595 * In either case, the proper way to
596 * handle BM_RLD is to set it and leave it set.
597 */
Bob Moore50ffba12009-02-23 15:02:07 +0800598 acpi_write_bit_register(ACPI_BITREG_BUS_MASTER_RLD, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700599
Patrick Mocheld550d982006-06-27 00:41:40 -0400600 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700601}
602
Linus Torvalds1da177e2005-04-16 15:20:36 -0700603static int acpi_processor_power_verify(struct acpi_processor *pr)
604{
605 unsigned int i;
606 unsigned int working = 0;
Venkatesh Pallipadi6eb0a0f2006-01-11 22:44:21 +0100607
Thomas Gleixner169a0ab2007-02-16 01:27:55 -0800608 pr->power.timer_broadcast_on_state = INT_MAX;
Venkatesh Pallipadi6eb0a0f2006-01-11 22:44:21 +0100609
Len Browna0bf2842009-05-15 01:29:31 -0400610 for (i = 1; i < ACPI_PROCESSOR_MAX_POWER && i <= max_cstate; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700611 struct acpi_processor_cx *cx = &pr->power.states[i];
612
613 switch (cx->type) {
614 case ACPI_STATE_C1:
615 cx->valid = 1;
616 break;
617
618 case ACPI_STATE_C2:
Len Brownd22edd22010-01-19 23:29:09 -0500619 if (!cx->address)
620 break;
621 cx->valid = 1;
622 cx->latency_ticks = cx->latency; /* Normalize latency */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700623 break;
624
625 case ACPI_STATE_C3:
626 acpi_processor_power_verify_c3(pr, cx);
627 break;
628 }
Len Brown7e275cc2009-05-15 02:08:44 -0400629 if (!cx->valid)
630 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700631
Len Brown7e275cc2009-05-15 02:08:44 -0400632 lapic_timer_check_state(i, pr, cx);
633 tsc_check_state(cx->type);
634 working++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700635 }
636
Hidetoshi Seto918aae42009-12-14 17:10:06 +0900637 lapic_timer_propagate_broadcast(pr);
Andi Kleenbd663342006-03-25 16:31:07 +0100638
Linus Torvalds1da177e2005-04-16 15:20:36 -0700639 return (working);
640}
641
Len Brown4be44fc2005-08-05 00:44:28 -0400642static int acpi_processor_get_power_info(struct acpi_processor *pr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700643{
644 unsigned int i;
645 int result;
646
Linus Torvalds1da177e2005-04-16 15:20:36 -0700647
648 /* NOTE: the idle thread may not be running while calling
649 * this function */
650
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700651 /* Zero initialize all the C-states info. */
652 memset(pr->power.states, 0, sizeof(pr->power.states));
653
Linus Torvalds1da177e2005-04-16 15:20:36 -0700654 result = acpi_processor_get_power_info_cst(pr);
Venkatesh Pallipadi6d93c642005-09-15 12:19:00 -0400655 if (result == -ENODEV)
Darrick J. Wongc5a114f2006-10-19 23:28:28 -0700656 result = acpi_processor_get_power_info_fadt(pr);
Venkatesh Pallipadi6d93c642005-09-15 12:19:00 -0400657
Venkatesh Pallipadi991528d2006-09-25 16:28:13 -0700658 if (result)
659 return result;
660
661 acpi_processor_get_power_info_default(pr);
662
Janosch Machowinskicf824782005-08-20 08:02:00 -0400663 pr->power.count = acpi_processor_power_verify(pr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700664
Linus Torvalds1da177e2005-04-16 15:20:36 -0700665 /*
666 * if one state of type C2 or C3 is available, mark this
667 * CPU as being "idle manageable"
668 */
669 for (i = 1; i < ACPI_PROCESSOR_MAX_POWER; i++) {
Venkatesh Pallipadiacf05f42005-03-31 23:23:15 -0500670 if (pr->power.states[i].valid) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700671 pr->power.count = i;
Linus Torvalds2203d6e2005-11-18 07:29:51 -0800672 if (pr->power.states[i].type >= ACPI_STATE_C2)
673 pr->flags.power = 1;
Venkatesh Pallipadiacf05f42005-03-31 23:23:15 -0500674 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700675 }
676
Patrick Mocheld550d982006-06-27 00:41:40 -0400677 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700678}
679
Len Brown4f86d3a2007-10-03 18:58:00 -0400680/**
681 * acpi_idle_bm_check - checks if bus master activity was detected
682 */
683static int acpi_idle_bm_check(void)
684{
685 u32 bm_status = 0;
686
Len Brownd3e7e992010-07-22 17:23:10 -0400687 if (bm_check_disable)
688 return 0;
689
Bob Moore50ffba12009-02-23 15:02:07 +0800690 acpi_read_bit_register(ACPI_BITREG_BUS_MASTER_STATUS, &bm_status);
Len Brown4f86d3a2007-10-03 18:58:00 -0400691 if (bm_status)
Bob Moore50ffba12009-02-23 15:02:07 +0800692 acpi_write_bit_register(ACPI_BITREG_BUS_MASTER_STATUS, 1);
Len Brown4f86d3a2007-10-03 18:58:00 -0400693 /*
694 * PIIX4 Erratum #18: Note that BM_STS doesn't always reflect
695 * the true state of bus mastering activity; forcing us to
696 * manually check the BMIDEA bit of each IDE channel.
697 */
698 else if (errata.piix4.bmisx) {
699 if ((inb_p(errata.piix4.bmisx + 0x02) & 0x01)
700 || (inb_p(errata.piix4.bmisx + 0x0A) & 0x01))
701 bm_status = 1;
702 }
703 return bm_status;
704}
705
706/**
Len Brown4f86d3a2007-10-03 18:58:00 -0400707 * acpi_idle_do_entry - a helper function that does C2 and C3 type entry
708 * @cx: cstate data
venkatesh.pallipadi@intel.combc71bec2008-01-31 17:35:04 -0800709 *
710 * Caller disables interrupt before call and enables interrupt after return.
Len Brown4f86d3a2007-10-03 18:58:00 -0400711 */
712static inline void acpi_idle_do_entry(struct acpi_processor_cx *cx)
713{
Steven Rostedtdcf30992008-07-25 18:00:42 -0400714 /* Don't trace irqs off for idle */
715 stop_critical_timings();
venkatesh.pallipadi@intel.combc71bec2008-01-31 17:35:04 -0800716 if (cx->entry_method == ACPI_CSTATE_FFH) {
Len Brown4f86d3a2007-10-03 18:58:00 -0400717 /* Call into architectural FFH based C-state */
718 acpi_processor_ffh_cstate_enter(cx);
venkatesh.pallipadi@intel.combc71bec2008-01-31 17:35:04 -0800719 } else if (cx->entry_method == ACPI_CSTATE_HALT) {
720 acpi_safe_halt();
Len Brown4f86d3a2007-10-03 18:58:00 -0400721 } else {
Len Brown4f86d3a2007-10-03 18:58:00 -0400722 /* IO port based C-state */
723 inb(cx->address);
724 /* Dummy wait op - must do something useless after P_LVL2 read
725 because chipsets cannot guarantee that STPCLK# signal
726 gets asserted in time to freeze execution properly. */
Andi Kleencfa806f2010-07-20 15:18:36 -0700727 inl(acpi_gbl_FADT.xpm_timer_block.address);
Len Brown4f86d3a2007-10-03 18:58:00 -0400728 }
Steven Rostedtdcf30992008-07-25 18:00:42 -0400729 start_critical_timings();
Len Brown4f86d3a2007-10-03 18:58:00 -0400730}
731
732/**
733 * acpi_idle_enter_c1 - enters an ACPI C1 state-type
734 * @dev: the target CPU
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530735 * @drv: cpuidle driver containing cpuidle state info
Deepthi Dharware978aa72011-10-28 16:20:09 +0530736 * @index: index of target state
Len Brown4f86d3a2007-10-03 18:58:00 -0400737 *
738 * This is equivalent to the HALT instruction.
739 */
740static int acpi_idle_enter_c1(struct cpuidle_device *dev,
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530741 struct cpuidle_driver *drv, int index)
Len Brown4f86d3a2007-10-03 18:58:00 -0400742{
alex.shiff69f2b2009-03-04 11:55:26 -0800743 ktime_t kt1, kt2;
744 s64 idle_time;
Len Brown4f86d3a2007-10-03 18:58:00 -0400745 struct acpi_processor *pr;
Deepthi Dharwar42027352011-10-28 16:20:33 +0530746 struct cpuidle_state_usage *state_usage = &dev->states_usage[index];
747 struct acpi_processor_cx *cx = cpuidle_get_statedata(state_usage);
venkatesh.pallipadi@intel.com9b12e182008-01-31 17:35:05 -0800748
Christoph Lameter4a6f4fe2010-12-06 11:16:24 -0600749 pr = __this_cpu_read(processors);
Deepthi Dharware978aa72011-10-28 16:20:09 +0530750 dev->last_residency = 0;
Len Brown4f86d3a2007-10-03 18:58:00 -0400751
752 if (unlikely(!pr))
Deepthi Dharware978aa72011-10-28 16:20:09 +0530753 return -EINVAL;
Len Brown4f86d3a2007-10-03 18:58:00 -0400754
venkatesh.pallipadi@intel.com2e906652008-01-31 17:35:03 -0800755 local_irq_disable();
Venkatesh Pallipadib077fba2008-02-11 15:20:27 -0800756
Len Brown7e275cc2009-05-15 02:08:44 -0400757 lapic_timer_state_broadcast(pr, cx, 1);
alex.shiff69f2b2009-03-04 11:55:26 -0800758 kt1 = ktime_get_real();
venkatesh.pallipadi@intel.combc71bec2008-01-31 17:35:04 -0800759 acpi_idle_do_entry(cx);
alex.shiff69f2b2009-03-04 11:55:26 -0800760 kt2 = ktime_get_real();
761 idle_time = ktime_to_us(ktime_sub(kt2, kt1));
Len Brown4f86d3a2007-10-03 18:58:00 -0400762
Deepthi Dharware978aa72011-10-28 16:20:09 +0530763 /* Update device last_residency*/
764 dev->last_residency = (int)idle_time;
765
venkatesh.pallipadi@intel.com2e906652008-01-31 17:35:03 -0800766 local_irq_enable();
Len Brown4f86d3a2007-10-03 18:58:00 -0400767 cx->usage++;
Len Brown7e275cc2009-05-15 02:08:44 -0400768 lapic_timer_state_broadcast(pr, cx, 0);
Len Brown4f86d3a2007-10-03 18:58:00 -0400769
Deepthi Dharware978aa72011-10-28 16:20:09 +0530770 return index;
Len Brown4f86d3a2007-10-03 18:58:00 -0400771}
772
773/**
774 * acpi_idle_enter_simple - enters an ACPI state without BM handling
775 * @dev: the target CPU
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530776 * @drv: cpuidle driver with cpuidle state information
Deepthi Dharware978aa72011-10-28 16:20:09 +0530777 * @index: the index of suggested state
Len Brown4f86d3a2007-10-03 18:58:00 -0400778 */
779static int acpi_idle_enter_simple(struct cpuidle_device *dev,
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530780 struct cpuidle_driver *drv, int index)
Len Brown4f86d3a2007-10-03 18:58:00 -0400781{
782 struct acpi_processor *pr;
Deepthi Dharwar42027352011-10-28 16:20:33 +0530783 struct cpuidle_state_usage *state_usage = &dev->states_usage[index];
784 struct acpi_processor_cx *cx = cpuidle_get_statedata(state_usage);
alex.shiff69f2b2009-03-04 11:55:26 -0800785 ktime_t kt1, kt2;
Venkatesh Pallipadi2da513f2010-04-22 16:48:33 -0700786 s64 idle_time_ns;
alex.shiff69f2b2009-03-04 11:55:26 -0800787 s64 idle_time;
Venkatesh Pallipadi50629112007-11-19 19:49:00 -0500788
Christoph Lameter4a6f4fe2010-12-06 11:16:24 -0600789 pr = __this_cpu_read(processors);
Deepthi Dharware978aa72011-10-28 16:20:09 +0530790 dev->last_residency = 0;
Len Brown4f86d3a2007-10-03 18:58:00 -0400791
792 if (unlikely(!pr))
Deepthi Dharware978aa72011-10-28 16:20:09 +0530793 return -EINVAL;
Len Browne1964412007-10-04 01:23:47 -0400794
Len Brown4f86d3a2007-10-03 18:58:00 -0400795 local_irq_disable();
Len Brown02cf4f92010-05-24 14:27:44 -0400796
Pallipadi, Venkateshd306ebc2010-02-10 10:35:31 -0800797 if (cx->entry_method != ACPI_CSTATE_FFH) {
798 current_thread_info()->status &= ~TS_POLLING;
799 /*
800 * TS_POLLING-cleared state must be visible before we test
801 * NEED_RESCHED:
802 */
803 smp_mb();
Len Brown4f86d3a2007-10-03 18:58:00 -0400804
Len Brown02cf4f92010-05-24 14:27:44 -0400805 if (unlikely(need_resched())) {
806 current_thread_info()->status |= TS_POLLING;
807 local_irq_enable();
Deepthi Dharware978aa72011-10-28 16:20:09 +0530808 return -EINVAL;
Len Brown02cf4f92010-05-24 14:27:44 -0400809 }
Len Brown4f86d3a2007-10-03 18:58:00 -0400810 }
811
Thomas Gleixnere17bcb42007-12-07 19:16:17 +0100812 /*
813 * Must be done before busmaster disable as we might need to
814 * access HPET !
815 */
Len Brown7e275cc2009-05-15 02:08:44 -0400816 lapic_timer_state_broadcast(pr, cx, 1);
Thomas Gleixnere17bcb42007-12-07 19:16:17 +0100817
Len Brown4f86d3a2007-10-03 18:58:00 -0400818 if (cx->type == ACPI_STATE_C3)
819 ACPI_FLUSH_CPU_CACHE();
820
alex.shiff69f2b2009-03-04 11:55:26 -0800821 kt1 = ktime_get_real();
Venkatesh Pallipadi50629112007-11-19 19:49:00 -0500822 /* Tell the scheduler that we are going deep-idle: */
823 sched_clock_idle_sleep_event();
Len Brown4f86d3a2007-10-03 18:58:00 -0400824 acpi_idle_do_entry(cx);
alex.shiff69f2b2009-03-04 11:55:26 -0800825 kt2 = ktime_get_real();
Venkatesh Pallipadi2da513f2010-04-22 16:48:33 -0700826 idle_time_ns = ktime_to_ns(ktime_sub(kt2, kt1));
827 idle_time = idle_time_ns;
828 do_div(idle_time, NSEC_PER_USEC);
Len Brown4f86d3a2007-10-03 18:58:00 -0400829
Deepthi Dharware978aa72011-10-28 16:20:09 +0530830 /* Update device last_residency*/
831 dev->last_residency = (int)idle_time;
832
Venkatesh Pallipadi50629112007-11-19 19:49:00 -0500833 /* Tell the scheduler how much we idled: */
Venkatesh Pallipadi2da513f2010-04-22 16:48:33 -0700834 sched_clock_idle_wakeup_event(idle_time_ns);
Len Brown4f86d3a2007-10-03 18:58:00 -0400835
836 local_irq_enable();
Len Brown02cf4f92010-05-24 14:27:44 -0400837 if (cx->entry_method != ACPI_CSTATE_FFH)
838 current_thread_info()->status |= TS_POLLING;
Len Brown4f86d3a2007-10-03 18:58:00 -0400839
840 cx->usage++;
841
Len Brown7e275cc2009-05-15 02:08:44 -0400842 lapic_timer_state_broadcast(pr, cx, 0);
Venkatesh Pallipadibceefad2010-06-02 10:01:09 -0700843 cx->time += idle_time;
Deepthi Dharware978aa72011-10-28 16:20:09 +0530844 return index;
Len Brown4f86d3a2007-10-03 18:58:00 -0400845}
846
847static int c3_cpu_count;
Thomas Gleixnere12f65f2009-07-25 18:14:37 +0200848static DEFINE_RAW_SPINLOCK(c3_lock);
Len Brown4f86d3a2007-10-03 18:58:00 -0400849
850/**
851 * acpi_idle_enter_bm - enters C3 with proper BM handling
852 * @dev: the target CPU
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530853 * @drv: cpuidle driver containing state data
Deepthi Dharware978aa72011-10-28 16:20:09 +0530854 * @index: the index of suggested state
Len Brown4f86d3a2007-10-03 18:58:00 -0400855 *
856 * If BM is detected, the deepest non-C3 idle state is entered instead.
857 */
858static int acpi_idle_enter_bm(struct cpuidle_device *dev,
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530859 struct cpuidle_driver *drv, int index)
Len Brown4f86d3a2007-10-03 18:58:00 -0400860{
861 struct acpi_processor *pr;
Deepthi Dharwar42027352011-10-28 16:20:33 +0530862 struct cpuidle_state_usage *state_usage = &dev->states_usage[index];
863 struct acpi_processor_cx *cx = cpuidle_get_statedata(state_usage);
alex.shiff69f2b2009-03-04 11:55:26 -0800864 ktime_t kt1, kt2;
Venkatesh Pallipadi2da513f2010-04-22 16:48:33 -0700865 s64 idle_time_ns;
alex.shiff69f2b2009-03-04 11:55:26 -0800866 s64 idle_time;
alex.shiff69f2b2009-03-04 11:55:26 -0800867
Venkatesh Pallipadi50629112007-11-19 19:49:00 -0500868
Christoph Lameter4a6f4fe2010-12-06 11:16:24 -0600869 pr = __this_cpu_read(processors);
Deepthi Dharware978aa72011-10-28 16:20:09 +0530870 dev->last_residency = 0;
Len Brown4f86d3a2007-10-03 18:58:00 -0400871
872 if (unlikely(!pr))
Deepthi Dharware978aa72011-10-28 16:20:09 +0530873 return -EINVAL;
Len Brown4f86d3a2007-10-03 18:58:00 -0400874
Len Brown718be4a2010-07-22 16:54:27 -0400875 if (!cx->bm_sts_skip && acpi_idle_bm_check()) {
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530876 if (drv->safe_state_index >= 0) {
877 return drv->states[drv->safe_state_index].enter(dev,
878 drv, drv->safe_state_index);
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500879 } else {
venkatesh.pallipadi@intel.com2e906652008-01-31 17:35:03 -0800880 local_irq_disable();
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500881 acpi_safe_halt();
venkatesh.pallipadi@intel.com2e906652008-01-31 17:35:03 -0800882 local_irq_enable();
Deepthi Dharware978aa72011-10-28 16:20:09 +0530883 return -EINVAL;
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500884 }
885 }
886
Len Brown4f86d3a2007-10-03 18:58:00 -0400887 local_irq_disable();
Len Brown02cf4f92010-05-24 14:27:44 -0400888
Pallipadi, Venkateshd306ebc2010-02-10 10:35:31 -0800889 if (cx->entry_method != ACPI_CSTATE_FFH) {
890 current_thread_info()->status &= ~TS_POLLING;
891 /*
892 * TS_POLLING-cleared state must be visible before we test
893 * NEED_RESCHED:
894 */
895 smp_mb();
Len Brown4f86d3a2007-10-03 18:58:00 -0400896
Len Brown02cf4f92010-05-24 14:27:44 -0400897 if (unlikely(need_resched())) {
898 current_thread_info()->status |= TS_POLLING;
899 local_irq_enable();
Deepthi Dharware978aa72011-10-28 16:20:09 +0530900 return -EINVAL;
Len Brown02cf4f92010-05-24 14:27:44 -0400901 }
Len Brown4f86d3a2007-10-03 18:58:00 -0400902 }
903
Venki Pallipadi996520c2008-03-24 14:24:10 -0700904 acpi_unlazy_tlb(smp_processor_id());
905
Venkatesh Pallipadi50629112007-11-19 19:49:00 -0500906 /* Tell the scheduler that we are going deep-idle: */
907 sched_clock_idle_sleep_event();
Len Brown4f86d3a2007-10-03 18:58:00 -0400908 /*
909 * Must be done before busmaster disable as we might need to
910 * access HPET !
911 */
Len Brown7e275cc2009-05-15 02:08:44 -0400912 lapic_timer_state_broadcast(pr, cx, 1);
Len Brown4f86d3a2007-10-03 18:58:00 -0400913
Len Brownf461dde2009-04-23 18:59:43 -0400914 kt1 = ktime_get_real();
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500915 /*
916 * disable bus master
917 * bm_check implies we need ARB_DIS
918 * !bm_check implies we need cache flush
919 * bm_control implies whether we can do ARB_DIS
920 *
921 * That leaves a case where bm_check is set and bm_control is
922 * not set. In that case we cannot do much, we enter C3
923 * without doing anything.
924 */
925 if (pr->flags.bm_check && pr->flags.bm_control) {
Thomas Gleixnere12f65f2009-07-25 18:14:37 +0200926 raw_spin_lock(&c3_lock);
Len Brown4f86d3a2007-10-03 18:58:00 -0400927 c3_cpu_count++;
928 /* Disable bus master arbitration when all CPUs are in C3 */
929 if (c3_cpu_count == num_online_cpus())
Bob Moore50ffba12009-02-23 15:02:07 +0800930 acpi_write_bit_register(ACPI_BITREG_ARB_DISABLE, 1);
Thomas Gleixnere12f65f2009-07-25 18:14:37 +0200931 raw_spin_unlock(&c3_lock);
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500932 } else if (!pr->flags.bm_check) {
933 ACPI_FLUSH_CPU_CACHE();
934 }
Len Brown4f86d3a2007-10-03 18:58:00 -0400935
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500936 acpi_idle_do_entry(cx);
Len Brown4f86d3a2007-10-03 18:58:00 -0400937
Venkatesh Pallipadiddc081a2007-11-19 21:43:22 -0500938 /* Re-enable bus master arbitration */
939 if (pr->flags.bm_check && pr->flags.bm_control) {
Thomas Gleixnere12f65f2009-07-25 18:14:37 +0200940 raw_spin_lock(&c3_lock);
Bob Moore50ffba12009-02-23 15:02:07 +0800941 acpi_write_bit_register(ACPI_BITREG_ARB_DISABLE, 0);
Len Brown4f86d3a2007-10-03 18:58:00 -0400942 c3_cpu_count--;
Thomas Gleixnere12f65f2009-07-25 18:14:37 +0200943 raw_spin_unlock(&c3_lock);
Len Brown4f86d3a2007-10-03 18:58:00 -0400944 }
Len Brownf461dde2009-04-23 18:59:43 -0400945 kt2 = ktime_get_real();
Zhao Yakui157317b2010-06-02 11:04:09 +0800946 idle_time_ns = ktime_to_ns(ktime_sub(kt2, kt1));
Venkatesh Pallipadi2da513f2010-04-22 16:48:33 -0700947 idle_time = idle_time_ns;
948 do_div(idle_time, NSEC_PER_USEC);
Len Brown4f86d3a2007-10-03 18:58:00 -0400949
Deepthi Dharware978aa72011-10-28 16:20:09 +0530950 /* Update device last_residency*/
951 dev->last_residency = (int)idle_time;
952
Venkatesh Pallipadi50629112007-11-19 19:49:00 -0500953 /* Tell the scheduler how much we idled: */
Venkatesh Pallipadi2da513f2010-04-22 16:48:33 -0700954 sched_clock_idle_wakeup_event(idle_time_ns);
Len Brown4f86d3a2007-10-03 18:58:00 -0400955
956 local_irq_enable();
Len Brown02cf4f92010-05-24 14:27:44 -0400957 if (cx->entry_method != ACPI_CSTATE_FFH)
958 current_thread_info()->status |= TS_POLLING;
Len Brown4f86d3a2007-10-03 18:58:00 -0400959
960 cx->usage++;
961
Len Brown7e275cc2009-05-15 02:08:44 -0400962 lapic_timer_state_broadcast(pr, cx, 0);
Venkatesh Pallipadibceefad2010-06-02 10:01:09 -0700963 cx->time += idle_time;
Deepthi Dharware978aa72011-10-28 16:20:09 +0530964 return index;
Len Brown4f86d3a2007-10-03 18:58:00 -0400965}
966
967struct cpuidle_driver acpi_idle_driver = {
968 .name = "acpi_idle",
969 .owner = THIS_MODULE,
970};
971
972/**
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530973 * acpi_processor_setup_cpuidle_cx - prepares and configures CPUIDLE
974 * device i.e. per-cpu data
975 *
Len Brown4f86d3a2007-10-03 18:58:00 -0400976 * @pr: the ACPI processor
977 */
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +0530978static int acpi_processor_setup_cpuidle_cx(struct acpi_processor *pr)
Len Brown4f86d3a2007-10-03 18:58:00 -0400979{
venkatesh.pallipadi@intel.com9a0b8412008-01-31 17:35:06 -0800980 int i, count = CPUIDLE_DRIVER_STATE_START;
Len Brown4f86d3a2007-10-03 18:58:00 -0400981 struct acpi_processor_cx *cx;
Deepthi Dharwar42027352011-10-28 16:20:33 +0530982 struct cpuidle_state_usage *state_usage;
Len Brown4f86d3a2007-10-03 18:58:00 -0400983 struct cpuidle_device *dev = &pr->power.dev;
984
985 if (!pr->flags.power_setup_done)
986 return -EINVAL;
987
988 if (pr->flags.power == 0) {
989 return -EINVAL;
990 }
991
Venkatesh Pallipadidcb84f32008-05-19 19:09:27 -0400992 dev->cpu = pr->id;
Venkatesh Pallipadi4fcb2fc2008-02-11 17:46:31 -0800993
Len Brown615dfd92009-04-23 23:21:29 -0400994 if (max_cstate == 0)
995 max_cstate = 1;
996
Len Brown4f86d3a2007-10-03 18:58:00 -0400997 for (i = 1; i < ACPI_PROCESSOR_MAX_POWER && i <= max_cstate; i++) {
998 cx = &pr->power.states[i];
Deepthi Dharwar42027352011-10-28 16:20:33 +0530999 state_usage = &dev->states_usage[count];
Len Brown4f86d3a2007-10-03 18:58:00 -04001000
1001 if (!cx->valid)
1002 continue;
1003
1004#ifdef CONFIG_HOTPLUG_CPU
1005 if ((cx->type != ACPI_STATE_C1) && (num_online_cpus() > 1) &&
1006 !pr->flags.has_cst &&
1007 !(acpi_gbl_FADT.flags & ACPI_FADT_C2_MP_SUPPORTED))
1008 continue;
1009#endif
Len Brown4f86d3a2007-10-03 18:58:00 -04001010
Deepthi Dharwar42027352011-10-28 16:20:33 +05301011 cpuidle_set_statedata(state_usage, cx);
Len Brown4f86d3a2007-10-03 18:58:00 -04001012
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301013 count++;
1014 if (count == CPUIDLE_STATE_MAX)
1015 break;
1016 }
1017
1018 dev->state_count = count;
1019
1020 if (!count)
1021 return -EINVAL;
1022
1023 return 0;
1024}
1025
1026/**
1027 * acpi_processor_setup_cpuidle states- prepares and configures cpuidle
1028 * global state data i.e. idle routines
1029 *
1030 * @pr: the ACPI processor
1031 */
1032static int acpi_processor_setup_cpuidle_states(struct acpi_processor *pr)
1033{
1034 int i, count = CPUIDLE_DRIVER_STATE_START;
1035 struct acpi_processor_cx *cx;
1036 struct cpuidle_state *state;
1037 struct cpuidle_driver *drv = &acpi_idle_driver;
1038
1039 if (!pr->flags.power_setup_done)
1040 return -EINVAL;
1041
1042 if (pr->flags.power == 0)
1043 return -EINVAL;
1044
1045 drv->safe_state_index = -1;
1046 for (i = 0; i < CPUIDLE_STATE_MAX; i++) {
1047 drv->states[i].name[0] = '\0';
1048 drv->states[i].desc[0] = '\0';
1049 }
1050
1051 if (max_cstate == 0)
1052 max_cstate = 1;
1053
1054 for (i = 1; i < ACPI_PROCESSOR_MAX_POWER && i <= max_cstate; i++) {
1055 cx = &pr->power.states[i];
1056
1057 if (!cx->valid)
1058 continue;
1059
1060#ifdef CONFIG_HOTPLUG_CPU
1061 if ((cx->type != ACPI_STATE_C1) && (num_online_cpus() > 1) &&
1062 !pr->flags.has_cst &&
1063 !(acpi_gbl_FADT.flags & ACPI_FADT_C2_MP_SUPPORTED))
1064 continue;
1065#endif
1066
1067 state = &drv->states[count];
Len Brown4f86d3a2007-10-03 18:58:00 -04001068 snprintf(state->name, CPUIDLE_NAME_LEN, "C%d", i);
Venkatesh Pallipadi4fcb2fc2008-02-11 17:46:31 -08001069 strncpy(state->desc, cx->desc, CPUIDLE_DESC_LEN);
Len Brown4f86d3a2007-10-03 18:58:00 -04001070 state->exit_latency = cx->latency;
Len Brown4963f622007-12-13 23:50:45 -05001071 state->target_residency = cx->latency * latency_factor;
Len Brown4f86d3a2007-10-03 18:58:00 -04001072
1073 state->flags = 0;
1074 switch (cx->type) {
1075 case ACPI_STATE_C1:
Venki Pallipadi8e92b662008-02-29 10:24:32 -08001076 if (cx->entry_method == ACPI_CSTATE_FFH)
1077 state->flags |= CPUIDLE_FLAG_TIME_VALID;
1078
Len Brown4f86d3a2007-10-03 18:58:00 -04001079 state->enter = acpi_idle_enter_c1;
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301080 drv->safe_state_index = count;
Len Brown4f86d3a2007-10-03 18:58:00 -04001081 break;
1082
1083 case ACPI_STATE_C2:
Len Brown4f86d3a2007-10-03 18:58:00 -04001084 state->flags |= CPUIDLE_FLAG_TIME_VALID;
1085 state->enter = acpi_idle_enter_simple;
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301086 drv->safe_state_index = count;
Len Brown4f86d3a2007-10-03 18:58:00 -04001087 break;
1088
1089 case ACPI_STATE_C3:
Len Brown4f86d3a2007-10-03 18:58:00 -04001090 state->flags |= CPUIDLE_FLAG_TIME_VALID;
Len Brown4f86d3a2007-10-03 18:58:00 -04001091 state->enter = pr->flags.bm_check ?
1092 acpi_idle_enter_bm :
1093 acpi_idle_enter_simple;
1094 break;
1095 }
1096
1097 count++;
venkatesh.pallipadi@intel.com9a0b8412008-01-31 17:35:06 -08001098 if (count == CPUIDLE_STATE_MAX)
1099 break;
Len Brown4f86d3a2007-10-03 18:58:00 -04001100 }
1101
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301102 drv->state_count = count;
Len Brown4f86d3a2007-10-03 18:58:00 -04001103
1104 if (!count)
1105 return -EINVAL;
1106
Len Brown4f86d3a2007-10-03 18:58:00 -04001107 return 0;
1108}
1109
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301110int acpi_processor_hotplug(struct acpi_processor *pr)
Len Brown4f86d3a2007-10-03 18:58:00 -04001111{
Venkatesh Pallipadidcb84f32008-05-19 19:09:27 -04001112 int ret = 0;
Len Brown4f86d3a2007-10-03 18:58:00 -04001113
Thomas Renningerd1896042010-11-03 17:06:14 +01001114 if (disabled_by_idle_boot_param())
Venkatesh Pallipadi36a91352008-04-30 13:57:15 -04001115 return 0;
1116
Len Brown4f86d3a2007-10-03 18:58:00 -04001117 if (!pr)
1118 return -EINVAL;
1119
1120 if (nocst) {
1121 return -ENODEV;
1122 }
1123
1124 if (!pr->flags.power_setup_done)
1125 return -ENODEV;
1126
1127 cpuidle_pause_and_lock();
1128 cpuidle_disable_device(&pr->power.dev);
1129 acpi_processor_get_power_info(pr);
Venkatesh Pallipadidcb84f32008-05-19 19:09:27 -04001130 if (pr->flags.power) {
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301131 acpi_processor_setup_cpuidle_cx(pr);
Venkatesh Pallipadidcb84f32008-05-19 19:09:27 -04001132 ret = cpuidle_enable_device(&pr->power.dev);
1133 }
Len Brown4f86d3a2007-10-03 18:58:00 -04001134 cpuidle_resume_and_unlock();
1135
1136 return ret;
1137}
1138
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301139int acpi_processor_cst_has_changed(struct acpi_processor *pr)
1140{
1141 int cpu;
1142 struct acpi_processor *_pr;
1143
1144 if (disabled_by_idle_boot_param())
1145 return 0;
1146
1147 if (!pr)
1148 return -EINVAL;
1149
1150 if (nocst)
1151 return -ENODEV;
1152
1153 if (!pr->flags.power_setup_done)
1154 return -ENODEV;
1155
1156 /*
1157 * FIXME: Design the ACPI notification to make it once per
1158 * system instead of once per-cpu. This condition is a hack
1159 * to make the code that updates C-States be called once.
1160 */
1161
Paul E. McKenney95056262012-02-28 13:27:44 -08001162 if (pr->id == 0 && cpuidle_get_driver() == &acpi_idle_driver) {
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301163
1164 cpuidle_pause_and_lock();
1165 /* Protect against cpu-hotplug */
1166 get_online_cpus();
1167
1168 /* Disable all cpuidle devices */
1169 for_each_online_cpu(cpu) {
1170 _pr = per_cpu(processors, cpu);
1171 if (!_pr || !_pr->flags.power_setup_done)
1172 continue;
1173 cpuidle_disable_device(&_pr->power.dev);
1174 }
1175
1176 /* Populate Updated C-state information */
1177 acpi_processor_setup_cpuidle_states(pr);
1178
1179 /* Enable all cpuidle devices */
1180 for_each_online_cpu(cpu) {
1181 _pr = per_cpu(processors, cpu);
1182 if (!_pr || !_pr->flags.power_setup_done)
1183 continue;
1184 acpi_processor_get_power_info(_pr);
1185 if (_pr->flags.power) {
1186 acpi_processor_setup_cpuidle_cx(_pr);
1187 cpuidle_enable_device(&_pr->power.dev);
1188 }
1189 }
1190 put_online_cpus();
1191 cpuidle_resume_and_unlock();
1192 }
1193
1194 return 0;
1195}
1196
1197static int acpi_processor_registered;
1198
Pierre Ossman7af8b662006-10-10 14:20:31 -07001199int __cpuinit acpi_processor_power_init(struct acpi_processor *pr,
Len Brown4be44fc2005-08-05 00:44:28 -04001200 struct acpi_device *device)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001201{
Len Brown4be44fc2005-08-05 00:44:28 -04001202 acpi_status status = 0;
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301203 int retval;
Andreas Mohrb6835052006-04-27 05:25:00 -04001204 static int first_run;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001205
Thomas Renningerd1896042010-11-03 17:06:14 +01001206 if (disabled_by_idle_boot_param())
Venkatesh Pallipadi36a91352008-04-30 13:57:15 -04001207 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001208
1209 if (!first_run) {
1210 dmi_check_system(processor_power_dmi_table);
Alexey Starikovskiyc1c30632007-11-26 20:42:19 +01001211 max_cstate = acpi_processor_cstate_check(max_cstate);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001212 if (max_cstate < ACPI_C_STATES_MAX)
Len Brown4be44fc2005-08-05 00:44:28 -04001213 printk(KERN_NOTICE
1214 "ACPI: processor limited to max C-state %d\n",
1215 max_cstate);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001216 first_run++;
1217 }
1218
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -04001219 if (!pr)
Patrick Mocheld550d982006-06-27 00:41:40 -04001220 return -EINVAL;
Venkatesh Pallipadi02df8b92005-04-15 15:07:10 -04001221
Alexey Starikovskiycee324b2007-02-02 19:48:22 +03001222 if (acpi_gbl_FADT.cst_control && !nocst) {
Len Brown4be44fc2005-08-05 00:44:28 -04001223 status =
Alexey Starikovskiycee324b2007-02-02 19:48:22 +03001224 acpi_os_write_port(acpi_gbl_FADT.smi_command, acpi_gbl_FADT.cst_control, 8);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001225 if (ACPI_FAILURE(status)) {
Thomas Renningera6fc6722006-06-26 23:58:43 -04001226 ACPI_EXCEPTION((AE_INFO, status,
1227 "Notifying BIOS of _CST ability failed"));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001228 }
1229 }
1230
Linus Torvalds1da177e2005-04-16 15:20:36 -07001231 acpi_processor_get_power_info(pr);
Len Brown4f86d3a2007-10-03 18:58:00 -04001232 pr->flags.power_setup_done = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001233
1234 /*
1235 * Install the idle handler if processor power management is supported.
1236 * Note that we use previously set idle handler will be used on
1237 * platforms that only support C1.
1238 */
Venkatesh Pallipadi36a91352008-04-30 13:57:15 -04001239 if (pr->flags.power) {
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301240 /* Register acpi_idle_driver if not already registered */
1241 if (!acpi_processor_registered) {
1242 acpi_processor_setup_cpuidle_states(pr);
1243 retval = cpuidle_register_driver(&acpi_idle_driver);
1244 if (retval)
1245 return retval;
1246 printk(KERN_DEBUG "ACPI: %s registered with cpuidle\n",
1247 acpi_idle_driver.name);
1248 }
1249 /* Register per-cpu cpuidle_device. Cpuidle driver
1250 * must already be registered before registering device
1251 */
1252 acpi_processor_setup_cpuidle_cx(pr);
1253 retval = cpuidle_register_device(&pr->power.dev);
1254 if (retval) {
1255 if (acpi_processor_registered == 0)
1256 cpuidle_unregister_driver(&acpi_idle_driver);
1257 return retval;
1258 }
1259 acpi_processor_registered++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001260 }
Patrick Mocheld550d982006-06-27 00:41:40 -04001261 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001262}
1263
Len Brown4be44fc2005-08-05 00:44:28 -04001264int acpi_processor_power_exit(struct acpi_processor *pr,
1265 struct acpi_device *device)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001266{
Thomas Renningerd1896042010-11-03 17:06:14 +01001267 if (disabled_by_idle_boot_param())
Venkatesh Pallipadi36a91352008-04-30 13:57:15 -04001268 return 0;
1269
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301270 if (pr->flags.power) {
1271 cpuidle_unregister_device(&pr->power.dev);
1272 acpi_processor_registered--;
1273 if (acpi_processor_registered == 0)
1274 cpuidle_unregister_driver(&acpi_idle_driver);
1275 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001276
Deepthi Dharwar46bcfad2011-10-28 16:20:42 +05301277 pr->flags.power_setup_done = 0;
Patrick Mocheld550d982006-06-27 00:41:40 -04001278 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001279}