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