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