git.oblomov.eu Git - linux-2.6/blob - drivers/acpi/processor_idle.c

   1 /*
   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>
   6  *  Copyright (C) 2004       Dominik Brodowski <linux@brodo.de>
   7  *  Copyright (C) 2004  Anil S Keshavamurthy <anil.s.keshavamurthy@intel.com>
   8  *                      - Added processor hotplug support
   9  *  Copyright (C) 2005  Venkatesh Pallipadi <venkatesh.pallipadi@intel.com>
  10  *                      - Added support for C3 on SMP
  11  *
  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>
  35 #include <linux/proc_fs.h>
  36 #include <linux/seq_file.h>
  37 #include <linux/acpi.h>
  38 #include <linux/dmi.h>
  39 #include <linux/moduleparam.h>
  40 #include <linux/sched.h>        /* need_resched() */
  41
  42 #include <asm/io.h>
  43 #include <asm/uaccess.h>
  44
  45 #include <acpi/acpi_bus.h>
  46 #include <acpi/processor.h>
  47
  48 #define ACPI_PROCESSOR_COMPONENT        0x01000000
  49 #define ACPI_PROCESSOR_CLASS            "processor"
  50 #define ACPI_PROCESSOR_DRIVER_NAME      "ACPI Processor Driver"
  51 #define _COMPONENT              ACPI_PROCESSOR_COMPONENT
  52 ACPI_MODULE_NAME("acpi_processor")
  53 #define ACPI_PROCESSOR_FILE_POWER       "power"
  54 #define US_TO_PM_TIMER_TICKS(t)         ((t * (PM_TIMER_FREQUENCY/1000)) / 1000)
  55 #define C2_OVERHEAD                     4       /* 1us (3.579 ticks per us) */
  56 #define C3_OVERHEAD                     4       /* 1us (3.579 ticks per us) */
  57 static void (*pm_idle_save) (void);
  58 module_param(max_cstate, uint, 0644);
  59
  60 static unsigned int nocst = 0;
  61 module_param(nocst, uint, 0000);
  62
  63 /*
  64  * bm_history -- bit-mask with a bit per jiffy of bus-master activity
  65  * 1000 HZ: 0xFFFFFFFF: 32 jiffies = 32ms
  66  * 800 HZ: 0xFFFFFFFF: 32 jiffies = 40ms
  67  * 100 HZ: 0x0000000F: 4 jiffies = 40ms
  68  * reduce history for more aggressive entry into C3
  69  */
  70 static unsigned int bm_history =
  71     (HZ >= 800 ? 0xFFFFFFFF : ((1U << (HZ / 25)) - 1));
  72 module_param(bm_history, uint, 0644);
  73 /* --------------------------------------------------------------------------
  74                                 Power Management
  75    -------------------------------------------------------------------------- */
  76
  77 /*
  78  * IBM ThinkPad R40e crashes mysteriously when going into C2 or C3.
  79  * For now disable this. Probably a bug somewhere else.
  80  *
  81  * To skip this limit, boot/load with a large max_cstate limit.
  82  */
  83 static int set_max_cstate(struct dmi_system_id *id)
  84 {
  85         if (max_cstate > ACPI_PROCESSOR_MAX_POWER)
  86                 return 0;
  87
  88         printk(KERN_NOTICE PREFIX "%s detected - limiting to C%ld max_cstate."
  89                " Override with \"processor.max_cstate=%d\"\n", id->ident,
  90                (long)id->driver_data, ACPI_PROCESSOR_MAX_POWER + 1);
  91
  92         max_cstate = (long)id->driver_data;
  93
  94         return 0;
  95 }
  96
  97 static struct dmi_system_id __initdata processor_power_dmi_table[] = {
  98         {set_max_cstate, "IBM ThinkPad R40e", {
  99                                                DMI_MATCH(DMI_BIOS_VENDOR,
 100                                                          "IBM"),
 101                                                DMI_MATCH(DMI_BIOS_VERSION,
 102                                                          "1SET60WW")},
 103          (void *)1},
 104         {set_max_cstate, "Medion 41700", {
 105                                           DMI_MATCH(DMI_BIOS_VENDOR,
 106                                                     "Phoenix Technologies LTD"),
 107                                           DMI_MATCH(DMI_BIOS_VERSION,
 108                                                     "R01-A1J")}, (void *)1},
 109         {set_max_cstate, "Clevo 5600D", {
 110                                          DMI_MATCH(DMI_BIOS_VENDOR,
 111                                                    "Phoenix Technologies LTD"),
 112                                          DMI_MATCH(DMI_BIOS_VERSION,
 113                                                    "SHE845M0.86C.0013.D.0302131307")},
 114          (void *)2},
 115         {},
 116 };
 117
 118 static inline u32 ticks_elapsed(u32 t1, u32 t2)
 119 {
 120         if (t2 >= t1)
 121                 return (t2 - t1);
 122         else if (!acpi_fadt.tmr_val_ext)
 123                 return (((0x00FFFFFF - t1) + t2) & 0x00FFFFFF);
 124         else
 125                 return ((0xFFFFFFFF - t1) + t2);
 126 }
 127
 128 static void
 129 acpi_processor_power_activate(struct acpi_processor *pr,
 130                               struct acpi_processor_cx *new)
 131 {
 132         struct acpi_processor_cx *old;
 133
 134         if (!pr || !new)
 135                 return;
 136
 137         old = pr->power.state;
 138
 139         if (old)
 140                 old->promotion.count = 0;
 141         new->demotion.count = 0;
 142
 143         /* Cleanup from old state. */
 144         if (old) {
 145                 switch (old->type) {
 146                 case ACPI_STATE_C3:
 147                         /* Disable bus master reload */
 148                         if (new->type != ACPI_STATE_C3 && pr->flags.bm_check)
 149                                 acpi_set_register(ACPI_BITREG_BUS_MASTER_RLD, 0,
 150                                                   ACPI_MTX_DO_NOT_LOCK);
 151                         break;
 152                 }
 153         }
 154
 155         /* Prepare to use new state. */
 156         switch (new->type) {
 157         case ACPI_STATE_C3:
 158                 /* Enable bus master reload */
 159                 if (old->type != ACPI_STATE_C3 && pr->flags.bm_check)
 160                         acpi_set_register(ACPI_BITREG_BUS_MASTER_RLD, 1,
 161                                           ACPI_MTX_DO_NOT_LOCK);
 162                 break;
 163         }
 164
 165         pr->power.state = new;
 166
 167         return;
 168 }
 169
 170 static atomic_t c3_cpu_count;
 171
 172 static void acpi_processor_idle(void)
 173 {
 174         struct acpi_processor *pr = NULL;
 175         struct acpi_processor_cx *cx = NULL;
 176         struct acpi_processor_cx *next_state = NULL;
 177         int sleep_ticks = 0;
 178         u32 t1, t2 = 0;
 179
 180         pr = processors[raw_smp_processor_id()];
 181         if (!pr)
 182                 return;
 183
 184         /*
 185          * Interrupts must be disabled during bus mastering calculations and
 186          * for C2/C3 transitions.
 187          */
 188         local_irq_disable();
 189
 190         /*
 191          * Check whether we truly need to go idle, or should
 192          * reschedule:
 193          */
 194         if (unlikely(need_resched())) {
 195                 local_irq_enable();
 196                 return;
 197         }
 198
 199         cx = pr->power.state;
 200         if (!cx)
 201                 goto easy_out;
 202
 203         /*
 204          * Check BM Activity
 205          * -----------------
 206          * Check for bus mastering activity (if required), record, and check
 207          * for demotion.
 208          */
 209         if (pr->flags.bm_check) {
 210                 u32 bm_status = 0;
 211                 unsigned long diff = jiffies - pr->power.bm_check_timestamp;
 212
 213                 if (diff > 32)
 214                         diff = 32;
 215
 216                 while (diff) {
 217                         /* if we didn't get called, assume there was busmaster activity */
 218                         diff--;
 219                         if (diff)
 220                                 pr->power.bm_activity |= 0x1;
 221                         pr->power.bm_activity <<= 1;
 222                 }
 223
 224                 acpi_get_register(ACPI_BITREG_BUS_MASTER_STATUS,
 225                                   &bm_status, ACPI_MTX_DO_NOT_LOCK);
 226                 if (bm_status) {
 227                         pr->power.bm_activity++;
 228                         acpi_set_register(ACPI_BITREG_BUS_MASTER_STATUS,
 229                                           1, ACPI_MTX_DO_NOT_LOCK);
 230                 }
 231                 /*
 232                  * PIIX4 Erratum #18: Note that BM_STS doesn't always reflect
 233                  * the true state of bus mastering activity; forcing us to
 234                  * manually check the BMIDEA bit of each IDE channel.
 235                  */
 236                 else if (errata.piix4.bmisx) {
 237                         if ((inb_p(errata.piix4.bmisx + 0x02) & 0x01)
 238                             || (inb_p(errata.piix4.bmisx + 0x0A) & 0x01))
 239                                 pr->power.bm_activity++;
 240                 }
 241
 242                 pr->power.bm_check_timestamp = jiffies;
 243
 244                 /*
 245                  * Apply bus mastering demotion policy.  Automatically demote
 246                  * to avoid a faulty transition.  Note that the processor
 247                  * won't enter a low-power state during this call (to this
 248                  * funciton) but should upon the next.
 249                  *
 250                  * TBD: A better policy might be to fallback to the demotion
 251                  *      state (use it for this quantum only) istead of
 252                  *      demoting -- and rely on duration as our sole demotion
 253                  *      qualification.  This may, however, introduce DMA
 254                  *      issues (e.g. floppy DMA transfer overrun/underrun).
 255                  */
 256                 if (pr->power.bm_activity & cx->demotion.threshold.bm) {
 257                         local_irq_enable();
 258                         next_state = cx->demotion.state;
 259                         goto end;
 260                 }
 261         }
 262
 263         cx->usage++;
 264
 265         /*
 266          * Sleep:
 267          * ------
 268          * Invoke the current Cx state to put the processor to sleep.
 269          */
 270         switch (cx->type) {
 271
 272         case ACPI_STATE_C1:
 273                 /*
 274                  * Invoke C1.
 275                  * Use the appropriate idle routine, the one that would
 276                  * be used without acpi C-states.
 277                  */
 278                 if (pm_idle_save)
 279                         pm_idle_save();
 280                 else
 281                         safe_halt();
 282                 /*
 283                  * TBD: Can't get time duration while in C1, as resumes
 284                  *      go to an ISR rather than here.  Need to instrument
 285                  *      base interrupt handler.
 286                  */
 287                 sleep_ticks = 0xFFFFFFFF;
 288                 break;
 289
 290         case ACPI_STATE_C2:
 291                 /* Get start time (ticks) */
 292                 t1 = inl(acpi_fadt.xpm_tmr_blk.address);
 293                 /* Invoke C2 */
 294                 inb(cx->address);
 295                 /* Dummy op - must do something useless after P_LVL2 read */
 296                 t2 = inl(acpi_fadt.xpm_tmr_blk.address);
 297                 /* Get end time (ticks) */
 298                 t2 = inl(acpi_fadt.xpm_tmr_blk.address);
 299                 /* Re-enable interrupts */
 300                 local_irq_enable();
 301                 /* Compute time (ticks) that we were actually asleep */
 302                 sleep_ticks =
 303                     ticks_elapsed(t1, t2) - cx->latency_ticks - C2_OVERHEAD;
 304                 break;
 305
 306         case ACPI_STATE_C3:
 307
 308                 if (pr->flags.bm_check) {
 309                         if (atomic_inc_return(&c3_cpu_count) ==
 310                             num_online_cpus()) {
 311                                 /*
 312                                  * All CPUs are trying to go to C3
 313                                  * Disable bus master arbitration
 314                                  */
 315                                 acpi_set_register(ACPI_BITREG_ARB_DISABLE, 1,
 316                                                   ACPI_MTX_DO_NOT_LOCK);
 317                         }
 318                 } else {
 319                         /* SMP with no shared cache... Invalidate cache  */
 320                         ACPI_FLUSH_CPU_CACHE();
 321                 }
 322
 323                 /* Get start time (ticks) */
 324                 t1 = inl(acpi_fadt.xpm_tmr_blk.address);
 325                 /* Invoke C3 */
 326                 inb(cx->address);
 327                 /* Dummy op - must do something useless after P_LVL3 read */
 328                 t2 = inl(acpi_fadt.xpm_tmr_blk.address);
 329                 /* Get end time (ticks) */
 330                 t2 = inl(acpi_fadt.xpm_tmr_blk.address);
 331                 if (pr->flags.bm_check) {
 332                         /* Enable bus master arbitration */
 333                         atomic_dec(&c3_cpu_count);
 334                         acpi_set_register(ACPI_BITREG_ARB_DISABLE, 0,
 335                                           ACPI_MTX_DO_NOT_LOCK);
 336                 }
 337
 338                 /* Re-enable interrupts */
 339                 local_irq_enable();
 340                 /* Compute time (ticks) that we were actually asleep */
 341                 sleep_ticks =
 342                     ticks_elapsed(t1, t2) - cx->latency_ticks - C3_OVERHEAD;
 343                 break;
 344
 345         default:
 346                 local_irq_enable();
 347                 return;
 348         }
 349
 350         next_state = pr->power.state;
 351
 352         /*
 353          * Promotion?
 354          * ----------
 355          * Track the number of longs (time asleep is greater than threshold)
 356          * and promote when the count threshold is reached.  Note that bus
 357          * mastering activity may prevent promotions.
 358          * Do not promote above max_cstate.
 359          */
 360         if (cx->promotion.state &&
 361             ((cx->promotion.state - pr->power.states) <= max_cstate)) {
 362                 if (sleep_ticks > cx->promotion.threshold.ticks) {
 363                         cx->promotion.count++;
 364                         cx->demotion.count = 0;
 365                         if (cx->promotion.count >=
 366                             cx->promotion.threshold.count) {
 367                                 if (pr->flags.bm_check) {
 368                                         if (!
 369                                             (pr->power.bm_activity & cx->
 370                                              promotion.threshold.bm)) {
 371                                                 next_state =
 372                                                     cx->promotion.state;
 373                                                 goto end;
 374                                         }
 375                                 } else {
 376                                         next_state = cx->promotion.state;
 377                                         goto end;
 378                                 }
 379                         }
 380                 }
 381         }
 382
 383         /*
 384          * Demotion?
 385          * ---------
 386          * Track the number of shorts (time asleep is less than time threshold)
 387          * and demote when the usage threshold is reached.
 388          */
 389         if (cx->demotion.state) {
 390                 if (sleep_ticks < cx->demotion.threshold.ticks) {
 391                         cx->demotion.count++;
 392                         cx->promotion.count = 0;
 393                         if (cx->demotion.count >= cx->demotion.threshold.count) {
 394                                 next_state = cx->demotion.state;
 395                                 goto end;
 396                         }
 397                 }
 398         }
 399
 400       end:
 401         /*
 402          * Demote if current state exceeds max_cstate
 403          */
 404         if ((pr->power.state - pr->power.states) > max_cstate) {
 405                 if (cx->demotion.state)
 406                         next_state = cx->demotion.state;
 407         }
 408
 409         /*
 410          * New Cx State?
 411          * -------------
 412          * If we're going to start using a new Cx state we must clean up
 413          * from the previous and prepare to use the new.
 414          */
 415         if (next_state != pr->power.state)
 416                 acpi_processor_power_activate(pr, next_state);
 417
 418         return;
 419
 420       easy_out:
 421         /* do C1 instead of busy loop */
 422         if (pm_idle_save)
 423                 pm_idle_save();
 424         else
 425                 safe_halt();
 426         return;
 427 }
 428
 429 static int acpi_processor_set_power_policy(struct acpi_processor *pr)
 430 {
 431         unsigned int i;
 432         unsigned int state_is_set = 0;
 433         struct acpi_processor_cx *lower = NULL;
 434         struct acpi_processor_cx *higher = NULL;
 435         struct acpi_processor_cx *cx;
 436
 437         ACPI_FUNCTION_TRACE("acpi_processor_set_power_policy");
 438
 439         if (!pr)
 440                 return_VALUE(-EINVAL);
 441
 442         /*
 443          * This function sets the default Cx state policy (OS idle handler).
 444          * Our scheme is to promote quickly to C2 but more conservatively
 445          * to C3.  We're favoring C2  for its characteristics of low latency
 446          * (quick response), good power savings, and ability to allow bus
 447          * mastering activity.  Note that the Cx state policy is completely
 448          * customizable and can be altered dynamically.
 449          */
 450
 451         /* startup state */
 452         for (i = 1; i < ACPI_PROCESSOR_MAX_POWER; i++) {
 453                 cx = &pr->power.states[i];
 454                 if (!cx->valid)
 455                         continue;
 456
 457                 if (!state_is_set)
 458                         pr->power.state = cx;
 459                 state_is_set++;
 460                 break;
 461         }
 462
 463         if (!state_is_set)
 464                 return_VALUE(-ENODEV);
 465
 466         /* demotion */
 467         for (i = 1; i < ACPI_PROCESSOR_MAX_POWER; i++) {
 468                 cx = &pr->power.states[i];
 469                 if (!cx->valid)
 470                         continue;
 471
 472                 if (lower) {
 473                         cx->demotion.state = lower;
 474                         cx->demotion.threshold.ticks = cx->latency_ticks;
 475                         cx->demotion.threshold.count = 1;
 476                         if (cx->type == ACPI_STATE_C3)
 477                                 cx->demotion.threshold.bm = bm_history;
 478                 }
 479
 480                 lower = cx;
 481         }
 482
 483         /* promotion */
 484         for (i = (ACPI_PROCESSOR_MAX_POWER - 1); i > 0; i--) {
 485                 cx = &pr->power.states[i];
 486                 if (!cx->valid)
 487                         continue;
 488
 489                 if (higher) {
 490                         cx->promotion.state = higher;
 491                         cx->promotion.threshold.ticks = cx->latency_ticks;
 492                         if (cx->type >= ACPI_STATE_C2)
 493                                 cx->promotion.threshold.count = 4;
 494                         else
 495                                 cx->promotion.threshold.count = 10;
 496                         if (higher->type == ACPI_STATE_C3)
 497                                 cx->promotion.threshold.bm = bm_history;
 498                 }
 499
 500                 higher = cx;
 501         }
 502
 503         return_VALUE(0);
 504 }
 505
 506 static int acpi_processor_get_power_info_fadt(struct acpi_processor *pr)
 507 {
 508         int i;
 509
 510         ACPI_FUNCTION_TRACE("acpi_processor_get_power_info_fadt");
 511
 512         if (!pr)
 513                 return_VALUE(-EINVAL);
 514
 515         if (!pr->pblk)
 516                 return_VALUE(-ENODEV);
 517
 518         for (i = 0; i < ACPI_PROCESSOR_MAX_POWER; i++)
 519                 memset(pr->power.states, 0, sizeof(struct acpi_processor_cx));
 520
 521         /* if info is obtained from pblk/fadt, type equals state */
 522         pr->power.states[ACPI_STATE_C1].type = ACPI_STATE_C1;
 523         pr->power.states[ACPI_STATE_C2].type = ACPI_STATE_C2;
 524         pr->power.states[ACPI_STATE_C3].type = ACPI_STATE_C3;
 525
 526         /* the C0 state only exists as a filler in our array,
 527          * and all processors need to support C1 */
 528         pr->power.states[ACPI_STATE_C0].valid = 1;
 529         pr->power.states[ACPI_STATE_C1].valid = 1;
 530
 531         /* determine C2 and C3 address from pblk */
 532         pr->power.states[ACPI_STATE_C2].address = pr->pblk + 4;
 533         pr->power.states[ACPI_STATE_C3].address = pr->pblk + 5;
 534
 535         /* determine latencies from FADT */
 536         pr->power.states[ACPI_STATE_C2].latency = acpi_fadt.plvl2_lat;
 537         pr->power.states[ACPI_STATE_C3].latency = acpi_fadt.plvl3_lat;
 538
 539         ACPI_DEBUG_PRINT((ACPI_DB_INFO,
 540                           "lvl2[0x%08x] lvl3[0x%08x]\n",
 541                           pr->power.states[ACPI_STATE_C2].address,
 542                           pr->power.states[ACPI_STATE_C3].address));
 543
 544         return_VALUE(0);
 545 }
 546
 547 static int acpi_processor_get_power_info_default_c1(struct acpi_processor *pr)
 548 {
 549         int i;
 550
 551         ACPI_FUNCTION_TRACE("acpi_processor_get_power_info_default_c1");
 552
 553         for (i = 0; i < ACPI_PROCESSOR_MAX_POWER; i++)
 554                 memset(&(pr->power.states[i]), 0,
 555                        sizeof(struct acpi_processor_cx));
 556
 557         /* if info is obtained from pblk/fadt, type equals state */
 558         pr->power.states[ACPI_STATE_C1].type = ACPI_STATE_C1;
 559         pr->power.states[ACPI_STATE_C2].type = ACPI_STATE_C2;
 560         pr->power.states[ACPI_STATE_C3].type = ACPI_STATE_C3;
 561
 562         /* the C0 state only exists as a filler in our array,
 563          * and all processors need to support C1 */
 564         pr->power.states[ACPI_STATE_C0].valid = 1;
 565         pr->power.states[ACPI_STATE_C1].valid = 1;
 566
 567         return_VALUE(0);
 568 }
 569
 570 static int acpi_processor_get_power_info_cst(struct acpi_processor *pr)
 571 {
 572         acpi_status status = 0;
 573         acpi_integer count;
 574         int i;
 575         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
 576         union acpi_object *cst;
 577
 578         ACPI_FUNCTION_TRACE("acpi_processor_get_power_info_cst");
 579
 580         if (nocst)
 581                 return_VALUE(-ENODEV);
 582
 583         pr->power.count = 0;
 584         for (i = 0; i < ACPI_PROCESSOR_MAX_POWER; i++)
 585                 memset(&(pr->power.states[i]), 0,
 586                        sizeof(struct acpi_processor_cx));
 587
 588         status = acpi_evaluate_object(pr->handle, "_CST", NULL, &buffer);
 589         if (ACPI_FAILURE(status)) {
 590                 ACPI_DEBUG_PRINT((ACPI_DB_INFO, "No _CST, giving up\n"));
 591                 return_VALUE(-ENODEV);
 592         }
 593
 594         cst = (union acpi_object *)buffer.pointer;
 595
 596         /* There must be at least 2 elements */
 597         if (!cst || (cst->type != ACPI_TYPE_PACKAGE) || cst->package.count < 2) {
 598                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
 599                                   "not enough elements in _CST\n"));
 600                 status = -EFAULT;
 601                 goto end;
 602         }
 603
 604         count = cst->package.elements[0].integer.value;
 605
 606         /* Validate number of power states. */
 607         if (count < 1 || count != cst->package.count - 1) {
 608                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
 609                                   "count given by _CST is not valid\n"));
 610                 status = -EFAULT;
 611                 goto end;
 612         }
 613
 614         /* We support up to ACPI_PROCESSOR_MAX_POWER. */
 615         if (count > ACPI_PROCESSOR_MAX_POWER) {
 616                 printk(KERN_WARNING
 617                        "Limiting number of power states to max (%d)\n",
 618                        ACPI_PROCESSOR_MAX_POWER);
 619                 printk(KERN_WARNING
 620                        "Please increase ACPI_PROCESSOR_MAX_POWER if needed.\n");
 621                 count = ACPI_PROCESSOR_MAX_POWER;
 622         }
 623
 624         /* Tell driver that at least _CST is supported. */
 625         pr->flags.has_cst = 1;
 626
 627         for (i = 1; i <= count; i++) {
 628                 union acpi_object *element;
 629                 union acpi_object *obj;
 630                 struct acpi_power_register *reg;
 631                 struct acpi_processor_cx cx;
 632
 633                 memset(&cx, 0, sizeof(cx));
 634
 635                 element = (union acpi_object *)&(cst->package.elements[i]);
 636                 if (element->type != ACPI_TYPE_PACKAGE)
 637                         continue;
 638
 639                 if (element->package.count != 4)
 640                         continue;
 641
 642                 obj = (union acpi_object *)&(element->package.elements[0]);
 643
 644                 if (obj->type != ACPI_TYPE_BUFFER)
 645                         continue;
 646
 647                 reg = (struct acpi_power_register *)obj->buffer.pointer;
 648
 649                 if (reg->space_id != ACPI_ADR_SPACE_SYSTEM_IO &&
 650                     (reg->space_id != ACPI_ADR_SPACE_FIXED_HARDWARE))
 651                         continue;
 652
 653                 cx.address = (reg->space_id == ACPI_ADR_SPACE_FIXED_HARDWARE) ?
 654                     0 : reg->address;
 655
 656                 /* There should be an easy way to extract an integer... */
 657                 obj = (union acpi_object *)&(element->package.elements[1]);
 658                 if (obj->type != ACPI_TYPE_INTEGER)
 659                         continue;
 660
 661                 cx.type = obj->integer.value;
 662
 663                 if ((cx.type != ACPI_STATE_C1) &&
 664                     (reg->space_id != ACPI_ADR_SPACE_SYSTEM_IO))
 665                         continue;
 666
 667                 if ((cx.type < ACPI_STATE_C1) || (cx.type > ACPI_STATE_C3))
 668                         continue;
 669
 670                 obj = (union acpi_object *)&(element->package.elements[2]);
 671                 if (obj->type != ACPI_TYPE_INTEGER)
 672                         continue;
 673
 674                 cx.latency = obj->integer.value;
 675
 676                 obj = (union acpi_object *)&(element->package.elements[3]);
 677                 if (obj->type != ACPI_TYPE_INTEGER)
 678                         continue;
 679
 680                 cx.power = obj->integer.value;
 681
 682                 (pr->power.count)++;
 683                 memcpy(&(pr->power.states[pr->power.count]), &cx, sizeof(cx));
 684         }
 685
 686         ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %d power states\n",
 687                           pr->power.count));
 688
 689         /* Validate number of power states discovered */
 690         if (pr->power.count < 2)
 691                 status = -ENODEV;
 692
 693       end:
 694         acpi_os_free(buffer.pointer);
 695
 696         return_VALUE(status);
 697 }
 698
 699 static void acpi_processor_power_verify_c2(struct acpi_processor_cx *cx)
 700 {
 701         ACPI_FUNCTION_TRACE("acpi_processor_get_power_verify_c2");
 702
 703         if (!cx->address)
 704                 return_VOID;
 705
 706         /*
 707          * C2 latency must be less than or equal to 100
 708          * microseconds.
 709          */
 710         else if (cx->latency > ACPI_PROCESSOR_MAX_C2_LATENCY) {
 711                 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
 712                                   "latency too large [%d]\n", cx->latency));
 713                 return_VOID;
 714         }
 715
 716         /*
 717          * Otherwise we've met all of our C2 requirements.
 718          * Normalize the C2 latency to expidite policy
 719          */
 720         cx->valid = 1;
 721         cx->latency_ticks = US_TO_PM_TIMER_TICKS(cx->latency);
 722
 723         return_VOID;
 724 }
 725
 726 static void acpi_processor_power_verify_c3(struct acpi_processor *pr,
 727                                            struct acpi_processor_cx *cx)
 728 {
 729         static int bm_check_flag;
 730
 731         ACPI_FUNCTION_TRACE("acpi_processor_get_power_verify_c3");
 732
 733         if (!cx->address)
 734                 return_VOID;
 735
 736         /*
 737          * C3 latency must be less than or equal to 1000
 738          * microseconds.
 739          */
 740         else if (cx->latency > ACPI_PROCESSOR_MAX_C3_LATENCY) {
 741                 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
 742                                   "latency too large [%d]\n", cx->latency));
 743                 return_VOID;
 744         }
 745
 746         /*
 747          * PIIX4 Erratum #18: We don't support C3 when Type-F (fast)
 748          * DMA transfers are used by any ISA device to avoid livelock.
 749          * Note that we could disable Type-F DMA (as recommended by
 750          * the erratum), but this is known to disrupt certain ISA
 751          * devices thus we take the conservative approach.
 752          */
 753         else if (errata.piix4.fdma) {
 754                 ACPI_DEBUG_PRINT((ACPI_DB_INFO,
 755                                   "C3 not supported on PIIX4 with Type-F DMA\n"));
 756                 return_VOID;
 757         }
 758
 759         /* All the logic here assumes flags.bm_check is same across all CPUs */
 760         if (!bm_check_flag) {
 761                 /* Determine whether bm_check is needed based on CPU  */
 762                 acpi_processor_power_init_bm_check(&(pr->flags), pr->id);
 763                 bm_check_flag = pr->flags.bm_check;
 764         } else {
 765                 pr->flags.bm_check = bm_check_flag;
 766         }
 767
 768         if (pr->flags.bm_check) {
 769                 /* bus mastering control is necessary */
 770                 if (!pr->flags.bm_control) {
 771                         ACPI_DEBUG_PRINT((ACPI_DB_INFO,
 772                                           "C3 support requires bus mastering control\n"));
 773                         return_VOID;
 774                 }
 775         } else {
 776                 /*
 777                  * WBINVD should be set in fadt, for C3 state to be
 778                  * supported on when bm_check is not required.
 779                  */
 780                 if (acpi_fadt.wb_invd != 1) {
 781                         ACPI_DEBUG_PRINT((ACPI_DB_INFO,
 782                                           "Cache invalidation should work properly"
 783                                           " for C3 to be enabled on SMP systems\n"));
 784                         return_VOID;
 785                 }
 786                 acpi_set_register(ACPI_BITREG_BUS_MASTER_RLD,
 787                                   0, ACPI_MTX_DO_NOT_LOCK);
 788         }
 789
 790         /*
 791          * Otherwise we've met all of our C3 requirements.
 792          * Normalize the C3 latency to expidite policy.  Enable
 793          * checking of bus mastering status (bm_check) so we can
 794          * use this in our C3 policy
 795          */
 796         cx->valid = 1;
 797         cx->latency_ticks = US_TO_PM_TIMER_TICKS(cx->latency);
 798
 799         return_VOID;
 800 }
 801
 802 static int acpi_processor_power_verify(struct acpi_processor *pr)
 803 {
 804         unsigned int i;
 805         unsigned int working = 0;
 806
 807         for (i = 1; i < ACPI_PROCESSOR_MAX_POWER; i++) {
 808                 struct acpi_processor_cx *cx = &pr->power.states[i];
 809
 810                 switch (cx->type) {
 811                 case ACPI_STATE_C1:
 812                         cx->valid = 1;
 813                         break;
 814
 815                 case ACPI_STATE_C2:
 816                         acpi_processor_power_verify_c2(cx);
 817                         break;
 818
 819                 case ACPI_STATE_C3:
 820                         acpi_processor_power_verify_c3(pr, cx);
 821                         break;
 822                 }
 823
 824                 if (cx->valid)
 825                         working++;
 826         }
 827
 828         return (working);
 829 }
 830
 831 static int acpi_processor_get_power_info(struct acpi_processor *pr)
 832 {
 833         unsigned int i;
 834         int result;
 835
 836         ACPI_FUNCTION_TRACE("acpi_processor_get_power_info");
 837
 838         /* NOTE: the idle thread may not be running while calling
 839          * this function */
 840
 841         result = acpi_processor_get_power_info_cst(pr);
 842         if ((result) || (acpi_processor_power_verify(pr) < 2)) {
 843                 result = acpi_processor_get_power_info_fadt(pr);
 844                 if ((result) || (acpi_processor_power_verify(pr) < 2))
 845                         result = acpi_processor_get_power_info_default_c1(pr);
 846         }
 847
 848         /*
 849          * Set Default Policy
 850          * ------------------
 851          * Now that we know which states are supported, set the default
 852          * policy.  Note that this policy can be changed dynamically
 853          * (e.g. encourage deeper sleeps to conserve battery life when
 854          * not on AC).
 855          */
 856         result = acpi_processor_set_power_policy(pr);
 857         if (result)
 858                 return_VALUE(result);
 859
 860         /*
 861          * if one state of type C2 or C3 is available, mark this
 862          * CPU as being "idle manageable"
 863          */
 864         for (i = 1; i < ACPI_PROCESSOR_MAX_POWER; i++) {
 865                 if (pr->power.states[i].valid) {
 866                         pr->power.count = i;
 867                         pr->flags.power = 1;
 868                 }
 869         }
 870
 871         return_VALUE(0);
 872 }
 873
 874 int acpi_processor_cst_has_changed(struct acpi_processor *pr)
 875 {
 876         int result = 0;
 877
 878         ACPI_FUNCTION_TRACE("acpi_processor_cst_has_changed");
 879
 880         if (!pr)
 881                 return_VALUE(-EINVAL);
 882
 883         if (nocst) {
 884                 return_VALUE(-ENODEV);
 885         }
 886
 887         if (!pr->flags.power_setup_done)
 888                 return_VALUE(-ENODEV);
 889
 890         /* Fall back to the default idle loop */
 891         pm_idle = pm_idle_save;
 892         synchronize_sched();    /* Relies on interrupts forcing exit from idle. */
 893
 894         pr->flags.power = 0;
 895         result = acpi_processor_get_power_info(pr);
 896         if ((pr->flags.power == 1) && (pr->flags.power_setup_done))
 897                 pm_idle = acpi_processor_idle;
 898
 899         return_VALUE(result);
 900 }
 901
 902 /* proc interface */
 903
 904 static int acpi_processor_power_seq_show(struct seq_file *seq, void *offset)
 905 {
 906         struct acpi_processor *pr = (struct acpi_processor *)seq->private;
 907         unsigned int i;
 908
 909         ACPI_FUNCTION_TRACE("acpi_processor_power_seq_show");
 910
 911         if (!pr)
 912                 goto end;
 913
 914         seq_printf(seq, "active state:            C%zd\n"
 915                    "max_cstate:              C%d\n"
 916                    "bus master activity:     %08x\n",
 917                    pr->power.state ? pr->power.state - pr->power.states : 0,
 918                    max_cstate, (unsigned)pr->power.bm_activity);
 919
 920         seq_puts(seq, "states:\n");
 921
 922         for (i = 1; i <= pr->power.count; i++) {
 923                 seq_printf(seq, "   %cC%d:                  ",
 924                            (&pr->power.states[i] ==
 925                             pr->power.state ? '*' : ' '), i);
 926
 927                 if (!pr->power.states[i].valid) {
 928                         seq_puts(seq, "<not supported>\n");
 929                         continue;
 930                 }
 931
 932                 switch (pr->power.states[i].type) {
 933                 case ACPI_STATE_C1:
 934                         seq_printf(seq, "type[C1] ");
 935                         break;
 936                 case ACPI_STATE_C2:
 937                         seq_printf(seq, "type[C2] ");
 938                         break;
 939                 case ACPI_STATE_C3:
 940                         seq_printf(seq, "type[C3] ");
 941                         break;
 942                 default:
 943                         seq_printf(seq, "type[--] ");
 944                         break;
 945                 }
 946
 947                 if (pr->power.states[i].promotion.state)
 948                         seq_printf(seq, "promotion[C%zd] ",
 949                                    (pr->power.states[i].promotion.state -
 950                                     pr->power.states));
 951                 else
 952                         seq_puts(seq, "promotion[--] ");
 953
 954                 if (pr->power.states[i].demotion.state)
 955                         seq_printf(seq, "demotion[C%zd] ",
 956                                    (pr->power.states[i].demotion.state -
 957                                     pr->power.states));
 958                 else
 959                         seq_puts(seq, "demotion[--] ");
 960
 961                 seq_printf(seq, "latency[%03d] usage[%08d]\n",
 962                            pr->power.states[i].latency,
 963                            pr->power.states[i].usage);
 964         }
 965
 966       end:
 967         return_VALUE(0);
 968 }
 969
 970 static int acpi_processor_power_open_fs(struct inode *inode, struct file *file)
 971 {
 972         return single_open(file, acpi_processor_power_seq_show,
 973                            PDE(inode)->data);
 974 }
 975
 976 static struct file_operations acpi_processor_power_fops = {
 977         .open = acpi_processor_power_open_fs,
 978         .read = seq_read,
 979         .llseek = seq_lseek,
 980         .release = single_release,
 981 };
 982
 983 int acpi_processor_power_init(struct acpi_processor *pr,
 984                               struct acpi_device *device)
 985 {
 986         acpi_status status = 0;
 987         static int first_run = 0;
 988         struct proc_dir_entry *entry = NULL;
 989         unsigned int i;
 990
 991         ACPI_FUNCTION_TRACE("acpi_processor_power_init");
 992
 993         if (!first_run) {
 994                 dmi_check_system(processor_power_dmi_table);
 995                 if (max_cstate < ACPI_C_STATES_MAX)
 996                         printk(KERN_NOTICE
 997                                "ACPI: processor limited to max C-state %d\n",
 998                                max_cstate);
 999                 first_run++;
1000         }
1001
1002         if (!pr)
1003                 return_VALUE(-EINVAL);
1004
1005         if (acpi_fadt.cst_cnt && !nocst) {
1006                 status =
1007                     acpi_os_write_port(acpi_fadt.smi_cmd, acpi_fadt.cst_cnt, 8);
1008                 if (ACPI_FAILURE(status)) {
1009                         ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
1010                                           "Notifying BIOS of _CST ability failed\n"));
1011                 }
1012         }
1013
1014         acpi_processor_power_init_pdc(&(pr->power), pr->id);
1015         acpi_processor_set_pdc(pr, pr->power.pdc);
1016         acpi_processor_get_power_info(pr);
1017
1018         /*
1019          * Install the idle handler if processor power management is supported.
1020          * Note that we use previously set idle handler will be used on
1021          * platforms that only support C1.
1022          */
1023         if ((pr->flags.power) && (!boot_option_idle_override)) {
1024                 printk(KERN_INFO PREFIX "CPU%d (power states:", pr->id);
1025                 for (i = 1; i <= pr->power.count; i++)
1026                         if (pr->power.states[i].valid)
1027                                 printk(" C%d[C%d]", i,
1028                                        pr->power.states[i].type);
1029                 printk(")\n");
1030
1031                 if (pr->id == 0) {
1032                         pm_idle_save = pm_idle;
1033                         pm_idle = acpi_processor_idle;
1034                 }
1035         }
1036
1037         /* 'power' [R] */
1038         entry = create_proc_entry(ACPI_PROCESSOR_FILE_POWER,
1039                                   S_IRUGO, acpi_device_dir(device));
1040         if (!entry)
1041                 ACPI_DEBUG_PRINT((ACPI_DB_ERROR,
1042                                   "Unable to create '%s' fs entry\n",
1043                                   ACPI_PROCESSOR_FILE_POWER));
1044         else {
1045                 entry->proc_fops = &acpi_processor_power_fops;
1046                 entry->data = acpi_driver_data(device);
1047                 entry->owner = THIS_MODULE;
1048         }
1049
1050         pr->flags.power_setup_done = 1;
1051
1052         return_VALUE(0);
1053 }
1054
1055 int acpi_processor_power_exit(struct acpi_processor *pr,
1056                               struct acpi_device *device)
1057 {
1058         ACPI_FUNCTION_TRACE("acpi_processor_power_exit");
1059
1060         pr->flags.power_setup_done = 0;
1061
1062         if (acpi_device_dir(device))
1063                 remove_proc_entry(ACPI_PROCESSOR_FILE_POWER,
1064                                   acpi_device_dir(device));
1065
1066         /* Unregister the idle handler when processor #0 is removed. */
1067         if (pr->id == 0) {
1068                 pm_idle = pm_idle_save;
1069
1070                 /*
1071                  * We are about to unload the current idle thread pm callback
1072                  * (pm_idle), Wait for all processors to update cached/local
1073                  * copies of pm_idle before proceeding.
1074                  */
1075                 cpu_idle_wait();
1076         }
1077
1078         return_VALUE(0);
1079 }