1d2912cb1SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only 25f5bac82SMichał Mirosław /* 35f5bac82SMichał Mirosław * cb710/mmc.c 45f5bac82SMichał Mirosław * 55f5bac82SMichał Mirosław * Copyright by Michał Mirosław, 2008-2009 65f5bac82SMichał Mirosław */ 75f5bac82SMichał Mirosław #include <linux/kernel.h> 85f5bac82SMichał Mirosław #include <linux/module.h> 95f5bac82SMichał Mirosław #include <linux/pci.h> 105f5bac82SMichał Mirosław #include <linux/delay.h> 115f5bac82SMichał Mirosław #include "cb710-mmc.h" 125f5bac82SMichał Mirosław 1385a3f77cSUlf Hansson #define CB710_MMC_REQ_TIMEOUT_MS 2000 1485a3f77cSUlf Hansson 155f5bac82SMichał Mirosław static const u8 cb710_clock_divider_log2[8] = { 165f5bac82SMichał Mirosław /* 1, 2, 4, 8, 16, 32, 128, 512 */ 175f5bac82SMichał Mirosław 0, 1, 2, 3, 4, 5, 7, 9 185f5bac82SMichał Mirosław }; 195f5bac82SMichał Mirosław #define CB710_MAX_DIVIDER_IDX \ 205f5bac82SMichał Mirosław (ARRAY_SIZE(cb710_clock_divider_log2) - 1) 215f5bac82SMichał Mirosław 225f5bac82SMichał Mirosław static const u8 cb710_src_freq_mhz[16] = { 235f5bac82SMichał Mirosław 33, 10, 20, 25, 30, 35, 40, 45, 245f5bac82SMichał Mirosław 50, 55, 60, 65, 70, 75, 80, 85 255f5bac82SMichał Mirosław }; 265f5bac82SMichał Mirosław 2719d614a4SMichał Mirosław static void cb710_mmc_select_clock_divider(struct mmc_host *mmc, int hz) 285f5bac82SMichał Mirosław { 295f5bac82SMichał Mirosław struct cb710_slot *slot = cb710_mmc_to_slot(mmc); 305f5bac82SMichał Mirosław struct pci_dev *pdev = cb710_slot_to_chip(slot)->pdev; 315f5bac82SMichał Mirosław u32 src_freq_idx; 325f5bac82SMichał Mirosław u32 divider_idx; 335f5bac82SMichał Mirosław int src_hz; 345f5bac82SMichał Mirosław 3519d614a4SMichał Mirosław /* on CB710 in HP nx9500: 3619d614a4SMichał Mirosław * src_freq_idx == 0 3719d614a4SMichał Mirosław * indexes 1-7 work as written in the table 3819d614a4SMichał Mirosław * indexes 0,8-15 give no clock output 3919d614a4SMichał Mirosław */ 405f5bac82SMichał Mirosław pci_read_config_dword(pdev, 0x48, &src_freq_idx); 415f5bac82SMichał Mirosław src_freq_idx = (src_freq_idx >> 16) & 0xF; 425f5bac82SMichał Mirosław src_hz = cb710_src_freq_mhz[src_freq_idx] * 1000000; 435f5bac82SMichał Mirosław 445f5bac82SMichał Mirosław for (divider_idx = 0; divider_idx < CB710_MAX_DIVIDER_IDX; ++divider_idx) { 455f5bac82SMichał Mirosław if (hz >= src_hz >> cb710_clock_divider_log2[divider_idx]) 465f5bac82SMichał Mirosław break; 475f5bac82SMichał Mirosław } 485f5bac82SMichał Mirosław 495f5bac82SMichał Mirosław if (src_freq_idx) 505f5bac82SMichał Mirosław divider_idx |= 0x8; 5119d614a4SMichał Mirosław else if (divider_idx == 0) 5219d614a4SMichał Mirosław divider_idx = 1; 535f5bac82SMichał Mirosław 545f5bac82SMichał Mirosław cb710_pci_update_config_reg(pdev, 0x40, ~0xF0000000, divider_idx << 28); 555f5bac82SMichał Mirosław 565f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), 5719d614a4SMichał Mirosław "clock set to %d Hz, wanted %d Hz; src_freq_idx = %d, divider_idx = %d|%d\n", 585f5bac82SMichał Mirosław src_hz >> cb710_clock_divider_log2[divider_idx & 7], 5919d614a4SMichał Mirosław hz, src_freq_idx, divider_idx & 7, divider_idx & 8); 605f5bac82SMichał Mirosław } 615f5bac82SMichał Mirosław 625f5bac82SMichał Mirosław static void __cb710_mmc_enable_irq(struct cb710_slot *slot, 635f5bac82SMichał Mirosław unsigned short enable, unsigned short mask) 645f5bac82SMichał Mirosław { 655f5bac82SMichał Mirosław /* clear global IE 665f5bac82SMichał Mirosław * - it gets set later if any interrupt sources are enabled */ 675f5bac82SMichał Mirosław mask |= CB710_MMC_IE_IRQ_ENABLE; 685f5bac82SMichał Mirosław 695f5bac82SMichał Mirosław /* look like interrupt is fired whenever 705f5bac82SMichał Mirosław * WORD[0x0C] & WORD[0x10] != 0; 715f5bac82SMichał Mirosław * -> bit 15 port 0x0C seems to be global interrupt enable 725f5bac82SMichał Mirosław */ 735f5bac82SMichał Mirosław 745f5bac82SMichał Mirosław enable = (cb710_read_port_16(slot, CB710_MMC_IRQ_ENABLE_PORT) 755f5bac82SMichał Mirosław & ~mask) | enable; 765f5bac82SMichał Mirosław 775f5bac82SMichał Mirosław if (enable) 785f5bac82SMichał Mirosław enable |= CB710_MMC_IE_IRQ_ENABLE; 795f5bac82SMichał Mirosław 805f5bac82SMichał Mirosław cb710_write_port_16(slot, CB710_MMC_IRQ_ENABLE_PORT, enable); 815f5bac82SMichał Mirosław } 825f5bac82SMichał Mirosław 835f5bac82SMichał Mirosław static void cb710_mmc_enable_irq(struct cb710_slot *slot, 845f5bac82SMichał Mirosław unsigned short enable, unsigned short mask) 855f5bac82SMichał Mirosław { 865f5bac82SMichał Mirosław struct cb710_mmc_reader *reader = mmc_priv(cb710_slot_to_mmc(slot)); 875f5bac82SMichał Mirosław unsigned long flags; 885f5bac82SMichał Mirosław 895f5bac82SMichał Mirosław spin_lock_irqsave(&reader->irq_lock, flags); 905f5bac82SMichał Mirosław /* this is the only thing irq_lock protects */ 915f5bac82SMichał Mirosław __cb710_mmc_enable_irq(slot, enable, mask); 925f5bac82SMichał Mirosław spin_unlock_irqrestore(&reader->irq_lock, flags); 935f5bac82SMichał Mirosław } 945f5bac82SMichał Mirosław 955f5bac82SMichał Mirosław static void cb710_mmc_reset_events(struct cb710_slot *slot) 965f5bac82SMichał Mirosław { 975f5bac82SMichał Mirosław cb710_write_port_8(slot, CB710_MMC_STATUS0_PORT, 0xFF); 985f5bac82SMichał Mirosław cb710_write_port_8(slot, CB710_MMC_STATUS1_PORT, 0xFF); 995f5bac82SMichał Mirosław cb710_write_port_8(slot, CB710_MMC_STATUS2_PORT, 0xFF); 1005f5bac82SMichał Mirosław } 1015f5bac82SMichał Mirosław 1025f5bac82SMichał Mirosław static void cb710_mmc_enable_4bit_data(struct cb710_slot *slot, int enable) 1035f5bac82SMichał Mirosław { 1045f5bac82SMichał Mirosław if (enable) 1055f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG1_PORT, 1065f5bac82SMichał Mirosław CB710_MMC_C1_4BIT_DATA_BUS, 0); 1075f5bac82SMichał Mirosław else 1085f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG1_PORT, 1095f5bac82SMichał Mirosław 0, CB710_MMC_C1_4BIT_DATA_BUS); 1105f5bac82SMichał Mirosław } 1115f5bac82SMichał Mirosław 1125f5bac82SMichał Mirosław static int cb710_check_event(struct cb710_slot *slot, u8 what) 1135f5bac82SMichał Mirosław { 1145f5bac82SMichał Mirosław u16 status; 1155f5bac82SMichał Mirosław 1165f5bac82SMichał Mirosław status = cb710_read_port_16(slot, CB710_MMC_STATUS_PORT); 1175f5bac82SMichał Mirosław 1185f5bac82SMichał Mirosław if (status & CB710_MMC_S0_FIFO_UNDERFLOW) { 1195f5bac82SMichał Mirosław /* it is just a guess, so log it */ 1205f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), 1215f5bac82SMichał Mirosław "CHECK : ignoring bit 6 in status %04X\n", status); 1225f5bac82SMichał Mirosław cb710_write_port_8(slot, CB710_MMC_STATUS0_PORT, 1235f5bac82SMichał Mirosław CB710_MMC_S0_FIFO_UNDERFLOW); 1245f5bac82SMichał Mirosław status &= ~CB710_MMC_S0_FIFO_UNDERFLOW; 1255f5bac82SMichał Mirosław } 1265f5bac82SMichał Mirosław 1275f5bac82SMichał Mirosław if (status & CB710_MMC_STATUS_ERROR_EVENTS) { 1285f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), 1295f5bac82SMichał Mirosław "CHECK : returning EIO on status %04X\n", status); 1305f5bac82SMichał Mirosław cb710_write_port_8(slot, CB710_MMC_STATUS0_PORT, status & 0xFF); 1315f5bac82SMichał Mirosław cb710_write_port_8(slot, CB710_MMC_STATUS1_PORT, 1325f5bac82SMichał Mirosław CB710_MMC_S1_RESET); 1335f5bac82SMichał Mirosław return -EIO; 1345f5bac82SMichał Mirosław } 1355f5bac82SMichał Mirosław 1365f5bac82SMichał Mirosław /* 'what' is a bit in MMC_STATUS1 */ 1375f5bac82SMichał Mirosław if ((status >> 8) & what) { 1385f5bac82SMichał Mirosław cb710_write_port_8(slot, CB710_MMC_STATUS1_PORT, what); 1395f5bac82SMichał Mirosław return 1; 1405f5bac82SMichał Mirosław } 1415f5bac82SMichał Mirosław 1425f5bac82SMichał Mirosław return 0; 1435f5bac82SMichał Mirosław } 1445f5bac82SMichał Mirosław 1455f5bac82SMichał Mirosław static int cb710_wait_for_event(struct cb710_slot *slot, u8 what) 1465f5bac82SMichał Mirosław { 1475f5bac82SMichał Mirosław int err = 0; 1485f5bac82SMichał Mirosław unsigned limit = 2000000; /* FIXME: real timeout */ 1495f5bac82SMichał Mirosław 1505f5bac82SMichał Mirosław #ifdef CONFIG_CB710_DEBUG 1515f5bac82SMichał Mirosław u32 e, x; 1525f5bac82SMichał Mirosław e = cb710_read_port_32(slot, CB710_MMC_STATUS_PORT); 1535f5bac82SMichał Mirosław #endif 1545f5bac82SMichał Mirosław 1555f5bac82SMichał Mirosław while (!(err = cb710_check_event(slot, what))) { 1565f5bac82SMichał Mirosław if (!--limit) { 1575f5bac82SMichał Mirosław cb710_dump_regs(cb710_slot_to_chip(slot), 1585f5bac82SMichał Mirosław CB710_DUMP_REGS_MMC); 1595f5bac82SMichał Mirosław err = -ETIMEDOUT; 1605f5bac82SMichał Mirosław break; 1615f5bac82SMichał Mirosław } 1625f5bac82SMichał Mirosław udelay(1); 1635f5bac82SMichał Mirosław } 1645f5bac82SMichał Mirosław 1655f5bac82SMichał Mirosław #ifdef CONFIG_CB710_DEBUG 1665f5bac82SMichał Mirosław x = cb710_read_port_32(slot, CB710_MMC_STATUS_PORT); 1675f5bac82SMichał Mirosław 1685f5bac82SMichał Mirosław limit = 2000000 - limit; 1695f5bac82SMichał Mirosław if (limit > 100) 1705f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), 1715f5bac82SMichał Mirosław "WAIT10: waited %d loops, what %d, entry val %08X, exit val %08X\n", 1725f5bac82SMichał Mirosław limit, what, e, x); 1735f5bac82SMichał Mirosław #endif 1745f5bac82SMichał Mirosław return err < 0 ? err : 0; 1755f5bac82SMichał Mirosław } 1765f5bac82SMichał Mirosław 1775f5bac82SMichał Mirosław 1785f5bac82SMichał Mirosław static int cb710_wait_while_busy(struct cb710_slot *slot, uint8_t mask) 1795f5bac82SMichał Mirosław { 1805f5bac82SMichał Mirosław unsigned limit = 500000; /* FIXME: real timeout */ 1815f5bac82SMichał Mirosław int err = 0; 1825f5bac82SMichał Mirosław 1835f5bac82SMichał Mirosław #ifdef CONFIG_CB710_DEBUG 1845f5bac82SMichał Mirosław u32 e, x; 1855f5bac82SMichał Mirosław e = cb710_read_port_32(slot, CB710_MMC_STATUS_PORT); 1865f5bac82SMichał Mirosław #endif 1875f5bac82SMichał Mirosław 1885f5bac82SMichał Mirosław while (cb710_read_port_8(slot, CB710_MMC_STATUS2_PORT) & mask) { 1895f5bac82SMichał Mirosław if (!--limit) { 1905f5bac82SMichał Mirosław cb710_dump_regs(cb710_slot_to_chip(slot), 1915f5bac82SMichał Mirosław CB710_DUMP_REGS_MMC); 1925f5bac82SMichał Mirosław err = -ETIMEDOUT; 1935f5bac82SMichał Mirosław break; 1945f5bac82SMichał Mirosław } 1955f5bac82SMichał Mirosław udelay(1); 1965f5bac82SMichał Mirosław } 1975f5bac82SMichał Mirosław 1985f5bac82SMichał Mirosław #ifdef CONFIG_CB710_DEBUG 1995f5bac82SMichał Mirosław x = cb710_read_port_32(slot, CB710_MMC_STATUS_PORT); 2005f5bac82SMichał Mirosław 2015f5bac82SMichał Mirosław limit = 500000 - limit; 2025f5bac82SMichał Mirosław if (limit > 100) 2035f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), 2045f5bac82SMichał Mirosław "WAIT12: waited %d loops, mask %02X, entry val %08X, exit val %08X\n", 2055f5bac82SMichał Mirosław limit, mask, e, x); 2065f5bac82SMichał Mirosław #endif 207b3bd1b5bSChris Ball return err; 2085f5bac82SMichał Mirosław } 2095f5bac82SMichał Mirosław 2105f5bac82SMichał Mirosław static void cb710_mmc_set_transfer_size(struct cb710_slot *slot, 2115f5bac82SMichał Mirosław size_t count, size_t blocksize) 2125f5bac82SMichał Mirosław { 2135f5bac82SMichał Mirosław cb710_wait_while_busy(slot, CB710_MMC_S2_BUSY_20); 2145f5bac82SMichał Mirosław cb710_write_port_32(slot, CB710_MMC_TRANSFER_SIZE_PORT, 2155f5bac82SMichał Mirosław ((count - 1) << 16)|(blocksize - 1)); 2165f5bac82SMichał Mirosław 21709adfe45SPierre Ossman dev_vdbg(cb710_slot_dev(slot), "set up for %zu block%s of %zu bytes\n", 2185f5bac82SMichał Mirosław count, count == 1 ? "" : "s", blocksize); 2195f5bac82SMichał Mirosław } 2205f5bac82SMichał Mirosław 2215f5bac82SMichał Mirosław static void cb710_mmc_fifo_hack(struct cb710_slot *slot) 2225f5bac82SMichał Mirosław { 2235f5bac82SMichał Mirosław /* without this, received data is prepended with 8-bytes of zeroes */ 2245f5bac82SMichał Mirosław u32 r1, r2; 2255f5bac82SMichał Mirosław int ok = 0; 2265f5bac82SMichał Mirosław 2275f5bac82SMichał Mirosław r1 = cb710_read_port_32(slot, CB710_MMC_DATA_PORT); 2285f5bac82SMichał Mirosław r2 = cb710_read_port_32(slot, CB710_MMC_DATA_PORT); 2295f5bac82SMichał Mirosław if (cb710_read_port_8(slot, CB710_MMC_STATUS0_PORT) 2305f5bac82SMichał Mirosław & CB710_MMC_S0_FIFO_UNDERFLOW) { 2315f5bac82SMichał Mirosław cb710_write_port_8(slot, CB710_MMC_STATUS0_PORT, 2325f5bac82SMichał Mirosław CB710_MMC_S0_FIFO_UNDERFLOW); 2335f5bac82SMichał Mirosław ok = 1; 2345f5bac82SMichał Mirosław } 2355f5bac82SMichał Mirosław 2365f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), 2375f5bac82SMichał Mirosław "FIFO-read-hack: expected STATUS0 bit was %s\n", 2385f5bac82SMichał Mirosław ok ? "set." : "NOT SET!"); 2395f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), 2405f5bac82SMichał Mirosław "FIFO-read-hack: dwords ignored: %08X %08X - %s\n", 2415f5bac82SMichał Mirosław r1, r2, (r1|r2) ? "BAD (NOT ZERO)!" : "ok"); 2425f5bac82SMichał Mirosław } 2435f5bac82SMichał Mirosław 2445f5bac82SMichał Mirosław static int cb710_mmc_receive_pio(struct cb710_slot *slot, 2455f5bac82SMichał Mirosław struct sg_mapping_iter *miter, size_t dw_count) 2465f5bac82SMichał Mirosław { 2475f5bac82SMichał Mirosław if (!(cb710_read_port_8(slot, CB710_MMC_STATUS2_PORT) & CB710_MMC_S2_FIFO_READY)) { 2485f5bac82SMichał Mirosław int err = cb710_wait_for_event(slot, 2495f5bac82SMichał Mirosław CB710_MMC_S1_PIO_TRANSFER_DONE); 2505f5bac82SMichał Mirosław if (err) 2515f5bac82SMichał Mirosław return err; 2525f5bac82SMichał Mirosław } 2535f5bac82SMichał Mirosław 2545f5bac82SMichał Mirosław cb710_sg_dwiter_write_from_io(miter, 2555f5bac82SMichał Mirosław slot->iobase + CB710_MMC_DATA_PORT, dw_count); 2565f5bac82SMichał Mirosław 2575f5bac82SMichał Mirosław return 0; 2585f5bac82SMichał Mirosław } 2595f5bac82SMichał Mirosław 2605f5bac82SMichał Mirosław static bool cb710_is_transfer_size_supported(struct mmc_data *data) 2615f5bac82SMichał Mirosław { 2625f5bac82SMichał Mirosław return !(data->blksz & 15 && (data->blocks != 1 || data->blksz != 8)); 2635f5bac82SMichał Mirosław } 2645f5bac82SMichał Mirosław 2655f5bac82SMichał Mirosław static int cb710_mmc_receive(struct cb710_slot *slot, struct mmc_data *data) 2665f5bac82SMichał Mirosław { 2675f5bac82SMichał Mirosław struct sg_mapping_iter miter; 2685f5bac82SMichał Mirosław size_t len, blocks = data->blocks; 2695f5bac82SMichał Mirosław int err = 0; 2705f5bac82SMichał Mirosław 2715f5bac82SMichał Mirosław /* TODO: I don't know how/if the hardware handles non-16B-boundary blocks 2725f5bac82SMichał Mirosław * except single 8B block */ 2735f5bac82SMichał Mirosław if (unlikely(data->blksz & 15 && (data->blocks != 1 || data->blksz != 8))) 2745f5bac82SMichał Mirosław return -EINVAL; 2755f5bac82SMichał Mirosław 2764b2a108cSSebastian Andrzej Siewior sg_miter_start(&miter, data->sg, data->sg_len, SG_MITER_TO_SG); 2775f5bac82SMichał Mirosław 2785f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG2_PORT, 2795f5bac82SMichał Mirosław 15, CB710_MMC_C2_READ_PIO_SIZE_MASK); 2805f5bac82SMichał Mirosław 2815f5bac82SMichał Mirosław cb710_mmc_fifo_hack(slot); 2825f5bac82SMichał Mirosław 2835f5bac82SMichał Mirosław while (blocks-- > 0) { 2845f5bac82SMichał Mirosław len = data->blksz; 2855f5bac82SMichał Mirosław 2865f5bac82SMichał Mirosław while (len >= 16) { 2875f5bac82SMichał Mirosław err = cb710_mmc_receive_pio(slot, &miter, 4); 2885f5bac82SMichał Mirosław if (err) 2895f5bac82SMichał Mirosław goto out; 2905f5bac82SMichał Mirosław len -= 16; 2915f5bac82SMichał Mirosław } 2925f5bac82SMichał Mirosław 2935f5bac82SMichał Mirosław if (!len) 2945f5bac82SMichał Mirosław continue; 2955f5bac82SMichał Mirosław 2965f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG2_PORT, 2975f5bac82SMichał Mirosław len - 1, CB710_MMC_C2_READ_PIO_SIZE_MASK); 2985f5bac82SMichał Mirosław 2995f5bac82SMichał Mirosław len = (len >= 8) ? 4 : 2; 3005f5bac82SMichał Mirosław err = cb710_mmc_receive_pio(slot, &miter, len); 3015f5bac82SMichał Mirosław if (err) 3025f5bac82SMichał Mirosław goto out; 3035f5bac82SMichał Mirosław } 3045f5bac82SMichał Mirosław out: 3054b2a108cSSebastian Andrzej Siewior sg_miter_stop(&miter); 3065f5bac82SMichał Mirosław return err; 3075f5bac82SMichał Mirosław } 3085f5bac82SMichał Mirosław 3095f5bac82SMichał Mirosław static int cb710_mmc_send(struct cb710_slot *slot, struct mmc_data *data) 3105f5bac82SMichał Mirosław { 3115f5bac82SMichał Mirosław struct sg_mapping_iter miter; 3125f5bac82SMichał Mirosław size_t len, blocks = data->blocks; 3135f5bac82SMichał Mirosław int err = 0; 3145f5bac82SMichał Mirosław 3155f5bac82SMichał Mirosław /* TODO: I don't know how/if the hardware handles multiple 3165f5bac82SMichał Mirosław * non-16B-boundary blocks */ 3175f5bac82SMichał Mirosław if (unlikely(data->blocks > 1 && data->blksz & 15)) 3185f5bac82SMichał Mirosław return -EINVAL; 3195f5bac82SMichał Mirosław 3204b2a108cSSebastian Andrzej Siewior sg_miter_start(&miter, data->sg, data->sg_len, SG_MITER_FROM_SG); 3215f5bac82SMichał Mirosław 3225f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG2_PORT, 3235f5bac82SMichał Mirosław 0, CB710_MMC_C2_READ_PIO_SIZE_MASK); 3245f5bac82SMichał Mirosław 3255f5bac82SMichał Mirosław while (blocks-- > 0) { 3265f5bac82SMichał Mirosław len = (data->blksz + 15) >> 4; 3275f5bac82SMichał Mirosław do { 3285f5bac82SMichał Mirosław if (!(cb710_read_port_8(slot, CB710_MMC_STATUS2_PORT) 3295f5bac82SMichał Mirosław & CB710_MMC_S2_FIFO_EMPTY)) { 3305f5bac82SMichał Mirosław err = cb710_wait_for_event(slot, 3315f5bac82SMichał Mirosław CB710_MMC_S1_PIO_TRANSFER_DONE); 3325f5bac82SMichał Mirosław if (err) 3335f5bac82SMichał Mirosław goto out; 3345f5bac82SMichał Mirosław } 3355f5bac82SMichał Mirosław cb710_sg_dwiter_read_to_io(&miter, 3365f5bac82SMichał Mirosław slot->iobase + CB710_MMC_DATA_PORT, 4); 3375f5bac82SMichał Mirosław } while (--len); 3385f5bac82SMichał Mirosław } 3395f5bac82SMichał Mirosław out: 3405f5bac82SMichał Mirosław sg_miter_stop(&miter); 3415f5bac82SMichał Mirosław return err; 3425f5bac82SMichał Mirosław } 3435f5bac82SMichał Mirosław 3445f5bac82SMichał Mirosław static u16 cb710_encode_cmd_flags(struct cb710_mmc_reader *reader, 3455f5bac82SMichał Mirosław struct mmc_command *cmd) 3465f5bac82SMichał Mirosław { 3475f5bac82SMichał Mirosław unsigned int flags = cmd->flags; 3485f5bac82SMichał Mirosław u16 cb_flags = 0; 3495f5bac82SMichał Mirosław 3505f5bac82SMichał Mirosław /* Windows driver returned 0 for commands for which no response 3515f5bac82SMichał Mirosław * is expected. It happened that there were only two such commands 3525f5bac82SMichał Mirosław * used: MMC_GO_IDLE_STATE and MMC_GO_INACTIVE_STATE so it might 3535f5bac82SMichał Mirosław * as well be a bug in that driver. 3545f5bac82SMichał Mirosław * 3555f5bac82SMichał Mirosław * Original driver set bit 14 for MMC/SD application 3565f5bac82SMichał Mirosław * commands. There's no difference 'on the wire' and 3575f5bac82SMichał Mirosław * it apparently works without it anyway. 3585f5bac82SMichał Mirosław */ 3595f5bac82SMichał Mirosław 3605f5bac82SMichał Mirosław switch (flags & MMC_CMD_MASK) { 3615f5bac82SMichał Mirosław case MMC_CMD_AC: cb_flags = CB710_MMC_CMD_AC; break; 3625f5bac82SMichał Mirosław case MMC_CMD_ADTC: cb_flags = CB710_MMC_CMD_ADTC; break; 3635f5bac82SMichał Mirosław case MMC_CMD_BC: cb_flags = CB710_MMC_CMD_BC; break; 3645f5bac82SMichał Mirosław case MMC_CMD_BCR: cb_flags = CB710_MMC_CMD_BCR; break; 3655f5bac82SMichał Mirosław } 3665f5bac82SMichał Mirosław 3675f5bac82SMichał Mirosław if (flags & MMC_RSP_BUSY) 3685f5bac82SMichał Mirosław cb_flags |= CB710_MMC_RSP_BUSY; 3695f5bac82SMichał Mirosław 3705f5bac82SMichał Mirosław cb_flags |= cmd->opcode << CB710_MMC_CMD_CODE_SHIFT; 3715f5bac82SMichał Mirosław 3725f5bac82SMichał Mirosław if (cmd->data && (cmd->data->flags & MMC_DATA_READ)) 3735f5bac82SMichał Mirosław cb_flags |= CB710_MMC_DATA_READ; 3745f5bac82SMichał Mirosław 3755f5bac82SMichał Mirosław if (flags & MMC_RSP_PRESENT) { 3765f5bac82SMichał Mirosław /* Windows driver set 01 at bits 4,3 except for 3775f5bac82SMichał Mirosław * MMC_SET_BLOCKLEN where it set 10. Maybe the 3785f5bac82SMichał Mirosław * hardware can do something special about this 3795f5bac82SMichał Mirosław * command? The original driver looks buggy/incomplete 3805f5bac82SMichał Mirosław * anyway so we ignore this for now. 3815f5bac82SMichał Mirosław * 3825f5bac82SMichał Mirosław * I assume that 00 here means no response is expected. 3835f5bac82SMichał Mirosław */ 3845f5bac82SMichał Mirosław cb_flags |= CB710_MMC_RSP_PRESENT; 3855f5bac82SMichał Mirosław 3865f5bac82SMichał Mirosław if (flags & MMC_RSP_136) 3875f5bac82SMichał Mirosław cb_flags |= CB710_MMC_RSP_136; 3885f5bac82SMichał Mirosław if (!(flags & MMC_RSP_CRC)) 3895f5bac82SMichał Mirosław cb_flags |= CB710_MMC_RSP_NO_CRC; 3905f5bac82SMichał Mirosław } 3915f5bac82SMichał Mirosław 3925f5bac82SMichał Mirosław return cb_flags; 3935f5bac82SMichał Mirosław } 3945f5bac82SMichał Mirosław 3955f5bac82SMichał Mirosław static void cb710_receive_response(struct cb710_slot *slot, 3965f5bac82SMichał Mirosław struct mmc_command *cmd) 3975f5bac82SMichał Mirosław { 3985f5bac82SMichał Mirosław unsigned rsp_opcode, wanted_opcode; 3995f5bac82SMichał Mirosław 4005f5bac82SMichał Mirosław /* Looks like final byte with CRC is always stripped (same as SDHCI) */ 4015f5bac82SMichał Mirosław if (cmd->flags & MMC_RSP_136) { 4025f5bac82SMichał Mirosław u32 resp[4]; 4035f5bac82SMichał Mirosław 4045f5bac82SMichał Mirosław resp[0] = cb710_read_port_32(slot, CB710_MMC_RESPONSE3_PORT); 4055f5bac82SMichał Mirosław resp[1] = cb710_read_port_32(slot, CB710_MMC_RESPONSE2_PORT); 4065f5bac82SMichał Mirosław resp[2] = cb710_read_port_32(slot, CB710_MMC_RESPONSE1_PORT); 4075f5bac82SMichał Mirosław resp[3] = cb710_read_port_32(slot, CB710_MMC_RESPONSE0_PORT); 4085f5bac82SMichał Mirosław rsp_opcode = resp[0] >> 24; 4095f5bac82SMichał Mirosław 4105f5bac82SMichał Mirosław cmd->resp[0] = (resp[0] << 8)|(resp[1] >> 24); 4115f5bac82SMichał Mirosław cmd->resp[1] = (resp[1] << 8)|(resp[2] >> 24); 4125f5bac82SMichał Mirosław cmd->resp[2] = (resp[2] << 8)|(resp[3] >> 24); 4135f5bac82SMichał Mirosław cmd->resp[3] = (resp[3] << 8); 4145f5bac82SMichał Mirosław } else { 4155f5bac82SMichał Mirosław rsp_opcode = cb710_read_port_32(slot, CB710_MMC_RESPONSE1_PORT) & 0x3F; 4165f5bac82SMichał Mirosław cmd->resp[0] = cb710_read_port_32(slot, CB710_MMC_RESPONSE0_PORT); 4175f5bac82SMichał Mirosław } 4185f5bac82SMichał Mirosław 4195f5bac82SMichał Mirosław wanted_opcode = (cmd->flags & MMC_RSP_OPCODE) ? cmd->opcode : 0x3F; 4205f5bac82SMichał Mirosław if (rsp_opcode != wanted_opcode) 4215f5bac82SMichał Mirosław cmd->error = -EILSEQ; 4225f5bac82SMichał Mirosław } 4235f5bac82SMichał Mirosław 4245f5bac82SMichał Mirosław static int cb710_mmc_transfer_data(struct cb710_slot *slot, 4255f5bac82SMichał Mirosław struct mmc_data *data) 4265f5bac82SMichał Mirosław { 4275f5bac82SMichał Mirosław int error, to; 4285f5bac82SMichał Mirosław 4295f5bac82SMichał Mirosław if (data->flags & MMC_DATA_READ) 4305f5bac82SMichał Mirosław error = cb710_mmc_receive(slot, data); 4315f5bac82SMichał Mirosław else 4325f5bac82SMichał Mirosław error = cb710_mmc_send(slot, data); 4335f5bac82SMichał Mirosław 4345f5bac82SMichał Mirosław to = cb710_wait_for_event(slot, CB710_MMC_S1_DATA_TRANSFER_DONE); 4355f5bac82SMichał Mirosław if (!error) 4365f5bac82SMichał Mirosław error = to; 4375f5bac82SMichał Mirosław 4385f5bac82SMichał Mirosław if (!error) 4395f5bac82SMichał Mirosław data->bytes_xfered = data->blksz * data->blocks; 4405f5bac82SMichał Mirosław return error; 4415f5bac82SMichał Mirosław } 4425f5bac82SMichał Mirosław 4435f5bac82SMichał Mirosław static int cb710_mmc_command(struct mmc_host *mmc, struct mmc_command *cmd) 4445f5bac82SMichał Mirosław { 4455f5bac82SMichał Mirosław struct cb710_slot *slot = cb710_mmc_to_slot(mmc); 4465f5bac82SMichał Mirosław struct cb710_mmc_reader *reader = mmc_priv(mmc); 4475f5bac82SMichał Mirosław struct mmc_data *data = cmd->data; 4485f5bac82SMichał Mirosław 4495f5bac82SMichał Mirosław u16 cb_cmd = cb710_encode_cmd_flags(reader, cmd); 4505f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), "cmd request: 0x%04X\n", cb_cmd); 4515f5bac82SMichał Mirosław 4525f5bac82SMichał Mirosław if (data) { 4535f5bac82SMichał Mirosław if (!cb710_is_transfer_size_supported(data)) { 4545f5bac82SMichał Mirosław data->error = -EINVAL; 4555f5bac82SMichał Mirosław return -1; 4565f5bac82SMichał Mirosław } 4575f5bac82SMichał Mirosław cb710_mmc_set_transfer_size(slot, data->blocks, data->blksz); 4585f5bac82SMichał Mirosław } 4595f5bac82SMichał Mirosław 4605f5bac82SMichał Mirosław cb710_wait_while_busy(slot, CB710_MMC_S2_BUSY_20|CB710_MMC_S2_BUSY_10); 4615f5bac82SMichał Mirosław cb710_write_port_16(slot, CB710_MMC_CMD_TYPE_PORT, cb_cmd); 4625f5bac82SMichał Mirosław cb710_wait_while_busy(slot, CB710_MMC_S2_BUSY_20); 4635f5bac82SMichał Mirosław cb710_write_port_32(slot, CB710_MMC_CMD_PARAM_PORT, cmd->arg); 4645f5bac82SMichał Mirosław cb710_mmc_reset_events(slot); 4655f5bac82SMichał Mirosław cb710_wait_while_busy(slot, CB710_MMC_S2_BUSY_20); 4665f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG0_PORT, 0x01, 0); 4675f5bac82SMichał Mirosław 4685f5bac82SMichał Mirosław cmd->error = cb710_wait_for_event(slot, CB710_MMC_S1_COMMAND_SENT); 4695f5bac82SMichał Mirosław if (cmd->error) 4705f5bac82SMichał Mirosław return -1; 4715f5bac82SMichał Mirosław 4725f5bac82SMichał Mirosław if (cmd->flags & MMC_RSP_PRESENT) { 4735f5bac82SMichał Mirosław cb710_receive_response(slot, cmd); 4745f5bac82SMichał Mirosław if (cmd->error) 4755f5bac82SMichał Mirosław return -1; 4765f5bac82SMichał Mirosław } 4775f5bac82SMichał Mirosław 4785f5bac82SMichał Mirosław if (data) 4795f5bac82SMichał Mirosław data->error = cb710_mmc_transfer_data(slot, data); 4805f5bac82SMichał Mirosław return 0; 4815f5bac82SMichał Mirosław } 4825f5bac82SMichał Mirosław 4835f5bac82SMichał Mirosław static void cb710_mmc_request(struct mmc_host *mmc, struct mmc_request *mrq) 4845f5bac82SMichał Mirosław { 4855f5bac82SMichał Mirosław struct cb710_slot *slot = cb710_mmc_to_slot(mmc); 4865f5bac82SMichał Mirosław struct cb710_mmc_reader *reader = mmc_priv(mmc); 4875f5bac82SMichał Mirosław 4885f5bac82SMichał Mirosław WARN_ON(reader->mrq != NULL); 4895f5bac82SMichał Mirosław 4905f5bac82SMichał Mirosław reader->mrq = mrq; 4915f5bac82SMichał Mirosław cb710_mmc_enable_irq(slot, CB710_MMC_IE_TEST_MASK, 0); 4925f5bac82SMichał Mirosław 4935f5bac82SMichał Mirosław if (!cb710_mmc_command(mmc, mrq->cmd) && mrq->stop) 4945f5bac82SMichał Mirosław cb710_mmc_command(mmc, mrq->stop); 4955f5bac82SMichał Mirosław 4965f5bac82SMichał Mirosław tasklet_schedule(&reader->finish_req_tasklet); 4975f5bac82SMichał Mirosław } 4985f5bac82SMichał Mirosław 4995f5bac82SMichał Mirosław static int cb710_mmc_powerup(struct cb710_slot *slot) 5005f5bac82SMichał Mirosław { 5015f5bac82SMichał Mirosław #ifdef CONFIG_CB710_DEBUG 5025f5bac82SMichał Mirosław struct cb710_chip *chip = cb710_slot_to_chip(slot); 5035f5bac82SMichał Mirosław #endif 5045f5bac82SMichał Mirosław int err; 5055f5bac82SMichał Mirosław 50619d614a4SMichał Mirosław /* a lot of magic for now */ 5075f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), "bus powerup\n"); 5085f5bac82SMichał Mirosław cb710_dump_regs(chip, CB710_DUMP_REGS_MMC); 5095f5bac82SMichał Mirosław err = cb710_wait_while_busy(slot, CB710_MMC_S2_BUSY_20); 5105f5bac82SMichał Mirosław if (unlikely(err)) 5115f5bac82SMichał Mirosław return err; 5125f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG1_PORT, 0x80, 0); 5135f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG3_PORT, 0x80, 0); 5145f5bac82SMichał Mirosław cb710_dump_regs(chip, CB710_DUMP_REGS_MMC); 5155f5bac82SMichał Mirosław mdelay(1); 5165f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), "after delay 1\n"); 5175f5bac82SMichał Mirosław cb710_dump_regs(chip, CB710_DUMP_REGS_MMC); 5185f5bac82SMichał Mirosław err = cb710_wait_while_busy(slot, CB710_MMC_S2_BUSY_20); 5195f5bac82SMichał Mirosław if (unlikely(err)) 5205f5bac82SMichał Mirosław return err; 5215f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG1_PORT, 0x09, 0); 5225f5bac82SMichał Mirosław cb710_dump_regs(chip, CB710_DUMP_REGS_MMC); 5235f5bac82SMichał Mirosław mdelay(1); 5245f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), "after delay 2\n"); 5255f5bac82SMichał Mirosław cb710_dump_regs(chip, CB710_DUMP_REGS_MMC); 5265f5bac82SMichał Mirosław err = cb710_wait_while_busy(slot, CB710_MMC_S2_BUSY_20); 5275f5bac82SMichał Mirosław if (unlikely(err)) 5285f5bac82SMichał Mirosław return err; 5295f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG1_PORT, 0, 0x08); 5305f5bac82SMichał Mirosław cb710_dump_regs(chip, CB710_DUMP_REGS_MMC); 5315f5bac82SMichał Mirosław mdelay(2); 5325f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), "after delay 3\n"); 5335f5bac82SMichał Mirosław cb710_dump_regs(chip, CB710_DUMP_REGS_MMC); 5345f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG0_PORT, 0x06, 0); 5355f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG1_PORT, 0x70, 0); 5365f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG2_PORT, 0x80, 0); 5375f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG3_PORT, 0x03, 0); 5385f5bac82SMichał Mirosław cb710_dump_regs(chip, CB710_DUMP_REGS_MMC); 5395f5bac82SMichał Mirosław err = cb710_wait_while_busy(slot, CB710_MMC_S2_BUSY_20); 5405f5bac82SMichał Mirosław if (unlikely(err)) 5415f5bac82SMichał Mirosław return err; 5425f5bac82SMichał Mirosław /* This port behaves weird: quick byte reads of 0x08,0x09 return 5435f5bac82SMichał Mirosław * 0xFF,0x00 after writing 0xFFFF to 0x08; it works correctly when 5445f5bac82SMichał Mirosław * read/written from userspace... What am I missing here? 5455f5bac82SMichał Mirosław * (it doesn't depend on write-to-read delay) */ 5465f5bac82SMichał Mirosław cb710_write_port_16(slot, CB710_MMC_CONFIGB_PORT, 0xFFFF); 5475f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG0_PORT, 0x06, 0); 5485f5bac82SMichał Mirosław cb710_dump_regs(chip, CB710_DUMP_REGS_MMC); 5495f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), "bus powerup finished\n"); 5505f5bac82SMichał Mirosław 5515f5bac82SMichał Mirosław return cb710_check_event(slot, 0); 5525f5bac82SMichał Mirosław } 5535f5bac82SMichał Mirosław 5545f5bac82SMichał Mirosław static void cb710_mmc_powerdown(struct cb710_slot *slot) 5555f5bac82SMichał Mirosław { 5565f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG1_PORT, 0, 0x81); 5575f5bac82SMichał Mirosław cb710_modify_port_8(slot, CB710_MMC_CONFIG3_PORT, 0, 0x80); 5585f5bac82SMichał Mirosław } 5595f5bac82SMichał Mirosław 5605f5bac82SMichał Mirosław static void cb710_mmc_set_ios(struct mmc_host *mmc, struct mmc_ios *ios) 5615f5bac82SMichał Mirosław { 5625f5bac82SMichał Mirosław struct cb710_slot *slot = cb710_mmc_to_slot(mmc); 5635f5bac82SMichał Mirosław struct cb710_mmc_reader *reader = mmc_priv(mmc); 5645f5bac82SMichał Mirosław int err; 5655f5bac82SMichał Mirosław 56619d614a4SMichał Mirosław cb710_mmc_select_clock_divider(mmc, ios->clock); 5675f5bac82SMichał Mirosław 568c16e9b76SColin Ian King if (ios->power_mode != reader->last_power_mode) { 5695f5bac82SMichał Mirosław switch (ios->power_mode) { 5705f5bac82SMichał Mirosław case MMC_POWER_ON: 5715f5bac82SMichał Mirosław err = cb710_mmc_powerup(slot); 5725f5bac82SMichał Mirosław if (err) { 5735f5bac82SMichał Mirosław dev_warn(cb710_slot_dev(slot), 5745f5bac82SMichał Mirosław "powerup failed (%d)- retrying\n", err); 5755f5bac82SMichał Mirosław cb710_mmc_powerdown(slot); 5765f5bac82SMichał Mirosław udelay(1); 5775f5bac82SMichał Mirosław err = cb710_mmc_powerup(slot); 5785f5bac82SMichał Mirosław if (err) 5795f5bac82SMichał Mirosław dev_warn(cb710_slot_dev(slot), 5805f5bac82SMichał Mirosław "powerup retry failed (%d) - expect errors\n", 5815f5bac82SMichał Mirosław err); 5825f5bac82SMichał Mirosław } 5835f5bac82SMichał Mirosław reader->last_power_mode = MMC_POWER_ON; 5845f5bac82SMichał Mirosław break; 5855f5bac82SMichał Mirosław case MMC_POWER_OFF: 5865f5bac82SMichał Mirosław cb710_mmc_powerdown(slot); 5875f5bac82SMichał Mirosław reader->last_power_mode = MMC_POWER_OFF; 5885f5bac82SMichał Mirosław break; 5895f5bac82SMichał Mirosław case MMC_POWER_UP: 5905f5bac82SMichał Mirosław default: 591c16e9b76SColin Ian King /* ignore */ 592c16e9b76SColin Ian King break; 593c16e9b76SColin Ian King } 5945f5bac82SMichał Mirosław } 5955f5bac82SMichał Mirosław 5965f5bac82SMichał Mirosław cb710_mmc_enable_4bit_data(slot, ios->bus_width != MMC_BUS_WIDTH_1); 5975f5bac82SMichał Mirosław 5985f5bac82SMichał Mirosław cb710_mmc_enable_irq(slot, CB710_MMC_IE_TEST_MASK, 0); 5995f5bac82SMichał Mirosław } 6005f5bac82SMichał Mirosław 6015f5bac82SMichał Mirosław static int cb710_mmc_get_ro(struct mmc_host *mmc) 6025f5bac82SMichał Mirosław { 6035f5bac82SMichał Mirosław struct cb710_slot *slot = cb710_mmc_to_slot(mmc); 6045f5bac82SMichał Mirosław 6055f5bac82SMichał Mirosław return cb710_read_port_8(slot, CB710_MMC_STATUS3_PORT) 6065f5bac82SMichał Mirosław & CB710_MMC_S3_WRITE_PROTECTED; 6075f5bac82SMichał Mirosław } 6085f5bac82SMichał Mirosław 6097fcc4ce3SMichał Mirosław static int cb710_mmc_get_cd(struct mmc_host *mmc) 6107fcc4ce3SMichał Mirosław { 6117fcc4ce3SMichał Mirosław struct cb710_slot *slot = cb710_mmc_to_slot(mmc); 6127fcc4ce3SMichał Mirosław 6137fcc4ce3SMichał Mirosław return cb710_read_port_8(slot, CB710_MMC_STATUS3_PORT) 6147fcc4ce3SMichał Mirosław & CB710_MMC_S3_CARD_DETECTED; 6157fcc4ce3SMichał Mirosław } 6167fcc4ce3SMichał Mirosław 6175f5bac82SMichał Mirosław static int cb710_mmc_irq_handler(struct cb710_slot *slot) 6185f5bac82SMichał Mirosław { 6195f5bac82SMichał Mirosław struct mmc_host *mmc = cb710_slot_to_mmc(slot); 6205f5bac82SMichał Mirosław struct cb710_mmc_reader *reader = mmc_priv(mmc); 6215f5bac82SMichał Mirosław u32 status, config1, config2, irqen; 6225f5bac82SMichał Mirosław 6235f5bac82SMichał Mirosław status = cb710_read_port_32(slot, CB710_MMC_STATUS_PORT); 6245f5bac82SMichał Mirosław irqen = cb710_read_port_32(slot, CB710_MMC_IRQ_ENABLE_PORT); 6255f5bac82SMichał Mirosław config2 = cb710_read_port_32(slot, CB710_MMC_CONFIGB_PORT); 6265f5bac82SMichał Mirosław config1 = cb710_read_port_32(slot, CB710_MMC_CONFIG_PORT); 6275f5bac82SMichał Mirosław 6285f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), "interrupt; status: %08X, " 6295f5bac82SMichał Mirosław "ie: %08X, c2: %08X, c1: %08X\n", 6305f5bac82SMichał Mirosław status, irqen, config2, config1); 6315f5bac82SMichał Mirosław 6325f5bac82SMichał Mirosław if (status & (CB710_MMC_S1_CARD_CHANGED << 8)) { 6335f5bac82SMichał Mirosław /* ack the event */ 6345f5bac82SMichał Mirosław cb710_write_port_8(slot, CB710_MMC_STATUS1_PORT, 6355f5bac82SMichał Mirosław CB710_MMC_S1_CARD_CHANGED); 6365f5bac82SMichał Mirosław if ((irqen & CB710_MMC_IE_CISTATUS_MASK) 6375f5bac82SMichał Mirosław == CB710_MMC_IE_CISTATUS_MASK) 6385f5bac82SMichał Mirosław mmc_detect_change(mmc, HZ/5); 6395f5bac82SMichał Mirosław } else { 6405f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), "unknown interrupt (test)\n"); 6415f5bac82SMichał Mirosław spin_lock(&reader->irq_lock); 6425f5bac82SMichał Mirosław __cb710_mmc_enable_irq(slot, 0, CB710_MMC_IE_TEST_MASK); 6435f5bac82SMichał Mirosław spin_unlock(&reader->irq_lock); 6445f5bac82SMichał Mirosław } 6455f5bac82SMichał Mirosław 6465f5bac82SMichał Mirosław return 1; 6475f5bac82SMichał Mirosław } 6485f5bac82SMichał Mirosław 6495f5bac82SMichał Mirosław static void cb710_mmc_finish_request_tasklet(unsigned long data) 6505f5bac82SMichał Mirosław { 6515f5bac82SMichał Mirosław struct mmc_host *mmc = (void *)data; 6525f5bac82SMichał Mirosław struct cb710_mmc_reader *reader = mmc_priv(mmc); 6535f5bac82SMichał Mirosław struct mmc_request *mrq = reader->mrq; 6545f5bac82SMichał Mirosław 6555f5bac82SMichał Mirosław reader->mrq = NULL; 6565f5bac82SMichał Mirosław mmc_request_done(mmc, mrq); 6575f5bac82SMichał Mirosław } 6585f5bac82SMichał Mirosław 6595f5bac82SMichał Mirosław static const struct mmc_host_ops cb710_mmc_host = { 6605f5bac82SMichał Mirosław .request = cb710_mmc_request, 6615f5bac82SMichał Mirosław .set_ios = cb710_mmc_set_ios, 6627fcc4ce3SMichał Mirosław .get_ro = cb710_mmc_get_ro, 6637fcc4ce3SMichał Mirosław .get_cd = cb710_mmc_get_cd, 6645f5bac82SMichał Mirosław }; 6655f5bac82SMichał Mirosław 6665f5bac82SMichał Mirosław #ifdef CONFIG_PM 6675f5bac82SMichał Mirosław 6685f5bac82SMichał Mirosław static int cb710_mmc_suspend(struct platform_device *pdev, pm_message_t state) 6695f5bac82SMichał Mirosław { 6705f5bac82SMichał Mirosław struct cb710_slot *slot = cb710_pdev_to_slot(pdev); 6715f5bac82SMichał Mirosław 6725f5bac82SMichał Mirosław cb710_mmc_enable_irq(slot, 0, ~0); 6735f5bac82SMichał Mirosław return 0; 6745f5bac82SMichał Mirosław } 6755f5bac82SMichał Mirosław 6765f5bac82SMichał Mirosław static int cb710_mmc_resume(struct platform_device *pdev) 6775f5bac82SMichał Mirosław { 6785f5bac82SMichał Mirosław struct cb710_slot *slot = cb710_pdev_to_slot(pdev); 6795f5bac82SMichał Mirosław 6805f5bac82SMichał Mirosław cb710_mmc_enable_irq(slot, 0, ~0); 681d978a2b6SUlf Hansson return 0; 6825f5bac82SMichał Mirosław } 6835f5bac82SMichał Mirosław 6845f5bac82SMichał Mirosław #endif /* CONFIG_PM */ 6855f5bac82SMichał Mirosław 686c3be1efdSBill Pemberton static int cb710_mmc_init(struct platform_device *pdev) 6875f5bac82SMichał Mirosław { 6885f5bac82SMichał Mirosław struct cb710_slot *slot = cb710_pdev_to_slot(pdev); 6895f5bac82SMichał Mirosław struct cb710_chip *chip = cb710_slot_to_chip(slot); 6905f5bac82SMichał Mirosław struct mmc_host *mmc; 6915f5bac82SMichał Mirosław struct cb710_mmc_reader *reader; 6925f5bac82SMichał Mirosław int err; 6935f5bac82SMichał Mirosław u32 val; 6945f5bac82SMichał Mirosław 6955f5bac82SMichał Mirosław mmc = mmc_alloc_host(sizeof(*reader), cb710_slot_dev(slot)); 6965f5bac82SMichał Mirosław if (!mmc) 6975f5bac82SMichał Mirosław return -ENOMEM; 6985f5bac82SMichał Mirosław 6996e2c0f3fSJingoo Han platform_set_drvdata(pdev, mmc); 7005f5bac82SMichał Mirosław 7015f5bac82SMichał Mirosław /* harmless (maybe) magic */ 7025f5bac82SMichał Mirosław pci_read_config_dword(chip->pdev, 0x48, &val); 7035f5bac82SMichał Mirosław val = cb710_src_freq_mhz[(val >> 16) & 0xF]; 7045f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), "source frequency: %dMHz\n", val); 7055f5bac82SMichał Mirosław val *= 1000000; 7065f5bac82SMichał Mirosław 7075f5bac82SMichał Mirosław mmc->ops = &cb710_mmc_host; 7085f5bac82SMichał Mirosław mmc->f_max = val; 7095f5bac82SMichał Mirosław mmc->f_min = val >> cb710_clock_divider_log2[CB710_MAX_DIVIDER_IDX]; 7105f5bac82SMichał Mirosław mmc->ocr_avail = MMC_VDD_32_33|MMC_VDD_33_34; 7115f5bac82SMichał Mirosław mmc->caps = MMC_CAP_4_BIT_DATA; 71285a3f77cSUlf Hansson /* 71385a3f77cSUlf Hansson * In cb710_wait_for_event() we use a fixed timeout of ~2s, hence let's 71485a3f77cSUlf Hansson * inform the core about it. A future improvement should instead make 71585a3f77cSUlf Hansson * use of the cmd->busy_timeout. 71685a3f77cSUlf Hansson */ 71785a3f77cSUlf Hansson mmc->max_busy_timeout = CB710_MMC_REQ_TIMEOUT_MS; 7185f5bac82SMichał Mirosław 7195f5bac82SMichał Mirosław reader = mmc_priv(mmc); 7205f5bac82SMichał Mirosław 7215f5bac82SMichał Mirosław tasklet_init(&reader->finish_req_tasklet, 7225f5bac82SMichał Mirosław cb710_mmc_finish_request_tasklet, (unsigned long)mmc); 7235f5bac82SMichał Mirosław spin_lock_init(&reader->irq_lock); 7245f5bac82SMichał Mirosław cb710_dump_regs(chip, CB710_DUMP_REGS_MMC); 7255f5bac82SMichał Mirosław 7265f5bac82SMichał Mirosław cb710_mmc_enable_irq(slot, 0, ~0); 7275f5bac82SMichał Mirosław cb710_set_irq_handler(slot, cb710_mmc_irq_handler); 7285f5bac82SMichał Mirosław 7295f5bac82SMichał Mirosław err = mmc_add_host(mmc); 7305f5bac82SMichał Mirosław if (unlikely(err)) 7315f5bac82SMichał Mirosław goto err_free_mmc; 7325f5bac82SMichał Mirosław 7335f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), "mmc_hostname is %s\n", 7345f5bac82SMichał Mirosław mmc_hostname(mmc)); 7355f5bac82SMichał Mirosław 7365f5bac82SMichał Mirosław cb710_mmc_enable_irq(slot, CB710_MMC_IE_CARD_INSERTION_STATUS, 0); 7375f5bac82SMichał Mirosław 7385f5bac82SMichał Mirosław return 0; 7395f5bac82SMichał Mirosław 7405f5bac82SMichał Mirosław err_free_mmc: 7415f5bac82SMichał Mirosław dev_dbg(cb710_slot_dev(slot), "mmc_add_host() failed: %d\n", err); 7425f5bac82SMichał Mirosław 743e0780db9SMichał Mirosław cb710_set_irq_handler(slot, NULL); 7445f5bac82SMichał Mirosław mmc_free_host(mmc); 7455f5bac82SMichał Mirosław return err; 7465f5bac82SMichał Mirosław } 7475f5bac82SMichał Mirosław 7486e0ee714SBill Pemberton static int cb710_mmc_exit(struct platform_device *pdev) 7495f5bac82SMichał Mirosław { 7505f5bac82SMichał Mirosław struct cb710_slot *slot = cb710_pdev_to_slot(pdev); 7515f5bac82SMichał Mirosław struct mmc_host *mmc = cb710_slot_to_mmc(slot); 7525f5bac82SMichał Mirosław struct cb710_mmc_reader *reader = mmc_priv(mmc); 7535f5bac82SMichał Mirosław 7545f5bac82SMichał Mirosław cb710_mmc_enable_irq(slot, 0, CB710_MMC_IE_CARD_INSERTION_STATUS); 7555f5bac82SMichał Mirosław 7565f5bac82SMichał Mirosław mmc_remove_host(mmc); 7575f5bac82SMichał Mirosław 7585f5bac82SMichał Mirosław /* IRQs should be disabled now, but let's stay on the safe side */ 7595f5bac82SMichał Mirosław cb710_mmc_enable_irq(slot, 0, ~0); 7605f5bac82SMichał Mirosław cb710_set_irq_handler(slot, NULL); 7615f5bac82SMichał Mirosław 7625f5bac82SMichał Mirosław /* clear config ports - just in case */ 7635f5bac82SMichał Mirosław cb710_write_port_32(slot, CB710_MMC_CONFIG_PORT, 0); 7645f5bac82SMichał Mirosław cb710_write_port_16(slot, CB710_MMC_CONFIGB_PORT, 0); 7655f5bac82SMichał Mirosław 7665f5bac82SMichał Mirosław tasklet_kill(&reader->finish_req_tasklet); 7675f5bac82SMichał Mirosław 7685f5bac82SMichał Mirosław mmc_free_host(mmc); 7695f5bac82SMichał Mirosław return 0; 7705f5bac82SMichał Mirosław } 7715f5bac82SMichał Mirosław 7725f5bac82SMichał Mirosław static struct platform_driver cb710_mmc_driver = { 7735f5bac82SMichał Mirosław .driver.name = "cb710-mmc", 7745f5bac82SMichał Mirosław .probe = cb710_mmc_init, 7750433c143SBill Pemberton .remove = cb710_mmc_exit, 7765f5bac82SMichał Mirosław #ifdef CONFIG_PM 7775f5bac82SMichał Mirosław .suspend = cb710_mmc_suspend, 7785f5bac82SMichał Mirosław .resume = cb710_mmc_resume, 7795f5bac82SMichał Mirosław #endif 7805f5bac82SMichał Mirosław }; 7815f5bac82SMichał Mirosław 782d1f81a64SAxel Lin module_platform_driver(cb710_mmc_driver); 7835f5bac82SMichał Mirosław 7845f5bac82SMichał Mirosław MODULE_AUTHOR("Michał Mirosław <mirq-linux@rere.qmqm.pl>"); 7855f5bac82SMichał Mirosław MODULE_DESCRIPTION("ENE CB710 memory card reader driver - MMC/SD part"); 7865f5bac82SMichał Mirosław MODULE_LICENSE("GPL"); 7875f5bac82SMichał Mirosław MODULE_ALIAS("platform:cb710-mmc"); 788