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