drivers/macintosh/mediabay.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * Driver for the media bay on the PowerBook 3400 and 2400.
   4  *
   5  * Copyright (C) 1998 Paul Mackerras.
   6  *
   7  * Various evolutions by Benjamin Herrenschmidt & Henry Worth
   8  */
   9 #include <linux/types.h>
  10 #include <linux/errno.h>
  11 #include <linux/kernel.h>
  12 #include <linux/delay.h>
  13 #include <linux/sched.h>
  14 #include <linux/timer.h>
  15 #include <linux/stddef.h>
  16 #include <linux/init.h>
  17 #include <linux/kthread.h>
  18 #include <linux/mutex.h>
  19 #include <linux/pgtable.h>
  20
  21 #include <asm/io.h>
  22 #include <asm/machdep.h>
  23 #include <asm/pmac_feature.h>
  24 #include <asm/mediabay.h>
  25 #include <asm/sections.h>
  26 #include <asm/ohare.h>
  27 #include <asm/heathrow.h>
  28 #include <asm/keylargo.h>
  29 #include <linux/adb.h>
  30 #include <linux/pmu.h>
  31
  32 #define MB_FCR32(bay, r)        ((bay)->base + ((r) >> 2))
  33 #define MB_FCR8(bay, r)         (((volatile u8 __iomem *)((bay)->base)) + (r))
  34
  35 #define MB_IN32(bay,r)          (in_le32(MB_FCR32(bay,r)))
  36 #define MB_OUT32(bay,r,v)       (out_le32(MB_FCR32(bay,r), (v)))
  37 #define MB_BIS(bay,r,v)         (MB_OUT32((bay), (r), MB_IN32((bay), r) | (v)))
  38 #define MB_BIC(bay,r,v)         (MB_OUT32((bay), (r), MB_IN32((bay), r) & ~(v)))
  39 #define MB_IN8(bay,r)           (in_8(MB_FCR8(bay,r)))
  40 #define MB_OUT8(bay,r,v)        (out_8(MB_FCR8(bay,r), (v)))
  41
  42 struct media_bay_info;
  43
  44 struct mb_ops {
  45         char*   name;
  46         void    (*init)(struct media_bay_info *bay);
  47         u8      (*content)(struct media_bay_info *bay);
  48         void    (*power)(struct media_bay_info *bay, int on_off);
  49         int     (*setup_bus)(struct media_bay_info *bay, u8 device_id);
  50         void    (*un_reset)(struct media_bay_info *bay);
  51         void    (*un_reset_ide)(struct media_bay_info *bay);
  52 };
  53
  54 struct media_bay_info {
  55         u32 __iomem                     *base;
  56         int                             content_id;
  57         int                             state;
  58         int                             last_value;
  59         int                             value_count;
  60         int                             timer;
  61         struct macio_dev                *mdev;
  62         const struct mb_ops*            ops;
  63         int                             index;
  64         int                             cached_gpio;
  65         int                             sleeping;
  66         int                             user_lock;
  67         struct mutex                    lock;
  68 };
  69
  70 #define MAX_BAYS        2
  71
  72 static struct media_bay_info media_bays[MAX_BAYS];
  73 static int media_bay_count = 0;
  74
  75 /*
  76  * Wait that number of ms between each step in normal polling mode
  77  */
  78 #define MB_POLL_DELAY   25
  79
  80 /*
  81  * Consider the media-bay ID value stable if it is the same for
  82  * this number of milliseconds
  83  */
  84 #define MB_STABLE_DELAY 100
  85
  86 /* Wait after powering up the media bay this delay in ms
  87  * timeout bumped for some powerbooks
  88  */
  89 #define MB_POWER_DELAY  200
  90
  91 /*
  92  * Hold the media-bay reset signal true for this many ticks
  93  * after a device is inserted before releasing it.
  94  */
  95 #define MB_RESET_DELAY  50
  96
  97 /*
  98  * Wait this long after the reset signal is released and before doing
  99  * further operations. After this delay, the IDE reset signal is released
 100  * too for an IDE device
 101  */
 102 #define MB_SETUP_DELAY  100
 103
 104 /*
 105  * Wait this many ticks after an IDE device (e.g. CD-ROM) is inserted
 106  * (or until the device is ready) before calling into the driver
 107  */
 108 #define MB_IDE_WAIT     1000
 109
 110 /*
 111  * States of a media bay
 112  */
 113 enum {
 114         mb_empty = 0,           /* Idle */
 115         mb_powering_up,         /* power bit set, waiting MB_POWER_DELAY */
 116         mb_enabling_bay,        /* enable bits set, waiting MB_RESET_DELAY */
 117         mb_resetting,           /* reset bit unset, waiting MB_SETUP_DELAY */
 118         mb_ide_resetting,       /* IDE reset bit unser, waiting MB_IDE_WAIT */
 119         mb_up,                  /* Media bay full */
 120         mb_powering_down        /* Powering down (avoid too fast down/up) */
 121 };
 122
 123 #define MB_POWER_SOUND          0x08
 124 #define MB_POWER_FLOPPY         0x04
 125 #define MB_POWER_ATA            0x02
 126 #define MB_POWER_PCI            0x01
 127 #define MB_POWER_OFF            0x00
 128
 129 /*
 130  * Functions for polling content of media bay
 131  */
 132
 133 static u8
 134 ohare_mb_content(struct media_bay_info *bay)
 135 {
 136         return (MB_IN32(bay, OHARE_MBCR) >> 12) & 7;
 137 }
 138
 139 static u8
 140 heathrow_mb_content(struct media_bay_info *bay)
 141 {
 142         return (MB_IN32(bay, HEATHROW_MBCR) >> 12) & 7;
 143 }
 144
 145 static u8
 146 keylargo_mb_content(struct media_bay_info *bay)
 147 {
 148         int new_gpio;
 149
 150         new_gpio = MB_IN8(bay, KL_GPIO_MEDIABAY_IRQ) & KEYLARGO_GPIO_INPUT_DATA;
 151         if (new_gpio) {
 152                 bay->cached_gpio = new_gpio;
 153                 return MB_NO;
 154         } else if (bay->cached_gpio != new_gpio) {
 155                 MB_BIS(bay, KEYLARGO_MBCR, KL_MBCR_MB0_ENABLE);
 156                 (void)MB_IN32(bay, KEYLARGO_MBCR);
 157                 udelay(5);
 158                 MB_BIC(bay, KEYLARGO_MBCR, 0x0000000F);
 159                 (void)MB_IN32(bay, KEYLARGO_MBCR);
 160                 udelay(5);
 161                 bay->cached_gpio = new_gpio;
 162         }
 163         return (MB_IN32(bay, KEYLARGO_MBCR) >> 4) & 7;
 164 }
 165
 166 /*
 167  * Functions for powering up/down the bay, puts the bay device
 168  * into reset state as well
 169  */
 170
 171 static void
 172 ohare_mb_power(struct media_bay_info* bay, int on_off)
 173 {
 174         if (on_off) {
 175                 /* Power up device, assert it's reset line */
 176                 MB_BIC(bay, OHARE_FCR, OH_BAY_RESET_N);
 177                 MB_BIC(bay, OHARE_FCR, OH_BAY_POWER_N);
 178         } else {
 179                 /* Disable all devices */
 180                 MB_BIC(bay, OHARE_FCR, OH_BAY_DEV_MASK);
 181                 MB_BIC(bay, OHARE_FCR, OH_FLOPPY_ENABLE);
 182                 /* Cut power from bay, release reset line */
 183                 MB_BIS(bay, OHARE_FCR, OH_BAY_POWER_N);
 184                 MB_BIS(bay, OHARE_FCR, OH_BAY_RESET_N);
 185                 MB_BIS(bay, OHARE_FCR, OH_IDE1_RESET_N);
 186         }
 187         MB_BIC(bay, OHARE_MBCR, 0x00000F00);
 188 }
 189
 190 static void
 191 heathrow_mb_power(struct media_bay_info* bay, int on_off)
 192 {
 193         if (on_off) {
 194                 /* Power up device, assert it's reset line */
 195                 MB_BIC(bay, HEATHROW_FCR, HRW_BAY_RESET_N);
 196                 MB_BIC(bay, HEATHROW_FCR, HRW_BAY_POWER_N);
 197         } else {
 198                 /* Disable all devices */
 199                 MB_BIC(bay, HEATHROW_FCR, HRW_BAY_DEV_MASK);
 200                 MB_BIC(bay, HEATHROW_FCR, HRW_SWIM_ENABLE);
 201                 /* Cut power from bay, release reset line */
 202                 MB_BIS(bay, HEATHROW_FCR, HRW_BAY_POWER_N);
 203                 MB_BIS(bay, HEATHROW_FCR, HRW_BAY_RESET_N);
 204                 MB_BIS(bay, HEATHROW_FCR, HRW_IDE1_RESET_N);
 205         }
 206         MB_BIC(bay, HEATHROW_MBCR, 0x00000F00);
 207 }
 208
 209 static void
 210 keylargo_mb_power(struct media_bay_info* bay, int on_off)
 211 {
 212         if (on_off) {
 213                 /* Power up device, assert it's reset line */
 214                 MB_BIC(bay, KEYLARGO_MBCR, KL_MBCR_MB0_DEV_RESET);
 215                 MB_BIC(bay, KEYLARGO_MBCR, KL_MBCR_MB0_DEV_POWER);
 216         } else {
 217                 /* Disable all devices */
 218                 MB_BIC(bay, KEYLARGO_MBCR, KL_MBCR_MB0_DEV_MASK);
 219                 MB_BIC(bay, KEYLARGO_FCR1, KL1_EIDE0_ENABLE);
 220                 /* Cut power from bay, release reset line */
 221                 MB_BIS(bay, KEYLARGO_MBCR, KL_MBCR_MB0_DEV_POWER);
 222                 MB_BIS(bay, KEYLARGO_MBCR, KL_MBCR_MB0_DEV_RESET);
 223                 MB_BIS(bay, KEYLARGO_FCR1, KL1_EIDE0_RESET_N);
 224         }
 225         MB_BIC(bay, KEYLARGO_MBCR, 0x0000000F);
 226 }
 227
 228 /*
 229  * Functions for configuring the media bay for a given type of device,
 230  * enable the related busses
 231  */
 232
 233 static int
 234 ohare_mb_setup_bus(struct media_bay_info* bay, u8 device_id)
 235 {
 236         switch(device_id) {
 237                 case MB_FD:
 238                 case MB_FD1:
 239                         MB_BIS(bay, OHARE_FCR, OH_BAY_FLOPPY_ENABLE);
 240                         MB_BIS(bay, OHARE_FCR, OH_FLOPPY_ENABLE);
 241                         return 0;
 242                 case MB_CD:
 243                         MB_BIC(bay, OHARE_FCR, OH_IDE1_RESET_N);
 244                         MB_BIS(bay, OHARE_FCR, OH_BAY_IDE_ENABLE);
 245                         return 0;
 246                 case MB_PCI:
 247                         MB_BIS(bay, OHARE_FCR, OH_BAY_PCI_ENABLE);
 248                         return 0;
 249         }
 250         return -ENODEV;
 251 }
 252
 253 static int
 254 heathrow_mb_setup_bus(struct media_bay_info* bay, u8 device_id)
 255 {
 256         switch(device_id) {
 257                 case MB_FD:
 258                 case MB_FD1:
 259                         MB_BIS(bay, HEATHROW_FCR, HRW_BAY_FLOPPY_ENABLE);
 260                         MB_BIS(bay, HEATHROW_FCR, HRW_SWIM_ENABLE);
 261                         return 0;
 262                 case MB_CD:
 263                         MB_BIC(bay, HEATHROW_FCR, HRW_IDE1_RESET_N);
 264                         MB_BIS(bay, HEATHROW_FCR, HRW_BAY_IDE_ENABLE);
 265                         return 0;
 266                 case MB_PCI:
 267                         MB_BIS(bay, HEATHROW_FCR, HRW_BAY_PCI_ENABLE);
 268                         return 0;
 269         }
 270         return -ENODEV;
 271 }
 272
 273 static int
 274 keylargo_mb_setup_bus(struct media_bay_info* bay, u8 device_id)
 275 {
 276         switch(device_id) {
 277                 case MB_CD:
 278                         MB_BIS(bay, KEYLARGO_MBCR, KL_MBCR_MB0_IDE_ENABLE);
 279                         MB_BIC(bay, KEYLARGO_FCR1, KL1_EIDE0_RESET_N);
 280                         MB_BIS(bay, KEYLARGO_FCR1, KL1_EIDE0_ENABLE);
 281                         return 0;
 282                 case MB_PCI:
 283                         MB_BIS(bay, KEYLARGO_MBCR, KL_MBCR_MB0_PCI_ENABLE);
 284                         return 0;
 285                 case MB_SOUND:
 286                         MB_BIS(bay, KEYLARGO_MBCR, KL_MBCR_MB0_SOUND_ENABLE);
 287                         return 0;
 288         }
 289         return -ENODEV;
 290 }
 291
 292 /*
 293  * Functions for tweaking resets
 294  */
 295
 296 static void
 297 ohare_mb_un_reset(struct media_bay_info* bay)
 298 {
 299         MB_BIS(bay, OHARE_FCR, OH_BAY_RESET_N);
 300 }
 301
 302 static void keylargo_mb_init(struct media_bay_info *bay)
 303 {
 304         MB_BIS(bay, KEYLARGO_MBCR, KL_MBCR_MB0_ENABLE);
 305 }
 306
 307 static void heathrow_mb_un_reset(struct media_bay_info* bay)
 308 {
 309         MB_BIS(bay, HEATHROW_FCR, HRW_BAY_RESET_N);
 310 }
 311
 312 static void keylargo_mb_un_reset(struct media_bay_info* bay)
 313 {
 314         MB_BIS(bay, KEYLARGO_MBCR, KL_MBCR_MB0_DEV_RESET);
 315 }
 316
 317 static void ohare_mb_un_reset_ide(struct media_bay_info* bay)
 318 {
 319         MB_BIS(bay, OHARE_FCR, OH_IDE1_RESET_N);
 320 }
 321
 322 static void heathrow_mb_un_reset_ide(struct media_bay_info* bay)
 323 {
 324         MB_BIS(bay, HEATHROW_FCR, HRW_IDE1_RESET_N);
 325 }
 326
 327 static void keylargo_mb_un_reset_ide(struct media_bay_info* bay)
 328 {
 329         MB_BIS(bay, KEYLARGO_FCR1, KL1_EIDE0_RESET_N);
 330 }
 331
 332 static inline void set_mb_power(struct media_bay_info* bay, int onoff)
 333 {
 334         /* Power up up and assert the bay reset line */
 335         if (onoff) {
 336                 bay->ops->power(bay, 1);
 337                 bay->state = mb_powering_up;
 338                 pr_debug("mediabay%d: powering up\n", bay->index);
 339         } else {
 340                 /* Make sure everything is powered down & disabled */
 341                 bay->ops->power(bay, 0);
 342                 bay->state = mb_powering_down;
 343                 pr_debug("mediabay%d: powering down\n", bay->index);
 344         }
 345         bay->timer = msecs_to_jiffies(MB_POWER_DELAY);
 346 }
 347
 348 static void poll_media_bay(struct media_bay_info* bay)
 349 {
 350         int id = bay->ops->content(bay);
 351
 352         static char *mb_content_types[] = {
 353                 "a floppy drive",
 354                 "a floppy drive",
 355                 "an unsupported audio device",
 356                 "an ATA device",
 357                 "an unsupported PCI device",
 358                 "an unknown device",
 359         };
 360
 361         if (id != bay->last_value) {
 362                 bay->last_value = id;
 363                 bay->value_count = 0;
 364                 return;
 365         }
 366         if (id == bay->content_id)
 367                 return;
 368
 369         bay->value_count += msecs_to_jiffies(MB_POLL_DELAY);
 370         if (bay->value_count >= msecs_to_jiffies(MB_STABLE_DELAY)) {
 371                 /* If the device type changes without going thru
 372                  * "MB_NO", we force a pass by "MB_NO" to make sure
 373                  * things are properly reset
 374                  */
 375                 if ((id != MB_NO) && (bay->content_id != MB_NO)) {
 376                         id = MB_NO;
 377                         pr_debug("mediabay%d: forcing MB_NO\n", bay->index);
 378                 }
 379                 pr_debug("mediabay%d: switching to %d\n", bay->index, id);
 380                 set_mb_power(bay, id != MB_NO);
 381                 bay->content_id = id;
 382                 if (id >= MB_NO || id < 0)
 383                         printk(KERN_INFO "mediabay%d: Bay is now empty\n", bay->index);
 384                 else
 385                         printk(KERN_INFO "mediabay%d: Bay contains %s\n",
 386                                bay->index, mb_content_types[id]);
 387         }
 388 }
 389
 390 int check_media_bay(struct macio_dev *baydev)
 391 {
 392         struct media_bay_info* bay;
 393         int id;
 394
 395         if (baydev == NULL)
 396                 return MB_NO;
 397
 398         /* This returns an instant snapshot, not locking, sine
 399          * we may be called with the bay lock held. The resulting
 400          * fuzzyness of the result if called at the wrong time is
 401          * not actually a huge deal
 402          */
 403         bay = macio_get_drvdata(baydev);
 404         if (bay == NULL)
 405                 return MB_NO;
 406         id = bay->content_id;
 407         if (bay->state != mb_up)
 408                 return MB_NO;
 409         if (id == MB_FD1)
 410                 return MB_FD;
 411         return id;
 412 }
 413 EXPORT_SYMBOL_GPL(check_media_bay);
 414
 415 void lock_media_bay(struct macio_dev *baydev)
 416 {
 417         struct media_bay_info* bay;
 418
 419         if (baydev == NULL)
 420                 return;
 421         bay = macio_get_drvdata(baydev);
 422         if (bay == NULL)
 423                 return;
 424         mutex_lock(&bay->lock);
 425         bay->user_lock = 1;
 426 }
 427 EXPORT_SYMBOL_GPL(lock_media_bay);
 428
 429 void unlock_media_bay(struct macio_dev *baydev)
 430 {
 431         struct media_bay_info* bay;
 432
 433         if (baydev == NULL)
 434                 return;
 435         bay = macio_get_drvdata(baydev);
 436         if (bay == NULL)
 437                 return;
 438         if (bay->user_lock) {
 439                 bay->user_lock = 0;
 440                 mutex_unlock(&bay->lock);
 441         }
 442 }
 443 EXPORT_SYMBOL_GPL(unlock_media_bay);
 444
 445 static int mb_broadcast_hotplug(struct device *dev, void *data)
 446 {
 447         struct media_bay_info* bay = data;
 448         struct macio_dev *mdev;
 449         struct macio_driver *drv;
 450         int state;
 451
 452         if (dev->bus != &macio_bus_type)
 453                 return 0;
 454
 455         state = bay->state == mb_up ? bay->content_id : MB_NO;
 456         if (state == MB_FD1)
 457                 state = MB_FD;
 458         mdev = to_macio_device(dev);
 459         drv = to_macio_driver(dev->driver);
 460         if (dev->driver && drv->mediabay_event)
 461                 drv->mediabay_event(mdev, state);
 462         return 0;
 463 }
 464
 465 static void media_bay_step(int i)
 466 {
 467         struct media_bay_info* bay = &media_bays[i];
 468
 469         /* We don't poll when powering down */
 470         if (bay->state != mb_powering_down)
 471             poll_media_bay(bay);
 472
 473         /* If timer expired run state machine */
 474         if (bay->timer != 0) {
 475                 bay->timer -= msecs_to_jiffies(MB_POLL_DELAY);
 476                 if (bay->timer > 0)
 477                         return;
 478                 bay->timer = 0;
 479         }
 480
 481         switch(bay->state) {
 482         case mb_powering_up:
 483                 if (bay->ops->setup_bus(bay, bay->last_value) < 0) {
 484                         pr_debug("mediabay%d: device not supported (kind:%d)\n",
 485                                  i, bay->content_id);
 486                         set_mb_power(bay, 0);
 487                         break;
 488                 }
 489                 bay->timer = msecs_to_jiffies(MB_RESET_DELAY);
 490                 bay->state = mb_enabling_bay;
 491                 pr_debug("mediabay%d: enabling (kind:%d)\n", i, bay->content_id);
 492                 break;
 493         case mb_enabling_bay:
 494                 bay->ops->un_reset(bay);
 495                 bay->timer = msecs_to_jiffies(MB_SETUP_DELAY);
 496                 bay->state = mb_resetting;
 497                 pr_debug("mediabay%d: releasing bay reset (kind:%d)\n",
 498                          i, bay->content_id);
 499                 break;
 500         case mb_resetting:
 501                 if (bay->content_id != MB_CD) {
 502                         pr_debug("mediabay%d: bay is up (kind:%d)\n", i,
 503                                  bay->content_id);
 504                         bay->state = mb_up;
 505                         device_for_each_child(&bay->mdev->ofdev.dev,
 506                                               bay, mb_broadcast_hotplug);
 507                         break;
 508                 }
 509                 pr_debug("mediabay%d: releasing ATA reset (kind:%d)\n",
 510                          i, bay->content_id);
 511                 bay->ops->un_reset_ide(bay);
 512                 bay->timer = msecs_to_jiffies(MB_IDE_WAIT);
 513                 bay->state = mb_ide_resetting;
 514                 break;
 515
 516         case mb_ide_resetting:
 517                 pr_debug("mediabay%d: bay is up (kind:%d)\n", i, bay->content_id);
 518                 bay->state = mb_up;
 519                 device_for_each_child(&bay->mdev->ofdev.dev,
 520                                       bay, mb_broadcast_hotplug);
 521                 break;
 522
 523         case mb_powering_down:
 524                 bay->state = mb_empty;
 525                 device_for_each_child(&bay->mdev->ofdev.dev,
 526                                       bay, mb_broadcast_hotplug);
 527                 pr_debug("mediabay%d: end of power down\n", i);
 528                 break;
 529         }
 530 }
 531
 532 /*
 533  * This procedure runs as a kernel thread to poll the media bay
 534  * once each tick and register and unregister the IDE interface
 535  * with the IDE driver.  It needs to be a thread because
 536  * ide_register can't be called from interrupt context.
 537  */
 538 static int media_bay_task(void *x)
 539 {
 540         int     i;
 541
 542         while (!kthread_should_stop()) {
 543                 for (i = 0; i < media_bay_count; ++i) {
 544                         mutex_lock(&media_bays[i].lock);
 545                         if (!media_bays[i].sleeping)
 546                                 media_bay_step(i);
 547                         mutex_unlock(&media_bays[i].lock);
 548                 }
 549
 550                 msleep_interruptible(MB_POLL_DELAY);
 551         }
 552         return 0;
 553 }
 554
 555 static int media_bay_attach(struct macio_dev *mdev,
 556                             const struct of_device_id *match)
 557 {
 558         struct media_bay_info* bay;
 559         u32 __iomem *regbase;
 560         struct device_node *ofnode;
 561         unsigned long base;
 562         int i;
 563
 564         ofnode = mdev->ofdev.dev.of_node;
 565
 566         if (macio_resource_count(mdev) < 1)
 567                 return -ENODEV;
 568         if (macio_request_resources(mdev, "media-bay"))
 569                 return -EBUSY;
 570         /* Media bay registers are located at the beginning of the
 571          * mac-io chip, for now, we trick and align down the first
 572          * resource passed in
 573          */
 574         base = macio_resource_start(mdev, 0) & 0xffff0000u;
 575         regbase = (u32 __iomem *)ioremap(base, 0x100);
 576         if (regbase == NULL) {
 577                 macio_release_resources(mdev);
 578                 return -ENOMEM;
 579         }
 580
 581         i = media_bay_count++;
 582         bay = &media_bays[i];
 583         bay->mdev = mdev;
 584         bay->base = regbase;
 585         bay->index = i;
 586         bay->ops = match->data;
 587         bay->sleeping = 0;
 588         mutex_init(&bay->lock);
 589
 590         /* Init HW probing */
 591         if (bay->ops->init)
 592                 bay->ops->init(bay);
 593
 594         printk(KERN_INFO "mediabay%d: Registered %s media-bay\n", i, bay->ops->name);
 595
 596         /* Force an immediate detect */
 597         set_mb_power(bay, 0);
 598         msleep(MB_POWER_DELAY);
 599         bay->content_id = MB_NO;
 600         bay->last_value = bay->ops->content(bay);
 601         bay->value_count = msecs_to_jiffies(MB_STABLE_DELAY);
 602         bay->state = mb_empty;
 603
 604         /* Mark us ready by filling our mdev data */
 605         macio_set_drvdata(mdev, bay);
 606
 607         /* Startup kernel thread */
 608         if (i == 0)
 609                 kthread_run(media_bay_task, NULL, "media-bay");
 610
 611         return 0;
 612
 613 }
 614
 615 static int media_bay_suspend(struct macio_dev *mdev, pm_message_t state)
 616 {
 617         struct media_bay_info   *bay = macio_get_drvdata(mdev);
 618
 619         if (state.event != mdev->ofdev.dev.power.power_state.event
 620             && (state.event & PM_EVENT_SLEEP)) {
 621                 mutex_lock(&bay->lock);
 622                 bay->sleeping = 1;
 623                 set_mb_power(bay, 0);
 624                 mutex_unlock(&bay->lock);
 625                 msleep(MB_POLL_DELAY);
 626                 mdev->ofdev.dev.power.power_state = state;
 627         }
 628         return 0;
 629 }
 630
 631 static int media_bay_resume(struct macio_dev *mdev)
 632 {
 633         struct media_bay_info   *bay = macio_get_drvdata(mdev);
 634
 635         if (mdev->ofdev.dev.power.power_state.event != PM_EVENT_ON) {
 636                 mdev->ofdev.dev.power.power_state = PMSG_ON;
 637
 638                 /* We re-enable the bay using it's previous content
 639                    only if it did not change. Note those bozo timings,
 640                    they seem to help the 3400 get it right.
 641                  */
 642                 /* Force MB power to 0 */
 643                 mutex_lock(&bay->lock);
 644                 set_mb_power(bay, 0);
 645                 msleep(MB_POWER_DELAY);
 646                 if (bay->ops->content(bay) != bay->content_id) {
 647                         printk("mediabay%d: Content changed during sleep...\n", bay->index);
 648                         mutex_unlock(&bay->lock);
 649                         return 0;
 650                 }
 651                 set_mb_power(bay, 1);
 652                 bay->last_value = bay->content_id;
 653                 bay->value_count = msecs_to_jiffies(MB_STABLE_DELAY);
 654                 bay->timer = msecs_to_jiffies(MB_POWER_DELAY);
 655                 do {
 656                         msleep(MB_POLL_DELAY);
 657                         media_bay_step(bay->index);
 658                 } while((bay->state != mb_empty) &&
 659                         (bay->state != mb_up));
 660                 bay->sleeping = 0;
 661                 mutex_unlock(&bay->lock);
 662         }
 663         return 0;
 664 }
 665
 666
 667 /* Definitions of "ops" structures.
 668  */
 669 static const struct mb_ops ohare_mb_ops = {
 670         .name           = "Ohare",
 671         .content        = ohare_mb_content,
 672         .power          = ohare_mb_power,
 673         .setup_bus      = ohare_mb_setup_bus,
 674         .un_reset       = ohare_mb_un_reset,
 675         .un_reset_ide   = ohare_mb_un_reset_ide,
 676 };
 677
 678 static const struct mb_ops heathrow_mb_ops = {
 679         .name           = "Heathrow",
 680         .content        = heathrow_mb_content,
 681         .power          = heathrow_mb_power,
 682         .setup_bus      = heathrow_mb_setup_bus,
 683         .un_reset       = heathrow_mb_un_reset,
 684         .un_reset_ide   = heathrow_mb_un_reset_ide,
 685 };
 686
 687 static const struct mb_ops keylargo_mb_ops = {
 688         .name           = "KeyLargo",
 689         .init           = keylargo_mb_init,
 690         .content        = keylargo_mb_content,
 691         .power          = keylargo_mb_power,
 692         .setup_bus      = keylargo_mb_setup_bus,
 693         .un_reset       = keylargo_mb_un_reset,
 694         .un_reset_ide   = keylargo_mb_un_reset_ide,
 695 };
 696
 697 /*
 698  * It seems that the bit for the media-bay interrupt in the IRQ_LEVEL
 699  * register is always set when there is something in the media bay.
 700  * This causes problems for the interrupt code if we attach an interrupt
 701  * handler to the media-bay interrupt, because it tends to go into
 702  * an infinite loop calling the media bay interrupt handler.
 703  * Therefore we do it all by polling the media bay once each tick.
 704  */
 705
 706 static const struct of_device_id media_bay_match[] =
 707 {
 708         {
 709         .name           = "media-bay",
 710         .compatible     = "keylargo-media-bay",
 711         .data           = &keylargo_mb_ops,
 712         },
 713         {
 714         .name           = "media-bay",
 715         .compatible     = "heathrow-media-bay",
 716         .data           = &heathrow_mb_ops,
 717         },
 718         {
 719         .name           = "media-bay",
 720         .compatible     = "ohare-media-bay",
 721         .data           = &ohare_mb_ops,
 722         },
 723         {},
 724 };
 725
 726 static struct macio_driver media_bay_driver =
 727 {
 728         .driver = {
 729                 .name           = "media-bay",
 730                 .of_match_table = media_bay_match,
 731         },
 732         .probe          = media_bay_attach,
 733         .suspend        = media_bay_suspend,
 734         .resume         = media_bay_resume
 735 };
 736
 737 static int __init media_bay_init(void)
 738 {
 739         int i;
 740
 741         for (i=0; i<MAX_BAYS; i++) {
 742                 memset((char *)&media_bays[i], 0, sizeof(struct media_bay_info));
 743                 media_bays[i].content_id        = -1;
 744         }
 745         if (!machine_is(powermac))
 746                 return 0;
 747
 748         macio_register_driver(&media_bay_driver);
 749
 750         return 0;
 751 }
 752
 753 device_initcall(media_bay_init);