^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * tifm_7xx1.c - TI FlashMedia driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 2006 Alex Dubov <oakad@yahoo.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/tifm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/dma-mapping.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #define DRIVER_NAME "tifm_7xx1"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #define DRIVER_VERSION "0.8"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #define TIFM_IRQ_ENABLE 0x80000000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #define TIFM_IRQ_SOCKMASK(x) (x)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #define TIFM_IRQ_CARDMASK(x) ((x) << 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #define TIFM_IRQ_FIFOMASK(x) ((x) << 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #define TIFM_IRQ_SETALL 0xffffffff
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) static void tifm_7xx1_dummy_eject(struct tifm_adapter *fm,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) struct tifm_dev *sock)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) static void tifm_7xx1_eject(struct tifm_adapter *fm, struct tifm_dev *sock)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) spin_lock_irqsave(&fm->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) fm->socket_change_set |= 1 << sock->socket_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) tifm_queue_work(&fm->media_switcher);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) spin_unlock_irqrestore(&fm->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) static irqreturn_t tifm_7xx1_isr(int irq, void *dev_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) struct tifm_adapter *fm = dev_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) struct tifm_dev *sock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) unsigned int irq_status, cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) spin_lock(&fm->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) irq_status = readl(fm->addr + FM_INTERRUPT_STATUS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) if (irq_status == 0 || irq_status == (~0)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) spin_unlock(&fm->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) return IRQ_NONE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) if (irq_status & TIFM_IRQ_ENABLE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) writel(TIFM_IRQ_ENABLE, fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) for (cnt = 0; cnt < fm->num_sockets; cnt++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) sock = fm->sockets[cnt];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) if (sock) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) if ((irq_status >> cnt) & TIFM_IRQ_FIFOMASK(1))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) sock->data_event(sock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) if ((irq_status >> cnt) & TIFM_IRQ_CARDMASK(1))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) sock->card_event(sock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) fm->socket_change_set |= irq_status
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) & ((1 << fm->num_sockets) - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) writel(irq_status, fm->addr + FM_INTERRUPT_STATUS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) if (fm->finish_me)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) complete_all(fm->finish_me);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) else if (!fm->socket_change_set)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) writel(TIFM_IRQ_ENABLE, fm->addr + FM_SET_INTERRUPT_ENABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) tifm_queue_work(&fm->media_switcher);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) spin_unlock(&fm->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) static unsigned char tifm_7xx1_toggle_sock_power(char __iomem *sock_addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) unsigned int s_state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) int cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) writel(0x0e00, sock_addr + SOCK_CONTROL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) for (cnt = 16; cnt <= 256; cnt <<= 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) if (!(TIFM_SOCK_STATE_POWERED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) & readl(sock_addr + SOCK_PRESENT_STATE)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) msleep(cnt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) s_state = readl(sock_addr + SOCK_PRESENT_STATE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) if (!(TIFM_SOCK_STATE_OCCUPIED & s_state))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) writel(readl(sock_addr + SOCK_CONTROL) | TIFM_CTRL_LED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) sock_addr + SOCK_CONTROL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) /* xd needs some extra time before power on */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) if (((readl(sock_addr + SOCK_PRESENT_STATE) >> 4) & 7)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) == TIFM_TYPE_XD)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) msleep(40);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) writel((s_state & TIFM_CTRL_POWER_MASK) | 0x0c00,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) sock_addr + SOCK_CONTROL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) /* wait for power to stabilize */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) msleep(20);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) for (cnt = 16; cnt <= 256; cnt <<= 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) if ((TIFM_SOCK_STATE_POWERED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) & readl(sock_addr + SOCK_PRESENT_STATE)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) msleep(cnt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) writel(readl(sock_addr + SOCK_CONTROL) & (~TIFM_CTRL_LED),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) sock_addr + SOCK_CONTROL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) return (readl(sock_addr + SOCK_PRESENT_STATE) >> 4) & 7;
^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) inline static void tifm_7xx1_sock_power_off(char __iomem *sock_addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) writel((~TIFM_CTRL_POWER_MASK) & readl(sock_addr + SOCK_CONTROL),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) sock_addr + SOCK_CONTROL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) inline static char __iomem *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) tifm_7xx1_sock_addr(char __iomem *base_addr, unsigned int sock_num)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) return base_addr + ((sock_num + 1) << 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) static void tifm_7xx1_switch_media(struct work_struct *work)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) struct tifm_adapter *fm = container_of(work, struct tifm_adapter,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) media_switcher);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) struct tifm_dev *sock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) char __iomem *sock_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) unsigned char media_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) unsigned int socket_change_set, cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) spin_lock_irqsave(&fm->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) socket_change_set = fm->socket_change_set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) fm->socket_change_set = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) dev_dbg(fm->dev.parent, "checking media set %x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) socket_change_set);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) if (!socket_change_set) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) spin_unlock_irqrestore(&fm->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) for (cnt = 0; cnt < fm->num_sockets; cnt++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) if (!(socket_change_set & (1 << cnt)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) sock = fm->sockets[cnt];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) if (sock) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) printk(KERN_INFO
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) "%s : demand removing card from socket %u:%u\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) dev_name(&fm->dev), fm->id, cnt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) fm->sockets[cnt] = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) sock_addr = sock->addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) spin_unlock_irqrestore(&fm->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) device_unregister(&sock->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) spin_lock_irqsave(&fm->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) tifm_7xx1_sock_power_off(sock_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) writel(0x0e00, sock_addr + SOCK_CONTROL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) spin_unlock_irqrestore(&fm->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) media_id = tifm_7xx1_toggle_sock_power(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) tifm_7xx1_sock_addr(fm->addr, cnt));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) // tifm_alloc_device will check if media_id is valid
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) sock = tifm_alloc_device(fm, cnt, media_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) if (sock) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) sock->addr = tifm_7xx1_sock_addr(fm->addr, cnt);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) if (!device_register(&sock->dev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) spin_lock_irqsave(&fm->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) if (!fm->sockets[cnt]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) fm->sockets[cnt] = sock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) sock = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) spin_unlock_irqrestore(&fm->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) if (sock)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) tifm_free_device(&sock->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) spin_lock_irqsave(&fm->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) writel(TIFM_IRQ_FIFOMASK(socket_change_set)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) | TIFM_IRQ_CARDMASK(socket_change_set),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) writel(TIFM_IRQ_FIFOMASK(socket_change_set)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) | TIFM_IRQ_CARDMASK(socket_change_set),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) fm->addr + FM_SET_INTERRUPT_ENABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) writel(TIFM_IRQ_ENABLE, fm->addr + FM_SET_INTERRUPT_ENABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) spin_unlock_irqrestore(&fm->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) static int __maybe_unused tifm_7xx1_suspend(struct device *dev_d)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) struct pci_dev *dev = to_pci_dev(dev_d);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) struct tifm_adapter *fm = pci_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) int cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) dev_dbg(&dev->dev, "suspending host\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) for (cnt = 0; cnt < fm->num_sockets; cnt++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) if (fm->sockets[cnt])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) tifm_7xx1_sock_power_off(fm->sockets[cnt]->addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) device_wakeup_disable(dev_d);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) static int __maybe_unused tifm_7xx1_resume(struct device *dev_d)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) struct pci_dev *dev = to_pci_dev(dev_d);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) struct tifm_adapter *fm = pci_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) unsigned long timeout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) unsigned int good_sockets = 0, bad_sockets = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) /* Maximum number of entries is 4 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) unsigned char new_ids[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) DECLARE_COMPLETION_ONSTACK(finish_resume);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) if (WARN_ON(fm->num_sockets > ARRAY_SIZE(new_ids)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) return -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) pci_set_master(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) dev_dbg(&dev->dev, "resuming host\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) for (rc = 0; rc < fm->num_sockets; rc++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) new_ids[rc] = tifm_7xx1_toggle_sock_power(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) tifm_7xx1_sock_addr(fm->addr, rc));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) spin_lock_irqsave(&fm->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) for (rc = 0; rc < fm->num_sockets; rc++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) if (fm->sockets[rc]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) if (fm->sockets[rc]->type == new_ids[rc])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) good_sockets |= 1 << rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) bad_sockets |= 1 << rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) writel(TIFM_IRQ_ENABLE | TIFM_IRQ_SOCKMASK((1 << fm->num_sockets) - 1),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) fm->addr + FM_SET_INTERRUPT_ENABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) dev_dbg(&dev->dev, "change sets on resume: good %x, bad %x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) good_sockets, bad_sockets);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) fm->socket_change_set = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) if (good_sockets) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) fm->finish_me = &finish_resume;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) spin_unlock_irqrestore(&fm->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) timeout = wait_for_completion_timeout(&finish_resume, HZ);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) dev_dbg(&dev->dev, "wait returned %lu\n", timeout);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) writel(TIFM_IRQ_FIFOMASK(good_sockets)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) | TIFM_IRQ_CARDMASK(good_sockets),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) writel(TIFM_IRQ_FIFOMASK(good_sockets)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) | TIFM_IRQ_CARDMASK(good_sockets),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) fm->addr + FM_SET_INTERRUPT_ENABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) spin_lock_irqsave(&fm->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) fm->finish_me = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) fm->socket_change_set ^= good_sockets & fm->socket_change_set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) fm->socket_change_set |= bad_sockets;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) if (fm->socket_change_set)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) tifm_queue_work(&fm->media_switcher);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) spin_unlock_irqrestore(&fm->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) writel(TIFM_IRQ_ENABLE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) fm->addr + FM_SET_INTERRUPT_ENABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) return 0;
^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) static int tifm_7xx1_dummy_has_ms_pif(struct tifm_adapter *fm,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) struct tifm_dev *sock)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) static int tifm_7xx1_has_ms_pif(struct tifm_adapter *fm, struct tifm_dev *sock)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) if (((fm->num_sockets == 4) && (sock->socket_id == 2))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) || ((fm->num_sockets == 2) && (sock->socket_id == 0)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) return 0;
^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 int tifm_7xx1_probe(struct pci_dev *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) const struct pci_device_id *dev_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) struct tifm_adapter *fm;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) int pci_dev_busy = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) int rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) rc = pci_set_dma_mask(dev, DMA_BIT_MASK(32));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) rc = pci_enable_device(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) pci_set_master(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) rc = pci_request_regions(dev, DRIVER_NAME);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) if (rc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) pci_dev_busy = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) goto err_out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) pci_intx(dev, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) fm = tifm_alloc_adapter(dev->device == PCI_DEVICE_ID_TI_XX21_XX11_FM
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) ? 4 : 2, &dev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) if (!fm) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) rc = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) goto err_out_int;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) INIT_WORK(&fm->media_switcher, tifm_7xx1_switch_media);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) fm->eject = tifm_7xx1_eject;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) fm->has_ms_pif = tifm_7xx1_has_ms_pif;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) pci_set_drvdata(dev, fm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) fm->addr = pci_ioremap_bar(dev, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) if (!fm->addr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) rc = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) goto err_out_free;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) rc = request_irq(dev->irq, tifm_7xx1_isr, IRQF_SHARED, DRIVER_NAME, fm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) goto err_out_unmap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) rc = tifm_add_adapter(fm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) if (rc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) goto err_out_irq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) writel(TIFM_IRQ_ENABLE | TIFM_IRQ_SOCKMASK((1 << fm->num_sockets) - 1),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) writel(TIFM_IRQ_ENABLE | TIFM_IRQ_SOCKMASK((1 << fm->num_sockets) - 1),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) fm->addr + FM_SET_INTERRUPT_ENABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) err_out_irq:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) free_irq(dev->irq, fm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) err_out_unmap:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) iounmap(fm->addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) err_out_free:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) tifm_free_adapter(fm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) err_out_int:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) pci_intx(dev, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) pci_release_regions(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) err_out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) if (!pci_dev_busy)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) pci_disable_device(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) return rc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) static void tifm_7xx1_remove(struct pci_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) struct tifm_adapter *fm = pci_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) int cnt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) fm->eject = tifm_7xx1_dummy_eject;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) fm->has_ms_pif = tifm_7xx1_dummy_has_ms_pif;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) writel(TIFM_IRQ_SETALL, fm->addr + FM_CLEAR_INTERRUPT_ENABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) free_irq(dev->irq, fm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) tifm_remove_adapter(fm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) for (cnt = 0; cnt < fm->num_sockets; cnt++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) tifm_7xx1_sock_power_off(tifm_7xx1_sock_addr(fm->addr, cnt));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) iounmap(fm->addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) pci_intx(dev, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) pci_release_regions(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) pci_disable_device(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) tifm_free_adapter(fm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) static const struct pci_device_id tifm_7xx1_pci_tbl[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) { PCI_VENDOR_ID_TI, PCI_DEVICE_ID_TI_XX21_XX11_FM, PCI_ANY_ID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) PCI_ANY_ID, 0, 0, 0 }, /* xx21 - the one I have */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) { PCI_VENDOR_ID_TI, PCI_DEVICE_ID_TI_XX12_FM, PCI_ANY_ID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) PCI_ANY_ID, 0, 0, 0 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) { PCI_VENDOR_ID_TI, PCI_DEVICE_ID_TI_XX20_FM, PCI_ANY_ID,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) PCI_ANY_ID, 0, 0, 0 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) { }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) static SIMPLE_DEV_PM_OPS(tifm_7xx1_pm_ops, tifm_7xx1_suspend, tifm_7xx1_resume);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) static struct pci_driver tifm_7xx1_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) .name = DRIVER_NAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) .id_table = tifm_7xx1_pci_tbl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) .probe = tifm_7xx1_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) .remove = tifm_7xx1_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) .driver.pm = &tifm_7xx1_pm_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) module_pci_driver(tifm_7xx1_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) MODULE_AUTHOR("Alex Dubov");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) MODULE_DESCRIPTION("TI FlashMedia host driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) MODULE_DEVICE_TABLE(pci, tifm_7xx1_pci_tbl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) MODULE_VERSION(DRIVER_VERSION);