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

   1 /*
   2  * Provides ACPI support for IDE drives.
   3  *
   4  * Copyright (C) 2005 Intel Corp.
   5  * Copyright (C) 2005 Randy Dunlap
   6  * Copyright (C) 2006 SUSE Linux Products GmbH
   7  * Copyright (C) 2006 Hannes Reinecke
   8  */
   9
  10 #include <linux/ata.h>
  11 #include <linux/delay.h>
  12 #include <linux/device.h>
  13 #include <linux/errno.h>
  14 #include <linux/kernel.h>
  15 #include <acpi/acpi.h>
  16 #include <linux/ide.h>
  17 #include <linux/pci.h>
  18 #include <linux/dmi.h>
  19
  20 #include <acpi/acpi_bus.h>
  21 #include <acpi/acnames.h>
  22 #include <acpi/acnamesp.h>
  23 #include <acpi/acparser.h>
  24 #include <acpi/acexcep.h>
  25 #include <acpi/acmacros.h>
  26 #include <acpi/actypes.h>
  27
  28 #define REGS_PER_GTF            7
  29 struct taskfile_array {
  30         u8      tfa[REGS_PER_GTF];      /* regs. 0x1f1 - 0x1f7 */
  31 };
  32
  33 struct GTM_buffer {
  34         u32     PIO_speed0;
  35         u32     DMA_speed0;
  36         u32     PIO_speed1;
  37         u32     DMA_speed1;
  38         u32     GTM_flags;
  39 };
  40
  41 struct ide_acpi_drive_link {
  42         ide_drive_t     *drive;
  43         acpi_handle      obj_handle;
  44         u8               idbuff[512];
  45 };
  46
  47 struct ide_acpi_hwif_link {
  48         ide_hwif_t                      *hwif;
  49         acpi_handle                      obj_handle;
  50         struct GTM_buffer                gtm;
  51         struct ide_acpi_drive_link       master;
  52         struct ide_acpi_drive_link       slave;
  53 };
  54
  55 #undef DEBUGGING
  56 /* note: adds function name and KERN_DEBUG */
  57 #ifdef DEBUGGING
  58 #define DEBPRINT(fmt, args...)  \
  59                 printk(KERN_DEBUG "%s: " fmt, __FUNCTION__, ## args)
  60 #else
  61 #define DEBPRINT(fmt, args...)  do {} while (0)
  62 #endif  /* DEBUGGING */
  63
  64 extern int ide_noacpi;
  65 extern int ide_noacpitfs;
  66 extern int ide_noacpionboot;
  67
  68 static bool ide_noacpi_psx;
  69 static int no_acpi_psx(const struct dmi_system_id *id)
  70 {
  71         ide_noacpi_psx = true;
  72         printk(KERN_NOTICE"%s detected - disable ACPI _PSx.\n", id->ident);
  73         return 0;
  74 }
  75
  76 static const struct dmi_system_id ide_acpi_dmi_table[] = {
  77         /* Bug 9673. */
  78         /* We should check if this is because ACPI NVS isn't save/restored. */
  79         {
  80                 .callback = no_acpi_psx,
  81                 .ident    = "HP nx9005",
  82                 .matches  = {
  83                         DMI_MATCH(DMI_BIOS_VENDOR, "Phoenix Technologies Ltd."),
  84                         DMI_MATCH(DMI_BIOS_VERSION, "KAM1.60")
  85                 },
  86         },
  87
  88         { }     /* terminate list */
  89 };
  90
  91 static int ide_acpi_blacklist(void)
  92 {
  93         static int done;
  94         if (done)
  95                 return 0;
  96         done = 1;
  97         dmi_check_system(ide_acpi_dmi_table);
  98         return 0;
  99 }
 100
 101 /**
 102  * ide_get_dev_handle - finds acpi_handle and PCI device.function
 103  * @dev: device to locate
 104  * @handle: returned acpi_handle for @dev
 105  * @pcidevfn: return PCI device.func for @dev
 106  *
 107  * Returns the ACPI object handle to the corresponding PCI device.
 108  *
 109  * Returns 0 on success, <0 on error.
 110  */
 111 static int ide_get_dev_handle(struct device *dev, acpi_handle *handle,
 112                                acpi_integer *pcidevfn)
 113 {
 114         struct pci_dev *pdev = to_pci_dev(dev);
 115         unsigned int bus, devnum, func;
 116         acpi_integer addr;
 117         acpi_handle dev_handle;
 118         struct acpi_buffer buffer = {.length = ACPI_ALLOCATE_BUFFER,
 119                                         .pointer = NULL};
 120         acpi_status status;
 121         struct acpi_device_info *dinfo = NULL;
 122         int ret = -ENODEV;
 123
 124         bus = pdev->bus->number;
 125         devnum = PCI_SLOT(pdev->devfn);
 126         func = PCI_FUNC(pdev->devfn);
 127         /* ACPI _ADR encoding for PCI bus: */
 128         addr = (acpi_integer)(devnum << 16 | func);
 129
 130         DEBPRINT("ENTER: pci %02x:%02x.%01x\n", bus, devnum, func);
 131
 132         dev_handle = DEVICE_ACPI_HANDLE(dev);
 133         if (!dev_handle) {
 134                 DEBPRINT("no acpi handle for device\n");
 135                 goto err;
 136         }
 137
 138         status = acpi_get_object_info(dev_handle, &buffer);
 139         if (ACPI_FAILURE(status)) {
 140                 DEBPRINT("get_object_info for device failed\n");
 141                 goto err;
 142         }
 143         dinfo = buffer.pointer;
 144         if (dinfo && (dinfo->valid & ACPI_VALID_ADR) &&
 145             dinfo->address == addr) {
 146                 *pcidevfn = addr;
 147                 *handle = dev_handle;
 148         } else {
 149                 DEBPRINT("get_object_info for device has wrong "
 150                         " address: %llu, should be %u\n",
 151                         dinfo ? (unsigned long long)dinfo->address : -1ULL,
 152                         (unsigned int)addr);
 153                 goto err;
 154         }
 155
 156         DEBPRINT("for dev=0x%x.%x, addr=0x%llx, *handle=0x%p\n",
 157                  devnum, func, (unsigned long long)addr, *handle);
 158         ret = 0;
 159 err:
 160         kfree(dinfo);
 161         return ret;
 162 }
 163
 164 /**
 165  * ide_acpi_hwif_get_handle - Get ACPI object handle for a given hwif
 166  * @hwif: device to locate
 167  *
 168  * Retrieves the object handle for a given hwif.
 169  *
 170  * Returns handle on success, 0 on error.
 171  */
 172 static acpi_handle ide_acpi_hwif_get_handle(ide_hwif_t *hwif)
 173 {
 174         struct device           *dev = hwif->gendev.parent;
 175         acpi_handle             dev_handle;
 176         acpi_integer            pcidevfn;
 177         acpi_handle             chan_handle;
 178         int                     err;
 179
 180         DEBPRINT("ENTER: device %s\n", hwif->name);
 181
 182         if (!dev) {
 183                 DEBPRINT("no PCI device for %s\n", hwif->name);
 184                 return NULL;
 185         }
 186
 187         err = ide_get_dev_handle(dev, &dev_handle, &pcidevfn);
 188         if (err < 0) {
 189                 DEBPRINT("ide_get_dev_handle failed (%d)\n", err);
 190                 return NULL;
 191         }
 192
 193         /* get child objects of dev_handle == channel objects,
 194          * + _their_ children == drive objects */
 195         /* channel is hwif->channel */
 196         chan_handle = acpi_get_child(dev_handle, hwif->channel);
 197         DEBPRINT("chan adr=%d: handle=0x%p\n",
 198                  hwif->channel, chan_handle);
 199
 200         return chan_handle;
 201 }
 202
 203 /**
 204  * ide_acpi_drive_get_handle - Get ACPI object handle for a given drive
 205  * @drive: device to locate
 206  *
 207  * Retrieves the object handle of a given drive. According to the ACPI
 208  * spec the drive is a child of the hwif.
 209  *
 210  * Returns handle on success, 0 on error.
 211  */
 212 static acpi_handle ide_acpi_drive_get_handle(ide_drive_t *drive)
 213 {
 214         ide_hwif_t      *hwif = HWIF(drive);
 215         int              port;
 216         acpi_handle      drive_handle;
 217
 218         if (!hwif->acpidata)
 219                 return NULL;
 220
 221         if (!hwif->acpidata->obj_handle)
 222                 return NULL;
 223
 224         port = hwif->channel ? drive->dn - 2: drive->dn;
 225
 226         DEBPRINT("ENTER: %s at channel#: %d port#: %d\n",
 227                  drive->name, hwif->channel, port);
 228
 229
 230         /* TBD: could also check ACPI object VALID bits */
 231         drive_handle = acpi_get_child(hwif->acpidata->obj_handle, port);
 232         DEBPRINT("drive %s handle 0x%p\n", drive->name, drive_handle);
 233
 234         return drive_handle;
 235 }
 236
 237 /**
 238  * do_drive_get_GTF - get the drive bootup default taskfile settings
 239  * @drive: the drive for which the taskfile settings should be retrieved
 240  * @gtf_length: number of bytes of _GTF data returned at @gtf_address
 241  * @gtf_address: buffer containing _GTF taskfile arrays
 242  *
 243  * The _GTF method has no input parameters.
 244  * It returns a variable number of register set values (registers
 245  * hex 1F1..1F7, taskfiles).
 246  * The <variable number> is not known in advance, so have ACPI-CA
 247  * allocate the buffer as needed and return it, then free it later.
 248  *
 249  * The returned @gtf_length and @gtf_address are only valid if the
 250  * function return value is 0.
 251  */
 252 static int do_drive_get_GTF(ide_drive_t *drive,
 253                      unsigned int *gtf_length, unsigned long *gtf_address,
 254                      unsigned long *obj_loc)
 255 {
 256         acpi_status                     status;
 257         struct acpi_buffer              output;
 258         union acpi_object               *out_obj;
 259         ide_hwif_t                      *hwif = HWIF(drive);
 260         struct device                   *dev = hwif->gendev.parent;
 261         int                             err = -ENODEV;
 262         int                             port;
 263
 264         *gtf_length = 0;
 265         *gtf_address = 0UL;
 266         *obj_loc = 0UL;
 267
 268         if (ide_noacpi)
 269                 return 0;
 270
 271         if (!dev) {
 272                 DEBPRINT("no PCI device for %s\n", hwif->name);
 273                 goto out;
 274         }
 275
 276         if (!hwif->acpidata) {
 277                 DEBPRINT("no ACPI data for %s\n", hwif->name);
 278                 goto out;
 279         }
 280
 281         port = hwif->channel ? drive->dn - 2: drive->dn;
 282
 283         DEBPRINT("ENTER: %s at %s, port#: %d, hard_port#: %d\n",
 284                  hwif->name, dev->bus_id, port, hwif->channel);
 285
 286         if (!drive->present) {
 287                 DEBPRINT("%s drive %d:%d not present\n",
 288                          hwif->name, hwif->channel, port);
 289                 goto out;
 290         }
 291
 292         /* Get this drive's _ADR info. if not already known. */
 293         if (!drive->acpidata->obj_handle) {
 294                 drive->acpidata->obj_handle = ide_acpi_drive_get_handle(drive);
 295                 if (!drive->acpidata->obj_handle) {
 296                         DEBPRINT("No ACPI object found for %s\n",
 297                                  drive->name);
 298                         goto out;
 299                 }
 300         }
 301
 302         /* Setting up output buffer */
 303         output.length = ACPI_ALLOCATE_BUFFER;
 304         output.pointer = NULL;  /* ACPI-CA sets this; save/free it later */
 305
 306         /* _GTF has no input parameters */
 307         err = -EIO;
 308         status = acpi_evaluate_object(drive->acpidata->obj_handle, "_GTF",
 309                                       NULL, &output);
 310         if (ACPI_FAILURE(status)) {
 311                 printk(KERN_DEBUG
 312                        "%s: Run _GTF error: status = 0x%x\n",
 313                        __FUNCTION__, status);
 314                 goto out;
 315         }
 316
 317         if (!output.length || !output.pointer) {
 318                 DEBPRINT("Run _GTF: "
 319                        "length or ptr is NULL (0x%llx, 0x%p)\n",
 320                        (unsigned long long)output.length,
 321                        output.pointer);
 322                 goto out;
 323         }
 324
 325         out_obj = output.pointer;
 326         if (out_obj->type != ACPI_TYPE_BUFFER) {
 327                 DEBPRINT("Run _GTF: error: "
 328                        "expected object type of ACPI_TYPE_BUFFER, "
 329                        "got 0x%x\n", out_obj->type);
 330                 err = -ENOENT;
 331                 kfree(output.pointer);
 332                 goto out;
 333         }
 334
 335         if (!out_obj->buffer.length || !out_obj->buffer.pointer ||
 336             out_obj->buffer.length % REGS_PER_GTF) {
 337                 printk(KERN_ERR
 338                        "%s: unexpected GTF length (%d) or addr (0x%p)\n",
 339                        __FUNCTION__, out_obj->buffer.length,
 340                        out_obj->buffer.pointer);
 341                 err = -ENOENT;
 342                 kfree(output.pointer);
 343                 goto out;
 344         }
 345
 346         *gtf_length = out_obj->buffer.length;
 347         *gtf_address = (unsigned long)out_obj->buffer.pointer;
 348         *obj_loc = (unsigned long)out_obj;
 349         DEBPRINT("returning gtf_length=%d, gtf_address=0x%lx, obj_loc=0x%lx\n",
 350                  *gtf_length, *gtf_address, *obj_loc);
 351         err = 0;
 352 out:
 353         return err;
 354 }
 355
 356 /**
 357  * taskfile_load_raw - send taskfile registers to drive
 358  * @drive: drive to which output is sent
 359  * @gtf: raw ATA taskfile register set (0x1f1 - 0x1f7)
 360  *
 361  * Outputs IDE taskfile to the drive.
 362  */
 363 static int taskfile_load_raw(ide_drive_t *drive,
 364                               const struct taskfile_array *gtf)
 365 {
 366         ide_task_t args;
 367         int err = 0;
 368
 369         DEBPRINT("(0x1f1-1f7): hex: "
 370                "%02x %02x %02x %02x %02x %02x %02x\n",
 371                gtf->tfa[0], gtf->tfa[1], gtf->tfa[2],
 372                gtf->tfa[3], gtf->tfa[4], gtf->tfa[5], gtf->tfa[6]);
 373
 374         memset(&args, 0, sizeof(ide_task_t));
 375
 376         /* convert gtf to IDE Taskfile */
 377         memcpy(&args.tf_array[7], &gtf->tfa, 7);
 378         args.tf_flags = IDE_TFLAG_TF | IDE_TFLAG_DEVICE;
 379
 380         if (ide_noacpitfs) {
 381                 DEBPRINT("_GTF execution disabled\n");
 382                 return err;
 383         }
 384
 385         err = ide_no_data_taskfile(drive, &args);
 386         if (err)
 387                 printk(KERN_ERR "%s: ide_no_data_taskfile failed: %u\n",
 388                        __FUNCTION__, err);
 389
 390         return err;
 391 }
 392
 393 /**
 394  * do_drive_set_taskfiles - write the drive taskfile settings from _GTF
 395  * @drive: the drive to which the taskfile command should be sent
 396  * @gtf_length: total number of bytes of _GTF taskfiles
 397  * @gtf_address: location of _GTF taskfile arrays
 398  *
 399  * Write {gtf_address, length gtf_length} in groups of
 400  * REGS_PER_GTF bytes.
 401  */
 402 static int do_drive_set_taskfiles(ide_drive_t *drive,
 403                                   unsigned int gtf_length,
 404                                   unsigned long gtf_address)
 405 {
 406         int                     rc = -ENODEV, err;
 407         int                     gtf_count = gtf_length / REGS_PER_GTF;
 408         int                     ix;
 409         struct taskfile_array   *gtf;
 410
 411         if (ide_noacpi)
 412                 return 0;
 413
 414         DEBPRINT("ENTER: %s, hard_port#: %d\n", drive->name, drive->dn);
 415
 416         if (!drive->present)
 417                 goto out;
 418         if (!gtf_count)         /* shouldn't be here */
 419                 goto out;
 420
 421         DEBPRINT("total GTF bytes=%u (0x%x), gtf_count=%d, addr=0x%lx\n",
 422                  gtf_length, gtf_length, gtf_count, gtf_address);
 423
 424         if (gtf_length % REGS_PER_GTF) {
 425                 printk(KERN_ERR "%s: unexpected GTF length (%d)\n",
 426                        __FUNCTION__, gtf_length);
 427                 goto out;
 428         }
 429
 430         rc = 0;
 431         for (ix = 0; ix < gtf_count; ix++) {
 432                 gtf = (struct taskfile_array *)
 433                         (gtf_address + ix * REGS_PER_GTF);
 434
 435                 /* send all TaskFile registers (0x1f1-0x1f7) *in*that*order* */
 436                 err = taskfile_load_raw(drive, gtf);
 437                 if (err)
 438                         rc = err;
 439         }
 440
 441 out:
 442         return rc;
 443 }
 444
 445 /**
 446  * ide_acpi_exec_tfs - get then write drive taskfile settings
 447  * @drive: the drive for which the taskfile settings should be
 448  *         written.
 449  *
 450  * According to the ACPI spec this should be called after _STM
 451  * has been evaluated for the interface. Some ACPI vendors interpret
 452  * that as a hard requirement and modify the taskfile according
 453  * to the Identify Drive information passed down with _STM.
 454  * So one should really make sure to call this only after _STM has
 455  * been executed.
 456  */
 457 int ide_acpi_exec_tfs(ide_drive_t *drive)
 458 {
 459         int             ret;
 460         unsigned int    gtf_length;
 461         unsigned long   gtf_address;
 462         unsigned long   obj_loc;
 463
 464         if (ide_noacpi)
 465                 return 0;
 466
 467         DEBPRINT("call get_GTF, drive=%s port=%d\n", drive->name, drive->dn);
 468
 469         ret = do_drive_get_GTF(drive, &gtf_length, &gtf_address, &obj_loc);
 470         if (ret < 0) {
 471                 DEBPRINT("get_GTF error (%d)\n", ret);
 472                 return ret;
 473         }
 474
 475         DEBPRINT("call set_taskfiles, drive=%s\n", drive->name);
 476
 477         ret = do_drive_set_taskfiles(drive, gtf_length, gtf_address);
 478         kfree((void *)obj_loc);
 479         if (ret < 0) {
 480                 DEBPRINT("set_taskfiles error (%d)\n", ret);
 481         }
 482
 483         DEBPRINT("ret=%d\n", ret);
 484
 485         return ret;
 486 }
 487
 488 /**
 489  * ide_acpi_get_timing - get the channel (controller) timings
 490  * @hwif: target IDE interface (channel)
 491  *
 492  * This function executes the _GTM ACPI method for the target channel.
 493  *
 494  */
 495 void ide_acpi_get_timing(ide_hwif_t *hwif)
 496 {
 497         acpi_status             status;
 498         struct acpi_buffer      output;
 499         union acpi_object       *out_obj;
 500
 501         if (ide_noacpi)
 502                 return;
 503
 504         DEBPRINT("ENTER:\n");
 505
 506         if (!hwif->acpidata) {
 507                 DEBPRINT("no ACPI data for %s\n", hwif->name);
 508                 return;
 509         }
 510
 511         /* Setting up output buffer for _GTM */
 512         output.length = ACPI_ALLOCATE_BUFFER;
 513         output.pointer = NULL;  /* ACPI-CA sets this; save/free it later */
 514
 515         /* _GTM has no input parameters */
 516         status = acpi_evaluate_object(hwif->acpidata->obj_handle, "_GTM",
 517                                       NULL, &output);
 518
 519         DEBPRINT("_GTM status: %d, outptr: 0x%p, outlen: 0x%llx\n",
 520                  status, output.pointer,
 521                  (unsigned long long)output.length);
 522
 523         if (ACPI_FAILURE(status)) {
 524                 DEBPRINT("Run _GTM error: status = 0x%x\n", status);
 525                 return;
 526         }
 527
 528         if (!output.length || !output.pointer) {
 529                 DEBPRINT("Run _GTM: length or ptr is NULL (0x%llx, 0x%p)\n",
 530                        (unsigned long long)output.length,
 531                        output.pointer);
 532                 kfree(output.pointer);
 533                 return;
 534         }
 535
 536         out_obj = output.pointer;
 537         if (out_obj->type != ACPI_TYPE_BUFFER) {
 538                 kfree(output.pointer);
 539                 DEBPRINT("Run _GTM: error: "
 540                        "expected object type of ACPI_TYPE_BUFFER, "
 541                        "got 0x%x\n", out_obj->type);
 542                 return;
 543         }
 544
 545         if (!out_obj->buffer.length || !out_obj->buffer.pointer ||
 546             out_obj->buffer.length != sizeof(struct GTM_buffer)) {
 547                 kfree(output.pointer);
 548                 printk(KERN_ERR
 549                         "%s: unexpected _GTM length (0x%x)[should be 0x%zx] or "
 550                         "addr (0x%p)\n",
 551                         __FUNCTION__, out_obj->buffer.length,
 552                         sizeof(struct GTM_buffer), out_obj->buffer.pointer);
 553                 return;
 554         }
 555
 556         memcpy(&hwif->acpidata->gtm, out_obj->buffer.pointer,
 557                sizeof(struct GTM_buffer));
 558
 559         DEBPRINT("_GTM info: ptr: 0x%p, len: 0x%x, exp.len: 0x%Zx\n",
 560                  out_obj->buffer.pointer, out_obj->buffer.length,
 561                  sizeof(struct GTM_buffer));
 562
 563         DEBPRINT("_GTM fields: 0x%x, 0x%x, 0x%x, 0x%x, 0x%x\n",
 564                  hwif->acpidata->gtm.PIO_speed0,
 565                  hwif->acpidata->gtm.DMA_speed0,
 566                  hwif->acpidata->gtm.PIO_speed1,
 567                  hwif->acpidata->gtm.DMA_speed1,
 568                  hwif->acpidata->gtm.GTM_flags);
 569
 570         kfree(output.pointer);
 571 }
 572
 573 /**
 574  * ide_acpi_push_timing - set the channel (controller) timings
 575  * @hwif: target IDE interface (channel)
 576  *
 577  * This function executes the _STM ACPI method for the target channel.
 578  *
 579  * _STM requires Identify Drive data, which has to passed as an argument.
 580  * Unfortunately hd_driveid is a mangled version which we can't readily
 581  * use; hence we'll get the information afresh.
 582  */
 583 void ide_acpi_push_timing(ide_hwif_t *hwif)
 584 {
 585         acpi_status             status;
 586         struct acpi_object_list input;
 587         union acpi_object       in_params[3];
 588         struct ide_acpi_drive_link      *master = &hwif->acpidata->master;
 589         struct ide_acpi_drive_link      *slave = &hwif->acpidata->slave;
 590
 591         if (ide_noacpi)
 592                 return;
 593
 594         DEBPRINT("ENTER:\n");
 595
 596         if (!hwif->acpidata) {
 597                 DEBPRINT("no ACPI data for %s\n", hwif->name);
 598                 return;
 599         }
 600
 601         /* Give the GTM buffer + drive Identify data to the channel via the
 602          * _STM method: */
 603         /* setup input parameters buffer for _STM */
 604         input.count = 3;
 605         input.pointer = in_params;
 606         in_params[0].type = ACPI_TYPE_BUFFER;
 607         in_params[0].buffer.length = sizeof(struct GTM_buffer);
 608         in_params[0].buffer.pointer = (u8 *)&hwif->acpidata->gtm;
 609         in_params[1].type = ACPI_TYPE_BUFFER;
 610         in_params[1].buffer.length = sizeof(struct hd_driveid);
 611         in_params[1].buffer.pointer = (u8 *)&master->idbuff;
 612         in_params[2].type = ACPI_TYPE_BUFFER;
 613         in_params[2].buffer.length = sizeof(struct hd_driveid);
 614         in_params[2].buffer.pointer = (u8 *)&slave->idbuff;
 615         /* Output buffer: _STM has no output */
 616
 617         status = acpi_evaluate_object(hwif->acpidata->obj_handle, "_STM",
 618                                       &input, NULL);
 619
 620         if (ACPI_FAILURE(status)) {
 621                 DEBPRINT("Run _STM error: status = 0x%x\n", status);
 622         }
 623         DEBPRINT("_STM status: %d\n", status);
 624 }
 625
 626 /**
 627  * ide_acpi_set_state - set the channel power state
 628  * @hwif: target IDE interface
 629  * @on: state, on/off
 630  *
 631  * This function executes the _PS0/_PS3 ACPI method to set the power state.
 632  * ACPI spec requires _PS0 when IDE power on and _PS3 when power off
 633  */
 634 void ide_acpi_set_state(ide_hwif_t *hwif, int on)
 635 {
 636         int unit;
 637
 638         if (ide_noacpi || ide_noacpi_psx)
 639                 return;
 640
 641         DEBPRINT("ENTER:\n");
 642
 643         if (!hwif->acpidata) {
 644                 DEBPRINT("no ACPI data for %s\n", hwif->name);
 645                 return;
 646         }
 647         /* channel first and then drives for power on and verse versa for power off */
 648         if (on)
 649                 acpi_bus_set_power(hwif->acpidata->obj_handle, ACPI_STATE_D0);
 650         for (unit = 0; unit < MAX_DRIVES; ++unit) {
 651                 ide_drive_t *drive = &hwif->drives[unit];
 652
 653                 if (!drive->acpidata->obj_handle)
 654                         drive->acpidata->obj_handle = ide_acpi_drive_get_handle(drive);
 655
 656                 if (drive->acpidata->obj_handle && drive->present) {
 657                         acpi_bus_set_power(drive->acpidata->obj_handle,
 658                                 on? ACPI_STATE_D0: ACPI_STATE_D3);
 659                 }
 660         }
 661         if (!on)
 662                 acpi_bus_set_power(hwif->acpidata->obj_handle, ACPI_STATE_D3);
 663 }
 664
 665 /**
 666  * ide_acpi_init - initialize the ACPI link for an IDE interface
 667  * @hwif: target IDE interface (channel)
 668  *
 669  * The ACPI spec is not quite clear when the drive identify buffer
 670  * should be obtained. Calling IDENTIFY DEVICE during shutdown
 671  * is not the best of ideas as the drive might already being put to
 672  * sleep. And obviously we can't call it during resume.
 673  * So we get the information during startup; but this means that
 674  * any changes during run-time will be lost after resume.
 675  */
 676 void ide_acpi_init(ide_hwif_t *hwif)
 677 {
 678         int unit;
 679         int                     err;
 680         struct ide_acpi_drive_link      *master;
 681         struct ide_acpi_drive_link      *slave;
 682
 683         ide_acpi_blacklist();
 684
 685         hwif->acpidata = kzalloc(sizeof(struct ide_acpi_hwif_link), GFP_KERNEL);
 686         if (!hwif->acpidata)
 687                 return;
 688
 689         hwif->acpidata->obj_handle = ide_acpi_hwif_get_handle(hwif);
 690         if (!hwif->acpidata->obj_handle) {
 691                 DEBPRINT("no ACPI object for %s found\n", hwif->name);
 692                 kfree(hwif->acpidata);
 693                 hwif->acpidata = NULL;
 694                 return;
 695         }
 696
 697         /*
 698          * The ACPI spec mandates that we send information
 699          * for both drives, regardless whether they are connected
 700          * or not.
 701          */
 702         hwif->acpidata->master.drive = &hwif->drives[0];
 703         hwif->drives[0].acpidata = &hwif->acpidata->master;
 704         master = &hwif->acpidata->master;
 705
 706         hwif->acpidata->slave.drive = &hwif->drives[1];
 707         hwif->drives[1].acpidata = &hwif->acpidata->slave;
 708         slave = &hwif->acpidata->slave;
 709
 710
 711         /*
 712          * Send IDENTIFY for each drive
 713          */
 714         if (master->drive->present) {
 715                 err = taskfile_lib_get_identify(master->drive, master->idbuff);
 716                 if (err) {
 717                         DEBPRINT("identify device %s failed (%d)\n",
 718                                  master->drive->name, err);
 719                 }
 720         }
 721
 722         if (slave->drive->present) {
 723                 err = taskfile_lib_get_identify(slave->drive, slave->idbuff);
 724                 if (err) {
 725                         DEBPRINT("identify device %s failed (%d)\n",
 726                                  slave->drive->name, err);
 727                 }
 728         }
 729
 730         if (ide_noacpionboot) {
 731                 DEBPRINT("ACPI methods disabled on boot\n");
 732                 return;
 733         }
 734
 735         /* ACPI _PS0 before _STM */
 736         ide_acpi_set_state(hwif, 1);
 737         /*
 738          * ACPI requires us to call _STM on startup
 739          */
 740         ide_acpi_get_timing(hwif);
 741         ide_acpi_push_timing(hwif);
 742
 743         for (unit = 0; unit < MAX_DRIVES; ++unit) {
 744                 ide_drive_t *drive = &hwif->drives[unit];
 745
 746                 if (drive->present) {
 747                         /* Execute ACPI startup code */
 748                         ide_acpi_exec_tfs(drive);
 749                 }
 750         }
 751 }