1831f5dcfSAlexander Motin /*- 2831f5dcfSAlexander Motin * Copyright (c) 2008 Alexander Motin <mav@FreeBSD.org> 3831f5dcfSAlexander Motin * All rights reserved. 4831f5dcfSAlexander Motin * 5831f5dcfSAlexander Motin * Redistribution and use in source and binary forms, with or without 6831f5dcfSAlexander Motin * modification, are permitted provided that the following conditions 7831f5dcfSAlexander Motin * are met: 8831f5dcfSAlexander Motin * 1. Redistributions of source code must retain the above copyright 9831f5dcfSAlexander Motin * notice, this list of conditions and the following disclaimer. 10831f5dcfSAlexander Motin * 2. Redistributions in binary form must reproduce the above copyright 11831f5dcfSAlexander Motin * notice, this list of conditions and the following disclaimer in the 12831f5dcfSAlexander Motin * documentation and/or other materials provided with the distribution. 13831f5dcfSAlexander Motin * 14831f5dcfSAlexander Motin * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 15831f5dcfSAlexander Motin * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 16831f5dcfSAlexander Motin * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 17831f5dcfSAlexander Motin * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 18831f5dcfSAlexander Motin * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 19831f5dcfSAlexander Motin * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 20831f5dcfSAlexander Motin * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 21831f5dcfSAlexander Motin * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 22831f5dcfSAlexander Motin * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 23831f5dcfSAlexander Motin * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 24831f5dcfSAlexander Motin */ 25831f5dcfSAlexander Motin 26831f5dcfSAlexander Motin #include <sys/cdefs.h> 27831f5dcfSAlexander Motin __FBSDID("$FreeBSD$"); 28831f5dcfSAlexander Motin 29831f5dcfSAlexander Motin #include <sys/param.h> 30831f5dcfSAlexander Motin #include <sys/systm.h> 31831f5dcfSAlexander Motin #include <sys/bus.h> 32831f5dcfSAlexander Motin #include <sys/conf.h> 33831f5dcfSAlexander Motin #include <sys/kernel.h> 34831f5dcfSAlexander Motin #include <sys/lock.h> 35831f5dcfSAlexander Motin #include <sys/module.h> 36831f5dcfSAlexander Motin #include <sys/mutex.h> 37831f5dcfSAlexander Motin #include <sys/resource.h> 38831f5dcfSAlexander Motin #include <sys/rman.h> 395b69a497SAlexander Motin #include <sys/sysctl.h> 40831f5dcfSAlexander Motin #include <sys/taskqueue.h> 41831f5dcfSAlexander Motin 42831f5dcfSAlexander Motin #include <machine/bus.h> 43831f5dcfSAlexander Motin #include <machine/resource.h> 44831f5dcfSAlexander Motin #include <machine/stdarg.h> 45831f5dcfSAlexander Motin 46831f5dcfSAlexander Motin #include <dev/mmc/bridge.h> 47831f5dcfSAlexander Motin #include <dev/mmc/mmcreg.h> 48831f5dcfSAlexander Motin #include <dev/mmc/mmcbrvar.h> 49831f5dcfSAlexander Motin 50831f5dcfSAlexander Motin #include "mmcbr_if.h" 51831f5dcfSAlexander Motin #include "sdhci.h" 52d6b3aaf8SOleksandr Tymoshenko #include "sdhci_if.h" 53831f5dcfSAlexander Motin 54831f5dcfSAlexander Motin struct sdhci_softc; 55831f5dcfSAlexander Motin 56831f5dcfSAlexander Motin struct sdhci_softc { 57831f5dcfSAlexander Motin device_t dev; /* Controller device */ 58831f5dcfSAlexander Motin struct resource *irq_res; /* IRQ resource */ 59831f5dcfSAlexander Motin int irq_rid; 60831f5dcfSAlexander Motin void *intrhand; /* Interrupt handle */ 61831f5dcfSAlexander Motin 62831f5dcfSAlexander Motin int num_slots; /* Number of slots on this controller */ 63831f5dcfSAlexander Motin struct sdhci_slot slots[6]; 64831f5dcfSAlexander Motin }; 65831f5dcfSAlexander Motin 666472ac3dSEd Schouten static SYSCTL_NODE(_hw, OID_AUTO, sdhci, CTLFLAG_RD, 0, "sdhci driver"); 675b69a497SAlexander Motin 687337a22fSOleksandr Tymoshenko int sdhci_debug = 0; 695b69a497SAlexander Motin TUNABLE_INT("hw.sdhci.debug", &sdhci_debug); 705b69a497SAlexander Motin SYSCTL_INT(_hw_sdhci, OID_AUTO, debug, CTLFLAG_RW, &sdhci_debug, 0, "Debug level"); 715b69a497SAlexander Motin 72d6b3aaf8SOleksandr Tymoshenko #define RD1(slot, off) SDHCI_READ_1((slot)->bus, (slot), (off)) 73d6b3aaf8SOleksandr Tymoshenko #define RD2(slot, off) SDHCI_READ_2((slot)->bus, (slot), (off)) 74d6b3aaf8SOleksandr Tymoshenko #define RD4(slot, off) SDHCI_READ_4((slot)->bus, (slot), (off)) 75d6b3aaf8SOleksandr Tymoshenko #define RD_MULTI_4(slot, off, ptr, count) \ 76d6b3aaf8SOleksandr Tymoshenko SDHCI_READ_MULTI_4((slot)->bus, (slot), (off), (ptr), (count)) 77831f5dcfSAlexander Motin 78d6b3aaf8SOleksandr Tymoshenko #define WR1(slot, off, val) SDHCI_WRITE_1((slot)->bus, (slot), (off), (val)) 79d6b3aaf8SOleksandr Tymoshenko #define WR2(slot, off, val) SDHCI_WRITE_2((slot)->bus, (slot), (off), (val)) 80d6b3aaf8SOleksandr Tymoshenko #define WR4(slot, off, val) SDHCI_WRITE_4((slot)->bus, (slot), (off), (val)) 81d6b3aaf8SOleksandr Tymoshenko #define WR_MULTI_4(slot, off, ptr, count) \ 82d6b3aaf8SOleksandr Tymoshenko SDHCI_WRITE_MULTI_4((slot)->bus, (slot), (off), (ptr), (count)) 83831f5dcfSAlexander Motin 84831f5dcfSAlexander Motin static void sdhci_set_clock(struct sdhci_slot *slot, uint32_t clock); 85831f5dcfSAlexander Motin static void sdhci_start(struct sdhci_slot *slot); 86831f5dcfSAlexander Motin static void sdhci_start_data(struct sdhci_slot *slot, struct mmc_data *data); 87831f5dcfSAlexander Motin 88831f5dcfSAlexander Motin static void sdhci_card_task(void *, int); 89831f5dcfSAlexander Motin 90831f5dcfSAlexander Motin /* helper routines */ 91831f5dcfSAlexander Motin #define SDHCI_LOCK(_slot) mtx_lock(&(_slot)->mtx) 92831f5dcfSAlexander Motin #define SDHCI_UNLOCK(_slot) mtx_unlock(&(_slot)->mtx) 93831f5dcfSAlexander Motin #define SDHCI_LOCK_INIT(_slot) \ 94831f5dcfSAlexander Motin mtx_init(&_slot->mtx, "SD slot mtx", "sdhci", MTX_DEF) 95831f5dcfSAlexander Motin #define SDHCI_LOCK_DESTROY(_slot) mtx_destroy(&_slot->mtx); 96831f5dcfSAlexander Motin #define SDHCI_ASSERT_LOCKED(_slot) mtx_assert(&_slot->mtx, MA_OWNED); 97831f5dcfSAlexander Motin #define SDHCI_ASSERT_UNLOCKED(_slot) mtx_assert(&_slot->mtx, MA_NOTOWNED); 98831f5dcfSAlexander Motin 9933aad34dSOleksandr Tymoshenko #define SDHCI_DEFAULT_MAX_FREQ 50 10033aad34dSOleksandr Tymoshenko 10157677a3aSOleksandr Tymoshenko #define SDHCI_200_MAX_DIVIDER 256 10257677a3aSOleksandr Tymoshenko #define SDHCI_300_MAX_DIVIDER 2046 10357677a3aSOleksandr Tymoshenko 104831f5dcfSAlexander Motin static void 105831f5dcfSAlexander Motin sdhci_getaddr(void *arg, bus_dma_segment_t *segs, int nsegs, int error) 106831f5dcfSAlexander Motin { 107831f5dcfSAlexander Motin if (error != 0) { 108831f5dcfSAlexander Motin printf("getaddr: error %d\n", error); 109831f5dcfSAlexander Motin return; 110831f5dcfSAlexander Motin } 111831f5dcfSAlexander Motin *(bus_addr_t *)arg = segs[0].ds_addr; 112831f5dcfSAlexander Motin } 113831f5dcfSAlexander Motin 114d6b3aaf8SOleksandr Tymoshenko static int 115d6b3aaf8SOleksandr Tymoshenko slot_printf(struct sdhci_slot *slot, const char * fmt, ...) 116d6b3aaf8SOleksandr Tymoshenko { 117d6b3aaf8SOleksandr Tymoshenko va_list ap; 118d6b3aaf8SOleksandr Tymoshenko int retval; 119d6b3aaf8SOleksandr Tymoshenko 120d6b3aaf8SOleksandr Tymoshenko retval = printf("%s-slot%d: ", 121d6b3aaf8SOleksandr Tymoshenko device_get_nameunit(slot->bus), slot->num); 122d6b3aaf8SOleksandr Tymoshenko 123d6b3aaf8SOleksandr Tymoshenko va_start(ap, fmt); 124d6b3aaf8SOleksandr Tymoshenko retval += vprintf(fmt, ap); 125d6b3aaf8SOleksandr Tymoshenko va_end(ap); 126d6b3aaf8SOleksandr Tymoshenko return (retval); 127d6b3aaf8SOleksandr Tymoshenko } 128d6b3aaf8SOleksandr Tymoshenko 129831f5dcfSAlexander Motin static void 130831f5dcfSAlexander Motin sdhci_dumpregs(struct sdhci_slot *slot) 131831f5dcfSAlexander Motin { 132831f5dcfSAlexander Motin slot_printf(slot, 133831f5dcfSAlexander Motin "============== REGISTER DUMP ==============\n"); 134831f5dcfSAlexander Motin 135831f5dcfSAlexander Motin slot_printf(slot, "Sys addr: 0x%08x | Version: 0x%08x\n", 136831f5dcfSAlexander Motin RD4(slot, SDHCI_DMA_ADDRESS), RD2(slot, SDHCI_HOST_VERSION)); 137831f5dcfSAlexander Motin slot_printf(slot, "Blk size: 0x%08x | Blk cnt: 0x%08x\n", 138831f5dcfSAlexander Motin RD2(slot, SDHCI_BLOCK_SIZE), RD2(slot, SDHCI_BLOCK_COUNT)); 139831f5dcfSAlexander Motin slot_printf(slot, "Argument: 0x%08x | Trn mode: 0x%08x\n", 140831f5dcfSAlexander Motin RD4(slot, SDHCI_ARGUMENT), RD2(slot, SDHCI_TRANSFER_MODE)); 141831f5dcfSAlexander Motin slot_printf(slot, "Present: 0x%08x | Host ctl: 0x%08x\n", 142831f5dcfSAlexander Motin RD4(slot, SDHCI_PRESENT_STATE), RD1(slot, SDHCI_HOST_CONTROL)); 143831f5dcfSAlexander Motin slot_printf(slot, "Power: 0x%08x | Blk gap: 0x%08x\n", 144831f5dcfSAlexander Motin RD1(slot, SDHCI_POWER_CONTROL), RD1(slot, SDHCI_BLOCK_GAP_CONTROL)); 145831f5dcfSAlexander Motin slot_printf(slot, "Wake-up: 0x%08x | Clock: 0x%08x\n", 146831f5dcfSAlexander Motin RD1(slot, SDHCI_WAKE_UP_CONTROL), RD2(slot, SDHCI_CLOCK_CONTROL)); 147831f5dcfSAlexander Motin slot_printf(slot, "Timeout: 0x%08x | Int stat: 0x%08x\n", 148831f5dcfSAlexander Motin RD1(slot, SDHCI_TIMEOUT_CONTROL), RD4(slot, SDHCI_INT_STATUS)); 149831f5dcfSAlexander Motin slot_printf(slot, "Int enab: 0x%08x | Sig enab: 0x%08x\n", 150831f5dcfSAlexander Motin RD4(slot, SDHCI_INT_ENABLE), RD4(slot, SDHCI_SIGNAL_ENABLE)); 151831f5dcfSAlexander Motin slot_printf(slot, "AC12 err: 0x%08x | Slot int: 0x%08x\n", 152831f5dcfSAlexander Motin RD2(slot, SDHCI_ACMD12_ERR), RD2(slot, SDHCI_SLOT_INT_STATUS)); 153831f5dcfSAlexander Motin slot_printf(slot, "Caps: 0x%08x | Max curr: 0x%08x\n", 154831f5dcfSAlexander Motin RD4(slot, SDHCI_CAPABILITIES), RD4(slot, SDHCI_MAX_CURRENT)); 155831f5dcfSAlexander Motin 156831f5dcfSAlexander Motin slot_printf(slot, 157831f5dcfSAlexander Motin "===========================================\n"); 158831f5dcfSAlexander Motin } 159831f5dcfSAlexander Motin 160831f5dcfSAlexander Motin static void 161831f5dcfSAlexander Motin sdhci_reset(struct sdhci_slot *slot, uint8_t mask) 162831f5dcfSAlexander Motin { 163831f5dcfSAlexander Motin int timeout; 164831f5dcfSAlexander Motin uint8_t res; 165831f5dcfSAlexander Motin 166d6b3aaf8SOleksandr Tymoshenko if (slot->quirks & SDHCI_QUIRK_NO_CARD_NO_RESET) { 167831f5dcfSAlexander Motin if (!(RD4(slot, SDHCI_PRESENT_STATE) & 168831f5dcfSAlexander Motin SDHCI_CARD_PRESENT)) 169831f5dcfSAlexander Motin return; 170831f5dcfSAlexander Motin } 171831f5dcfSAlexander Motin 172831f5dcfSAlexander Motin /* Some controllers need this kick or reset won't work. */ 173831f5dcfSAlexander Motin if ((mask & SDHCI_RESET_ALL) == 0 && 174d6b3aaf8SOleksandr Tymoshenko (slot->quirks & SDHCI_QUIRK_CLOCK_BEFORE_RESET)) { 175831f5dcfSAlexander Motin uint32_t clock; 176831f5dcfSAlexander Motin 177831f5dcfSAlexander Motin /* This is to force an update */ 178831f5dcfSAlexander Motin clock = slot->clock; 179831f5dcfSAlexander Motin slot->clock = 0; 180831f5dcfSAlexander Motin sdhci_set_clock(slot, clock); 181831f5dcfSAlexander Motin } 182831f5dcfSAlexander Motin 183831f5dcfSAlexander Motin WR1(slot, SDHCI_SOFTWARE_RESET, mask); 184831f5dcfSAlexander Motin 185d8208d9eSAlexander Motin if (mask & SDHCI_RESET_ALL) { 186831f5dcfSAlexander Motin slot->clock = 0; 187d8208d9eSAlexander Motin slot->power = 0; 188d8208d9eSAlexander Motin } 189831f5dcfSAlexander Motin 190831f5dcfSAlexander Motin /* Wait max 100 ms */ 191831f5dcfSAlexander Motin timeout = 100; 192831f5dcfSAlexander Motin /* Controller clears the bits when it's done */ 193831f5dcfSAlexander Motin while ((res = RD1(slot, SDHCI_SOFTWARE_RESET)) & mask) { 194831f5dcfSAlexander Motin if (timeout == 0) { 195831f5dcfSAlexander Motin slot_printf(slot, 196831f5dcfSAlexander Motin "Reset 0x%x never completed - 0x%x.\n", 197831f5dcfSAlexander Motin (int)mask, (int)res); 198831f5dcfSAlexander Motin sdhci_dumpregs(slot); 199831f5dcfSAlexander Motin return; 200831f5dcfSAlexander Motin } 201831f5dcfSAlexander Motin timeout--; 202831f5dcfSAlexander Motin DELAY(1000); 203831f5dcfSAlexander Motin } 204831f5dcfSAlexander Motin } 205831f5dcfSAlexander Motin 206831f5dcfSAlexander Motin static void 207831f5dcfSAlexander Motin sdhci_init(struct sdhci_slot *slot) 208831f5dcfSAlexander Motin { 209831f5dcfSAlexander Motin 210831f5dcfSAlexander Motin sdhci_reset(slot, SDHCI_RESET_ALL); 211831f5dcfSAlexander Motin 212831f5dcfSAlexander Motin /* Enable interrupts. */ 213831f5dcfSAlexander Motin slot->intmask = SDHCI_INT_BUS_POWER | SDHCI_INT_DATA_END_BIT | 214831f5dcfSAlexander Motin SDHCI_INT_DATA_CRC | SDHCI_INT_DATA_TIMEOUT | SDHCI_INT_INDEX | 215831f5dcfSAlexander Motin SDHCI_INT_END_BIT | SDHCI_INT_CRC | SDHCI_INT_TIMEOUT | 216831f5dcfSAlexander Motin SDHCI_INT_CARD_REMOVE | SDHCI_INT_CARD_INSERT | 217831f5dcfSAlexander Motin SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL | 218831f5dcfSAlexander Motin SDHCI_INT_DMA_END | SDHCI_INT_DATA_END | SDHCI_INT_RESPONSE | 219831f5dcfSAlexander Motin SDHCI_INT_ACMD12ERR; 220831f5dcfSAlexander Motin WR4(slot, SDHCI_INT_ENABLE, slot->intmask); 221831f5dcfSAlexander Motin WR4(slot, SDHCI_SIGNAL_ENABLE, slot->intmask); 222831f5dcfSAlexander Motin } 223831f5dcfSAlexander Motin 224831f5dcfSAlexander Motin static void 225831f5dcfSAlexander Motin sdhci_set_clock(struct sdhci_slot *slot, uint32_t clock) 226831f5dcfSAlexander Motin { 227831f5dcfSAlexander Motin uint32_t res; 228831f5dcfSAlexander Motin uint16_t clk; 2298f3b7d56SOleksandr Tymoshenko uint16_t div; 230831f5dcfSAlexander Motin int timeout; 231831f5dcfSAlexander Motin 232831f5dcfSAlexander Motin if (clock == slot->clock) 233831f5dcfSAlexander Motin return; 234831f5dcfSAlexander Motin slot->clock = clock; 235831f5dcfSAlexander Motin 236831f5dcfSAlexander Motin /* Turn off the clock. */ 237831f5dcfSAlexander Motin WR2(slot, SDHCI_CLOCK_CONTROL, 0); 238831f5dcfSAlexander Motin /* If no clock requested - left it so. */ 239831f5dcfSAlexander Motin if (clock == 0) 240831f5dcfSAlexander Motin return; 2418f3b7d56SOleksandr Tymoshenko if (slot->version < SDHCI_SPEC_300) { 242831f5dcfSAlexander Motin /* Looking for highest freq <= clock. */ 243831f5dcfSAlexander Motin res = slot->max_clk; 24457677a3aSOleksandr Tymoshenko for (div = 1; div < SDHCI_200_MAX_DIVIDER; div <<= 1) { 245831f5dcfSAlexander Motin if (res <= clock) 246831f5dcfSAlexander Motin break; 247831f5dcfSAlexander Motin res >>= 1; 248831f5dcfSAlexander Motin } 249831f5dcfSAlexander Motin /* Divider 1:1 is 0x00, 2:1 is 0x01, 256:1 is 0x80 ... */ 2508f3b7d56SOleksandr Tymoshenko div >>= 1; 2518f3b7d56SOleksandr Tymoshenko } 2528f3b7d56SOleksandr Tymoshenko else { 2538f3b7d56SOleksandr Tymoshenko /* Version 3.0 divisors are multiples of two up to 1023*2 */ 25457677a3aSOleksandr Tymoshenko if (clock >= slot->max_clk) 25557677a3aSOleksandr Tymoshenko div = 0; 2568f3b7d56SOleksandr Tymoshenko else { 25757677a3aSOleksandr Tymoshenko for (div = 2; div < SDHCI_300_MAX_DIVIDER; div += 2) { 2588f3b7d56SOleksandr Tymoshenko if ((slot->max_clk / div) <= clock) 2598f3b7d56SOleksandr Tymoshenko break; 2608f3b7d56SOleksandr Tymoshenko } 2618f3b7d56SOleksandr Tymoshenko } 2628f3b7d56SOleksandr Tymoshenko div >>= 1; 2638f3b7d56SOleksandr Tymoshenko } 2648f3b7d56SOleksandr Tymoshenko 2658f3b7d56SOleksandr Tymoshenko if (bootverbose || sdhci_debug) 2668f3b7d56SOleksandr Tymoshenko slot_printf(slot, "Divider %d for freq %d (max %d)\n", 2678f3b7d56SOleksandr Tymoshenko div, clock, slot->max_clk); 2688f3b7d56SOleksandr Tymoshenko 269831f5dcfSAlexander Motin /* Now we have got divider, set it. */ 2708f3b7d56SOleksandr Tymoshenko clk = (div & SDHCI_DIVIDER_MASK) << SDHCI_DIVIDER_SHIFT; 2718f3b7d56SOleksandr Tymoshenko clk |= ((div >> SDHCI_DIVIDER_MASK_LEN) & SDHCI_DIVIDER_HI_MASK) 2728f3b7d56SOleksandr Tymoshenko << SDHCI_DIVIDER_HI_SHIFT; 2738f3b7d56SOleksandr Tymoshenko 274831f5dcfSAlexander Motin WR2(slot, SDHCI_CLOCK_CONTROL, clk); 275831f5dcfSAlexander Motin /* Enable clock. */ 276831f5dcfSAlexander Motin clk |= SDHCI_CLOCK_INT_EN; 277831f5dcfSAlexander Motin WR2(slot, SDHCI_CLOCK_CONTROL, clk); 278831f5dcfSAlexander Motin /* Wait up to 10 ms until it stabilize. */ 279831f5dcfSAlexander Motin timeout = 10; 280831f5dcfSAlexander Motin while (!((clk = RD2(slot, SDHCI_CLOCK_CONTROL)) 281831f5dcfSAlexander Motin & SDHCI_CLOCK_INT_STABLE)) { 282831f5dcfSAlexander Motin if (timeout == 0) { 283831f5dcfSAlexander Motin slot_printf(slot, 284831f5dcfSAlexander Motin "Internal clock never stabilised.\n"); 285831f5dcfSAlexander Motin sdhci_dumpregs(slot); 286831f5dcfSAlexander Motin return; 287831f5dcfSAlexander Motin } 288831f5dcfSAlexander Motin timeout--; 289831f5dcfSAlexander Motin DELAY(1000); 290831f5dcfSAlexander Motin } 291831f5dcfSAlexander Motin /* Pass clock signal to the bus. */ 292831f5dcfSAlexander Motin clk |= SDHCI_CLOCK_CARD_EN; 293831f5dcfSAlexander Motin WR2(slot, SDHCI_CLOCK_CONTROL, clk); 294831f5dcfSAlexander Motin } 295831f5dcfSAlexander Motin 296831f5dcfSAlexander Motin static void 297831f5dcfSAlexander Motin sdhci_set_power(struct sdhci_slot *slot, u_char power) 298831f5dcfSAlexander Motin { 299831f5dcfSAlexander Motin uint8_t pwr; 300831f5dcfSAlexander Motin 301831f5dcfSAlexander Motin if (slot->power == power) 302831f5dcfSAlexander Motin return; 303d6b3aaf8SOleksandr Tymoshenko 304831f5dcfSAlexander Motin slot->power = power; 305831f5dcfSAlexander Motin 306831f5dcfSAlexander Motin /* Turn off the power. */ 307831f5dcfSAlexander Motin pwr = 0; 308831f5dcfSAlexander Motin WR1(slot, SDHCI_POWER_CONTROL, pwr); 309831f5dcfSAlexander Motin /* If power down requested - left it so. */ 310831f5dcfSAlexander Motin if (power == 0) 311831f5dcfSAlexander Motin return; 312831f5dcfSAlexander Motin /* Set voltage. */ 313831f5dcfSAlexander Motin switch (1 << power) { 314831f5dcfSAlexander Motin case MMC_OCR_LOW_VOLTAGE: 315831f5dcfSAlexander Motin pwr |= SDHCI_POWER_180; 316831f5dcfSAlexander Motin break; 317831f5dcfSAlexander Motin case MMC_OCR_290_300: 318831f5dcfSAlexander Motin case MMC_OCR_300_310: 319831f5dcfSAlexander Motin pwr |= SDHCI_POWER_300; 320831f5dcfSAlexander Motin break; 321831f5dcfSAlexander Motin case MMC_OCR_320_330: 322831f5dcfSAlexander Motin case MMC_OCR_330_340: 323831f5dcfSAlexander Motin pwr |= SDHCI_POWER_330; 324831f5dcfSAlexander Motin break; 325831f5dcfSAlexander Motin } 326831f5dcfSAlexander Motin WR1(slot, SDHCI_POWER_CONTROL, pwr); 327831f5dcfSAlexander Motin /* Turn on the power. */ 328831f5dcfSAlexander Motin pwr |= SDHCI_POWER_ON; 329831f5dcfSAlexander Motin WR1(slot, SDHCI_POWER_CONTROL, pwr); 330831f5dcfSAlexander Motin } 331831f5dcfSAlexander Motin 332831f5dcfSAlexander Motin static void 333831f5dcfSAlexander Motin sdhci_read_block_pio(struct sdhci_slot *slot) 334831f5dcfSAlexander Motin { 335831f5dcfSAlexander Motin uint32_t data; 336831f5dcfSAlexander Motin char *buffer; 337831f5dcfSAlexander Motin size_t left; 338831f5dcfSAlexander Motin 339831f5dcfSAlexander Motin buffer = slot->curcmd->data->data; 340831f5dcfSAlexander Motin buffer += slot->offset; 341831f5dcfSAlexander Motin /* Transfer one block at a time. */ 342831f5dcfSAlexander Motin left = min(512, slot->curcmd->data->len - slot->offset); 343831f5dcfSAlexander Motin slot->offset += left; 344831f5dcfSAlexander Motin 345831f5dcfSAlexander Motin /* If we are too fast, broken controllers return zeroes. */ 346d6b3aaf8SOleksandr Tymoshenko if (slot->quirks & SDHCI_QUIRK_BROKEN_TIMINGS) 347831f5dcfSAlexander Motin DELAY(10); 348831f5dcfSAlexander Motin /* Handle unalligned and alligned buffer cases. */ 349831f5dcfSAlexander Motin if ((intptr_t)buffer & 3) { 350831f5dcfSAlexander Motin while (left > 3) { 351831f5dcfSAlexander Motin data = RD4(slot, SDHCI_BUFFER); 352831f5dcfSAlexander Motin buffer[0] = data; 353831f5dcfSAlexander Motin buffer[1] = (data >> 8); 354831f5dcfSAlexander Motin buffer[2] = (data >> 16); 355831f5dcfSAlexander Motin buffer[3] = (data >> 24); 356831f5dcfSAlexander Motin buffer += 4; 357831f5dcfSAlexander Motin left -= 4; 358831f5dcfSAlexander Motin } 359831f5dcfSAlexander Motin } else { 360d6b3aaf8SOleksandr Tymoshenko RD_MULTI_4(slot, SDHCI_BUFFER, 361831f5dcfSAlexander Motin (uint32_t *)buffer, left >> 2); 362831f5dcfSAlexander Motin left &= 3; 363831f5dcfSAlexander Motin } 364831f5dcfSAlexander Motin /* Handle uneven size case. */ 365831f5dcfSAlexander Motin if (left > 0) { 366831f5dcfSAlexander Motin data = RD4(slot, SDHCI_BUFFER); 367831f5dcfSAlexander Motin while (left > 0) { 368831f5dcfSAlexander Motin *(buffer++) = data; 369831f5dcfSAlexander Motin data >>= 8; 370831f5dcfSAlexander Motin left--; 371831f5dcfSAlexander Motin } 372831f5dcfSAlexander Motin } 373831f5dcfSAlexander Motin } 374831f5dcfSAlexander Motin 375831f5dcfSAlexander Motin static void 376831f5dcfSAlexander Motin sdhci_write_block_pio(struct sdhci_slot *slot) 377831f5dcfSAlexander Motin { 378831f5dcfSAlexander Motin uint32_t data = 0; 379831f5dcfSAlexander Motin char *buffer; 380831f5dcfSAlexander Motin size_t left; 381831f5dcfSAlexander Motin 382831f5dcfSAlexander Motin buffer = slot->curcmd->data->data; 383831f5dcfSAlexander Motin buffer += slot->offset; 384831f5dcfSAlexander Motin /* Transfer one block at a time. */ 385831f5dcfSAlexander Motin left = min(512, slot->curcmd->data->len - slot->offset); 386831f5dcfSAlexander Motin slot->offset += left; 387831f5dcfSAlexander Motin 388831f5dcfSAlexander Motin /* Handle unalligned and alligned buffer cases. */ 389831f5dcfSAlexander Motin if ((intptr_t)buffer & 3) { 390831f5dcfSAlexander Motin while (left > 3) { 391831f5dcfSAlexander Motin data = buffer[0] + 392831f5dcfSAlexander Motin (buffer[1] << 8) + 393831f5dcfSAlexander Motin (buffer[2] << 16) + 394831f5dcfSAlexander Motin (buffer[3] << 24); 395831f5dcfSAlexander Motin left -= 4; 396831f5dcfSAlexander Motin buffer += 4; 397831f5dcfSAlexander Motin WR4(slot, SDHCI_BUFFER, data); 398831f5dcfSAlexander Motin } 399831f5dcfSAlexander Motin } else { 400d6b3aaf8SOleksandr Tymoshenko WR_MULTI_4(slot, SDHCI_BUFFER, 401831f5dcfSAlexander Motin (uint32_t *)buffer, left >> 2); 402831f5dcfSAlexander Motin left &= 3; 403831f5dcfSAlexander Motin } 404831f5dcfSAlexander Motin /* Handle uneven size case. */ 405831f5dcfSAlexander Motin if (left > 0) { 406831f5dcfSAlexander Motin while (left > 0) { 407831f5dcfSAlexander Motin data <<= 8; 408831f5dcfSAlexander Motin data += *(buffer++); 409831f5dcfSAlexander Motin left--; 410831f5dcfSAlexander Motin } 411831f5dcfSAlexander Motin WR4(slot, SDHCI_BUFFER, data); 412831f5dcfSAlexander Motin } 413831f5dcfSAlexander Motin } 414831f5dcfSAlexander Motin 415831f5dcfSAlexander Motin static void 416831f5dcfSAlexander Motin sdhci_transfer_pio(struct sdhci_slot *slot) 417831f5dcfSAlexander Motin { 418831f5dcfSAlexander Motin 419831f5dcfSAlexander Motin /* Read as many blocks as possible. */ 420831f5dcfSAlexander Motin if (slot->curcmd->data->flags & MMC_DATA_READ) { 421831f5dcfSAlexander Motin while (RD4(slot, SDHCI_PRESENT_STATE) & 422831f5dcfSAlexander Motin SDHCI_DATA_AVAILABLE) { 423831f5dcfSAlexander Motin sdhci_read_block_pio(slot); 424831f5dcfSAlexander Motin if (slot->offset >= slot->curcmd->data->len) 425831f5dcfSAlexander Motin break; 426831f5dcfSAlexander Motin } 427831f5dcfSAlexander Motin } else { 428831f5dcfSAlexander Motin while (RD4(slot, SDHCI_PRESENT_STATE) & 429831f5dcfSAlexander Motin SDHCI_SPACE_AVAILABLE) { 430831f5dcfSAlexander Motin sdhci_write_block_pio(slot); 431831f5dcfSAlexander Motin if (slot->offset >= slot->curcmd->data->len) 432831f5dcfSAlexander Motin break; 433831f5dcfSAlexander Motin } 434831f5dcfSAlexander Motin } 435831f5dcfSAlexander Motin } 436831f5dcfSAlexander Motin 437831f5dcfSAlexander Motin static void 438831f5dcfSAlexander Motin sdhci_card_delay(void *arg) 439831f5dcfSAlexander Motin { 440831f5dcfSAlexander Motin struct sdhci_slot *slot = arg; 441831f5dcfSAlexander Motin 442831f5dcfSAlexander Motin taskqueue_enqueue(taskqueue_swi_giant, &slot->card_task); 443831f5dcfSAlexander Motin } 444831f5dcfSAlexander Motin 445831f5dcfSAlexander Motin static void 446831f5dcfSAlexander Motin sdhci_card_task(void *arg, int pending) 447831f5dcfSAlexander Motin { 448831f5dcfSAlexander Motin struct sdhci_slot *slot = arg; 449831f5dcfSAlexander Motin 450831f5dcfSAlexander Motin SDHCI_LOCK(slot); 451831f5dcfSAlexander Motin if (RD4(slot, SDHCI_PRESENT_STATE) & SDHCI_CARD_PRESENT) { 452831f5dcfSAlexander Motin if (slot->dev == NULL) { 453831f5dcfSAlexander Motin /* If card is present - attach mmc bus. */ 454d6b3aaf8SOleksandr Tymoshenko slot->dev = device_add_child(slot->bus, "mmc", -1); 455831f5dcfSAlexander Motin device_set_ivars(slot->dev, slot); 456831f5dcfSAlexander Motin SDHCI_UNLOCK(slot); 457831f5dcfSAlexander Motin device_probe_and_attach(slot->dev); 458831f5dcfSAlexander Motin } else 459831f5dcfSAlexander Motin SDHCI_UNLOCK(slot); 460831f5dcfSAlexander Motin } else { 461831f5dcfSAlexander Motin if (slot->dev != NULL) { 462831f5dcfSAlexander Motin /* If no card present - detach mmc bus. */ 463831f5dcfSAlexander Motin device_t d = slot->dev; 464831f5dcfSAlexander Motin slot->dev = NULL; 465831f5dcfSAlexander Motin SDHCI_UNLOCK(slot); 466d6b3aaf8SOleksandr Tymoshenko device_delete_child(slot->bus, d); 467831f5dcfSAlexander Motin } else 468831f5dcfSAlexander Motin SDHCI_UNLOCK(slot); 469831f5dcfSAlexander Motin } 470831f5dcfSAlexander Motin } 471831f5dcfSAlexander Motin 472d6b3aaf8SOleksandr Tymoshenko int 473d6b3aaf8SOleksandr Tymoshenko sdhci_init_slot(device_t dev, struct sdhci_slot *slot, int num) 474831f5dcfSAlexander Motin { 475831f5dcfSAlexander Motin uint32_t caps; 476d6b3aaf8SOleksandr Tymoshenko int err; 477831f5dcfSAlexander Motin 478831f5dcfSAlexander Motin SDHCI_LOCK_INIT(slot); 479d6b3aaf8SOleksandr Tymoshenko slot->num = num; 480d6b3aaf8SOleksandr Tymoshenko slot->bus = dev; 481d6b3aaf8SOleksandr Tymoshenko 482831f5dcfSAlexander Motin /* Allocate DMA tag. */ 483831f5dcfSAlexander Motin err = bus_dma_tag_create(bus_get_dma_tag(dev), 484831f5dcfSAlexander Motin DMA_BLOCK_SIZE, 0, BUS_SPACE_MAXADDR_32BIT, 485831f5dcfSAlexander Motin BUS_SPACE_MAXADDR, NULL, NULL, 486831f5dcfSAlexander Motin DMA_BLOCK_SIZE, 1, DMA_BLOCK_SIZE, 487831f5dcfSAlexander Motin BUS_DMA_ALLOCNOW, NULL, NULL, 488831f5dcfSAlexander Motin &slot->dmatag); 489831f5dcfSAlexander Motin if (err != 0) { 490831f5dcfSAlexander Motin device_printf(dev, "Can't create DMA tag\n"); 491831f5dcfSAlexander Motin SDHCI_LOCK_DESTROY(slot); 492d6b3aaf8SOleksandr Tymoshenko return (err); 493831f5dcfSAlexander Motin } 494831f5dcfSAlexander Motin /* Allocate DMA memory. */ 495831f5dcfSAlexander Motin err = bus_dmamem_alloc(slot->dmatag, (void **)&slot->dmamem, 496831f5dcfSAlexander Motin BUS_DMA_NOWAIT, &slot->dmamap); 497831f5dcfSAlexander Motin if (err != 0) { 498831f5dcfSAlexander Motin device_printf(dev, "Can't alloc DMA memory\n"); 499831f5dcfSAlexander Motin SDHCI_LOCK_DESTROY(slot); 500d6b3aaf8SOleksandr Tymoshenko return (err); 501831f5dcfSAlexander Motin } 502831f5dcfSAlexander Motin /* Map the memory. */ 503831f5dcfSAlexander Motin err = bus_dmamap_load(slot->dmatag, slot->dmamap, 504831f5dcfSAlexander Motin (void *)slot->dmamem, DMA_BLOCK_SIZE, 505831f5dcfSAlexander Motin sdhci_getaddr, &slot->paddr, 0); 506831f5dcfSAlexander Motin if (err != 0 || slot->paddr == 0) { 507831f5dcfSAlexander Motin device_printf(dev, "Can't load DMA memory\n"); 508831f5dcfSAlexander Motin SDHCI_LOCK_DESTROY(slot); 509d6b3aaf8SOleksandr Tymoshenko if(err) 510d6b3aaf8SOleksandr Tymoshenko return (err); 511d6b3aaf8SOleksandr Tymoshenko else 512d6b3aaf8SOleksandr Tymoshenko return (EFAULT); 513831f5dcfSAlexander Motin } 514d6b3aaf8SOleksandr Tymoshenko 515831f5dcfSAlexander Motin /* Initialize slot. */ 516831f5dcfSAlexander Motin sdhci_init(slot); 517d6b3aaf8SOleksandr Tymoshenko slot->version = (RD2(slot, SDHCI_HOST_VERSION) 518d6b3aaf8SOleksandr Tymoshenko >> SDHCI_SPEC_VER_SHIFT) & SDHCI_SPEC_VER_MASK; 5198f3b7d56SOleksandr Tymoshenko if (slot->quirks & SDHCI_QUIRK_MISSING_CAPS) 5208f3b7d56SOleksandr Tymoshenko caps = slot->caps; 5218f3b7d56SOleksandr Tymoshenko else 522831f5dcfSAlexander Motin caps = RD4(slot, SDHCI_CAPABILITIES); 523831f5dcfSAlexander Motin /* Calculate base clock frequency. */ 52433aad34dSOleksandr Tymoshenko if (slot->version >= SDHCI_SPEC_300) 52533aad34dSOleksandr Tymoshenko slot->max_clk = (caps & SDHCI_CLOCK_V3_BASE_MASK) 52633aad34dSOleksandr Tymoshenko >> SDHCI_CLOCK_BASE_SHIFT; 52733aad34dSOleksandr Tymoshenko else 52833aad34dSOleksandr Tymoshenko slot->max_clk = (caps & SDHCI_CLOCK_BASE_MASK) 52933aad34dSOleksandr Tymoshenko >> SDHCI_CLOCK_BASE_SHIFT; 530831f5dcfSAlexander Motin if (slot->max_clk == 0) { 53133aad34dSOleksandr Tymoshenko slot->max_clk = SDHCI_DEFAULT_MAX_FREQ; 532831f5dcfSAlexander Motin device_printf(dev, "Hardware doesn't specify base clock " 53333aad34dSOleksandr Tymoshenko "frequency, using %dMHz as default.\n", SDHCI_DEFAULT_MAX_FREQ); 534831f5dcfSAlexander Motin } 535831f5dcfSAlexander Motin slot->max_clk *= 1000000; 536831f5dcfSAlexander Motin /* Calculate timeout clock frequency. */ 5378f3b7d56SOleksandr Tymoshenko if (slot->quirks & SDHCI_QUIRK_DATA_TIMEOUT_USES_SDCLK) { 5388f3b7d56SOleksandr Tymoshenko slot->timeout_clk = slot->max_clk / 1000; 5398f3b7d56SOleksandr Tymoshenko } else { 540831f5dcfSAlexander Motin slot->timeout_clk = 541831f5dcfSAlexander Motin (caps & SDHCI_TIMEOUT_CLK_MASK) >> SDHCI_TIMEOUT_CLK_SHIFT; 5428f3b7d56SOleksandr Tymoshenko if (caps & SDHCI_TIMEOUT_CLK_UNIT) 5438f3b7d56SOleksandr Tymoshenko slot->timeout_clk *= 1000; 5448f3b7d56SOleksandr Tymoshenko } 5458f3b7d56SOleksandr Tymoshenko 546831f5dcfSAlexander Motin if (slot->timeout_clk == 0) { 547831f5dcfSAlexander Motin device_printf(dev, "Hardware doesn't specify timeout clock " 548831f5dcfSAlexander Motin "frequency.\n"); 549831f5dcfSAlexander Motin } 550831f5dcfSAlexander Motin 55157677a3aSOleksandr Tymoshenko slot->host.f_min = SDHCI_MIN_FREQ(slot->bus, slot); 552831f5dcfSAlexander Motin slot->host.f_max = slot->max_clk; 553831f5dcfSAlexander Motin slot->host.host_ocr = 0; 554831f5dcfSAlexander Motin if (caps & SDHCI_CAN_VDD_330) 555831f5dcfSAlexander Motin slot->host.host_ocr |= MMC_OCR_320_330 | MMC_OCR_330_340; 556831f5dcfSAlexander Motin if (caps & SDHCI_CAN_VDD_300) 557831f5dcfSAlexander Motin slot->host.host_ocr |= MMC_OCR_290_300 | MMC_OCR_300_310; 558831f5dcfSAlexander Motin if (caps & SDHCI_CAN_VDD_180) 559831f5dcfSAlexander Motin slot->host.host_ocr |= MMC_OCR_LOW_VOLTAGE; 560831f5dcfSAlexander Motin if (slot->host.host_ocr == 0) { 561831f5dcfSAlexander Motin device_printf(dev, "Hardware doesn't report any " 562831f5dcfSAlexander Motin "support voltages.\n"); 563831f5dcfSAlexander Motin } 564831f5dcfSAlexander Motin slot->host.caps = MMC_CAP_4_BIT_DATA; 565831f5dcfSAlexander Motin if (caps & SDHCI_CAN_DO_HISPD) 566831f5dcfSAlexander Motin slot->host.caps |= MMC_CAP_HSPEED; 567831f5dcfSAlexander Motin /* Decide if we have usable DMA. */ 568831f5dcfSAlexander Motin if (caps & SDHCI_CAN_DO_DMA) 569831f5dcfSAlexander Motin slot->opt |= SDHCI_HAVE_DMA; 570d6b3aaf8SOleksandr Tymoshenko 571d6b3aaf8SOleksandr Tymoshenko if (slot->quirks & SDHCI_QUIRK_BROKEN_DMA) 572831f5dcfSAlexander Motin slot->opt &= ~SDHCI_HAVE_DMA; 573d6b3aaf8SOleksandr Tymoshenko if (slot->quirks & SDHCI_QUIRK_FORCE_DMA) 574831f5dcfSAlexander Motin slot->opt |= SDHCI_HAVE_DMA; 575831f5dcfSAlexander Motin 5765b69a497SAlexander Motin if (bootverbose || sdhci_debug) { 577831f5dcfSAlexander Motin slot_printf(slot, "%uMHz%s 4bits%s%s%s %s\n", 578831f5dcfSAlexander Motin slot->max_clk / 1000000, 579831f5dcfSAlexander Motin (caps & SDHCI_CAN_DO_HISPD) ? " HS" : "", 580831f5dcfSAlexander Motin (caps & SDHCI_CAN_VDD_330) ? " 3.3V" : "", 581831f5dcfSAlexander Motin (caps & SDHCI_CAN_VDD_300) ? " 3.0V" : "", 582831f5dcfSAlexander Motin (caps & SDHCI_CAN_VDD_180) ? " 1.8V" : "", 583831f5dcfSAlexander Motin (slot->opt & SDHCI_HAVE_DMA) ? "DMA" : "PIO"); 584831f5dcfSAlexander Motin sdhci_dumpregs(slot); 585831f5dcfSAlexander Motin } 586831f5dcfSAlexander Motin 587831f5dcfSAlexander Motin TASK_INIT(&slot->card_task, 0, sdhci_card_task, slot); 588831f5dcfSAlexander Motin callout_init(&slot->card_callout, 1); 589831f5dcfSAlexander Motin return (0); 590831f5dcfSAlexander Motin } 591831f5dcfSAlexander Motin 592d6b3aaf8SOleksandr Tymoshenko void 593d6b3aaf8SOleksandr Tymoshenko sdhci_start_slot(struct sdhci_slot *slot) 594831f5dcfSAlexander Motin { 595d6b3aaf8SOleksandr Tymoshenko sdhci_card_task(slot, 0); 596d6b3aaf8SOleksandr Tymoshenko } 597831f5dcfSAlexander Motin 598d6b3aaf8SOleksandr Tymoshenko int 599d6b3aaf8SOleksandr Tymoshenko sdhci_cleanup_slot(struct sdhci_slot *slot) 600d6b3aaf8SOleksandr Tymoshenko { 601831f5dcfSAlexander Motin device_t d; 602831f5dcfSAlexander Motin 603831f5dcfSAlexander Motin callout_drain(&slot->card_callout); 604831f5dcfSAlexander Motin taskqueue_drain(taskqueue_swi_giant, &slot->card_task); 605831f5dcfSAlexander Motin 606831f5dcfSAlexander Motin SDHCI_LOCK(slot); 607831f5dcfSAlexander Motin d = slot->dev; 608831f5dcfSAlexander Motin slot->dev = NULL; 609831f5dcfSAlexander Motin SDHCI_UNLOCK(slot); 610831f5dcfSAlexander Motin if (d != NULL) 611d6b3aaf8SOleksandr Tymoshenko device_delete_child(slot->bus, d); 612831f5dcfSAlexander Motin 613831f5dcfSAlexander Motin SDHCI_LOCK(slot); 614831f5dcfSAlexander Motin sdhci_reset(slot, SDHCI_RESET_ALL); 615831f5dcfSAlexander Motin SDHCI_UNLOCK(slot); 616831f5dcfSAlexander Motin bus_dmamap_unload(slot->dmatag, slot->dmamap); 617831f5dcfSAlexander Motin bus_dmamem_free(slot->dmatag, slot->dmamem, slot->dmamap); 618831f5dcfSAlexander Motin bus_dma_tag_destroy(slot->dmatag); 619d6b3aaf8SOleksandr Tymoshenko 620831f5dcfSAlexander Motin SDHCI_LOCK_DESTROY(slot); 621d6b3aaf8SOleksandr Tymoshenko 622831f5dcfSAlexander Motin return (0); 623831f5dcfSAlexander Motin } 624831f5dcfSAlexander Motin 625d6b3aaf8SOleksandr Tymoshenko int 626d6b3aaf8SOleksandr Tymoshenko sdhci_generic_suspend(struct sdhci_slot *slot) 62792bf0e27SAlexander Motin { 628d6b3aaf8SOleksandr Tymoshenko sdhci_reset(slot, SDHCI_RESET_ALL); 62992bf0e27SAlexander Motin 63092bf0e27SAlexander Motin return (0); 63192bf0e27SAlexander Motin } 63292bf0e27SAlexander Motin 633d6b3aaf8SOleksandr Tymoshenko int 634d6b3aaf8SOleksandr Tymoshenko sdhci_generic_resume(struct sdhci_slot *slot) 63592bf0e27SAlexander Motin { 636d6b3aaf8SOleksandr Tymoshenko sdhci_init(slot); 63792bf0e27SAlexander Motin 638d6b3aaf8SOleksandr Tymoshenko return (0); 63992bf0e27SAlexander Motin } 64092bf0e27SAlexander Motin 64157677a3aSOleksandr Tymoshenko uint32_t 64257677a3aSOleksandr Tymoshenko sdhci_generic_min_freq(device_t brdev, struct sdhci_slot *slot) 64357677a3aSOleksandr Tymoshenko { 64457677a3aSOleksandr Tymoshenko if (slot->version >= SDHCI_SPEC_300) 64557677a3aSOleksandr Tymoshenko return (slot->max_clk / SDHCI_300_MAX_DIVIDER); 64657677a3aSOleksandr Tymoshenko else 64757677a3aSOleksandr Tymoshenko return (slot->max_clk / SDHCI_200_MAX_DIVIDER); 64857677a3aSOleksandr Tymoshenko } 64957677a3aSOleksandr Tymoshenko 650d6b3aaf8SOleksandr Tymoshenko int 651d6b3aaf8SOleksandr Tymoshenko sdhci_generic_update_ios(device_t brdev, device_t reqdev) 652831f5dcfSAlexander Motin { 653831f5dcfSAlexander Motin struct sdhci_slot *slot = device_get_ivars(reqdev); 654831f5dcfSAlexander Motin struct mmc_ios *ios = &slot->host.ios; 655831f5dcfSAlexander Motin 656831f5dcfSAlexander Motin SDHCI_LOCK(slot); 657831f5dcfSAlexander Motin /* Do full reset on bus power down to clear from any state. */ 658831f5dcfSAlexander Motin if (ios->power_mode == power_off) { 659831f5dcfSAlexander Motin WR4(slot, SDHCI_SIGNAL_ENABLE, 0); 660831f5dcfSAlexander Motin sdhci_init(slot); 661831f5dcfSAlexander Motin } 662831f5dcfSAlexander Motin /* Configure the bus. */ 663831f5dcfSAlexander Motin sdhci_set_clock(slot, ios->clock); 664831f5dcfSAlexander Motin sdhci_set_power(slot, (ios->power_mode == power_off)?0:ios->vdd); 665831f5dcfSAlexander Motin if (ios->bus_width == bus_width_4) 666831f5dcfSAlexander Motin slot->hostctrl |= SDHCI_CTRL_4BITBUS; 667831f5dcfSAlexander Motin else 668831f5dcfSAlexander Motin slot->hostctrl &= ~SDHCI_CTRL_4BITBUS; 669831f5dcfSAlexander Motin if (ios->timing == bus_timing_hs) 670831f5dcfSAlexander Motin slot->hostctrl |= SDHCI_CTRL_HISPD; 671831f5dcfSAlexander Motin else 672831f5dcfSAlexander Motin slot->hostctrl &= ~SDHCI_CTRL_HISPD; 673831f5dcfSAlexander Motin WR1(slot, SDHCI_HOST_CONTROL, slot->hostctrl); 674831f5dcfSAlexander Motin /* Some controllers like reset after bus changes. */ 675d6b3aaf8SOleksandr Tymoshenko if(slot->quirks & SDHCI_QUIRK_RESET_ON_IOS) 676831f5dcfSAlexander Motin sdhci_reset(slot, SDHCI_RESET_CMD | SDHCI_RESET_DATA); 677831f5dcfSAlexander Motin 678831f5dcfSAlexander Motin SDHCI_UNLOCK(slot); 679831f5dcfSAlexander Motin return (0); 680831f5dcfSAlexander Motin } 681831f5dcfSAlexander Motin 682831f5dcfSAlexander Motin static void 683831f5dcfSAlexander Motin sdhci_set_transfer_mode(struct sdhci_slot *slot, 684831f5dcfSAlexander Motin struct mmc_data *data) 685831f5dcfSAlexander Motin { 686831f5dcfSAlexander Motin uint16_t mode; 687831f5dcfSAlexander Motin 688831f5dcfSAlexander Motin if (data == NULL) 689831f5dcfSAlexander Motin return; 690831f5dcfSAlexander Motin 691831f5dcfSAlexander Motin mode = SDHCI_TRNS_BLK_CNT_EN; 692831f5dcfSAlexander Motin if (data->len > 512) 693831f5dcfSAlexander Motin mode |= SDHCI_TRNS_MULTI; 694831f5dcfSAlexander Motin if (data->flags & MMC_DATA_READ) 695831f5dcfSAlexander Motin mode |= SDHCI_TRNS_READ; 696831f5dcfSAlexander Motin if (slot->req->stop) 697831f5dcfSAlexander Motin mode |= SDHCI_TRNS_ACMD12; 698831f5dcfSAlexander Motin if (slot->flags & SDHCI_USE_DMA) 699831f5dcfSAlexander Motin mode |= SDHCI_TRNS_DMA; 700831f5dcfSAlexander Motin 701831f5dcfSAlexander Motin WR2(slot, SDHCI_TRANSFER_MODE, mode); 702831f5dcfSAlexander Motin } 703831f5dcfSAlexander Motin 704831f5dcfSAlexander Motin static void 705831f5dcfSAlexander Motin sdhci_start_command(struct sdhci_slot *slot, struct mmc_command *cmd) 706831f5dcfSAlexander Motin { 707831f5dcfSAlexander Motin struct mmc_request *req = slot->req; 708831f5dcfSAlexander Motin int flags, timeout; 709831f5dcfSAlexander Motin uint32_t mask, state; 710831f5dcfSAlexander Motin 711831f5dcfSAlexander Motin slot->curcmd = cmd; 712831f5dcfSAlexander Motin slot->cmd_done = 0; 713831f5dcfSAlexander Motin 714831f5dcfSAlexander Motin cmd->error = MMC_ERR_NONE; 715831f5dcfSAlexander Motin 716831f5dcfSAlexander Motin /* This flags combination is not supported by controller. */ 717831f5dcfSAlexander Motin if ((cmd->flags & MMC_RSP_136) && (cmd->flags & MMC_RSP_BUSY)) { 718831f5dcfSAlexander Motin slot_printf(slot, "Unsupported response type!\n"); 719831f5dcfSAlexander Motin cmd->error = MMC_ERR_FAILED; 720831f5dcfSAlexander Motin slot->req = NULL; 721831f5dcfSAlexander Motin slot->curcmd = NULL; 722831f5dcfSAlexander Motin req->done(req); 723831f5dcfSAlexander Motin return; 724831f5dcfSAlexander Motin } 725831f5dcfSAlexander Motin 726831f5dcfSAlexander Motin /* Read controller present state. */ 727831f5dcfSAlexander Motin state = RD4(slot, SDHCI_PRESENT_STATE); 728d8208d9eSAlexander Motin /* Do not issue command if there is no card, clock or power. 729d8208d9eSAlexander Motin * Controller will not detect timeout without clock active. */ 730d8208d9eSAlexander Motin if ((state & SDHCI_CARD_PRESENT) == 0 || 731d8208d9eSAlexander Motin slot->power == 0 || 732d8208d9eSAlexander Motin slot->clock == 0) { 733831f5dcfSAlexander Motin cmd->error = MMC_ERR_FAILED; 734831f5dcfSAlexander Motin slot->req = NULL; 735831f5dcfSAlexander Motin slot->curcmd = NULL; 736831f5dcfSAlexander Motin req->done(req); 737831f5dcfSAlexander Motin return; 738831f5dcfSAlexander Motin } 739831f5dcfSAlexander Motin /* Always wait for free CMD bus. */ 740831f5dcfSAlexander Motin mask = SDHCI_CMD_INHIBIT; 741831f5dcfSAlexander Motin /* Wait for free DAT if we have data or busy signal. */ 742831f5dcfSAlexander Motin if (cmd->data || (cmd->flags & MMC_RSP_BUSY)) 743831f5dcfSAlexander Motin mask |= SDHCI_DAT_INHIBIT; 744831f5dcfSAlexander Motin /* We shouldn't wait for DAT for stop commands. */ 745831f5dcfSAlexander Motin if (cmd == slot->req->stop) 746831f5dcfSAlexander Motin mask &= ~SDHCI_DAT_INHIBIT; 747831f5dcfSAlexander Motin /* Wait for bus no more then 10 ms. */ 748831f5dcfSAlexander Motin timeout = 10; 749831f5dcfSAlexander Motin while (state & mask) { 750831f5dcfSAlexander Motin if (timeout == 0) { 751831f5dcfSAlexander Motin slot_printf(slot, "Controller never released " 752831f5dcfSAlexander Motin "inhibit bit(s).\n"); 753831f5dcfSAlexander Motin sdhci_dumpregs(slot); 754831f5dcfSAlexander Motin cmd->error = MMC_ERR_FAILED; 755831f5dcfSAlexander Motin slot->req = NULL; 756831f5dcfSAlexander Motin slot->curcmd = NULL; 757831f5dcfSAlexander Motin req->done(req); 758831f5dcfSAlexander Motin return; 759831f5dcfSAlexander Motin } 760831f5dcfSAlexander Motin timeout--; 761831f5dcfSAlexander Motin DELAY(1000); 762831f5dcfSAlexander Motin state = RD4(slot, SDHCI_PRESENT_STATE); 763831f5dcfSAlexander Motin } 764831f5dcfSAlexander Motin 765831f5dcfSAlexander Motin /* Prepare command flags. */ 766831f5dcfSAlexander Motin if (!(cmd->flags & MMC_RSP_PRESENT)) 767831f5dcfSAlexander Motin flags = SDHCI_CMD_RESP_NONE; 768831f5dcfSAlexander Motin else if (cmd->flags & MMC_RSP_136) 769831f5dcfSAlexander Motin flags = SDHCI_CMD_RESP_LONG; 770831f5dcfSAlexander Motin else if (cmd->flags & MMC_RSP_BUSY) 771831f5dcfSAlexander Motin flags = SDHCI_CMD_RESP_SHORT_BUSY; 772831f5dcfSAlexander Motin else 773831f5dcfSAlexander Motin flags = SDHCI_CMD_RESP_SHORT; 774831f5dcfSAlexander Motin if (cmd->flags & MMC_RSP_CRC) 775831f5dcfSAlexander Motin flags |= SDHCI_CMD_CRC; 776831f5dcfSAlexander Motin if (cmd->flags & MMC_RSP_OPCODE) 777831f5dcfSAlexander Motin flags |= SDHCI_CMD_INDEX; 778831f5dcfSAlexander Motin if (cmd->data) 779831f5dcfSAlexander Motin flags |= SDHCI_CMD_DATA; 780831f5dcfSAlexander Motin if (cmd->opcode == MMC_STOP_TRANSMISSION) 781831f5dcfSAlexander Motin flags |= SDHCI_CMD_TYPE_ABORT; 782831f5dcfSAlexander Motin /* Prepare data. */ 783831f5dcfSAlexander Motin sdhci_start_data(slot, cmd->data); 784831f5dcfSAlexander Motin /* 785831f5dcfSAlexander Motin * Interrupt aggregation: To reduce total number of interrupts 786831f5dcfSAlexander Motin * group response interrupt with data interrupt when possible. 787831f5dcfSAlexander Motin * If there going to be data interrupt, mask response one. 788831f5dcfSAlexander Motin */ 789831f5dcfSAlexander Motin if (slot->data_done == 0) { 790831f5dcfSAlexander Motin WR4(slot, SDHCI_SIGNAL_ENABLE, 791831f5dcfSAlexander Motin slot->intmask &= ~SDHCI_INT_RESPONSE); 792831f5dcfSAlexander Motin } 793831f5dcfSAlexander Motin /* Set command argument. */ 794831f5dcfSAlexander Motin WR4(slot, SDHCI_ARGUMENT, cmd->arg); 795831f5dcfSAlexander Motin /* Set data transfer mode. */ 796831f5dcfSAlexander Motin sdhci_set_transfer_mode(slot, cmd->data); 797831f5dcfSAlexander Motin /* Start command. */ 798d6b3aaf8SOleksandr Tymoshenko WR2(slot, SDHCI_COMMAND_FLAGS, (cmd->opcode << 8) | (flags & 0xff)); 799831f5dcfSAlexander Motin } 800831f5dcfSAlexander Motin 801831f5dcfSAlexander Motin static void 802831f5dcfSAlexander Motin sdhci_finish_command(struct sdhci_slot *slot) 803831f5dcfSAlexander Motin { 804831f5dcfSAlexander Motin int i; 805831f5dcfSAlexander Motin 806831f5dcfSAlexander Motin slot->cmd_done = 1; 807831f5dcfSAlexander Motin /* Interrupt aggregation: Restore command interrupt. 808831f5dcfSAlexander Motin * Main restore point for the case when command interrupt 809831f5dcfSAlexander Motin * happened first. */ 810831f5dcfSAlexander Motin WR4(slot, SDHCI_SIGNAL_ENABLE, slot->intmask |= SDHCI_INT_RESPONSE); 811831f5dcfSAlexander Motin /* In case of error - reset host and return. */ 812831f5dcfSAlexander Motin if (slot->curcmd->error) { 813831f5dcfSAlexander Motin sdhci_reset(slot, SDHCI_RESET_CMD); 814831f5dcfSAlexander Motin sdhci_reset(slot, SDHCI_RESET_DATA); 815831f5dcfSAlexander Motin sdhci_start(slot); 816831f5dcfSAlexander Motin return; 817831f5dcfSAlexander Motin } 818831f5dcfSAlexander Motin /* If command has response - fetch it. */ 819831f5dcfSAlexander Motin if (slot->curcmd->flags & MMC_RSP_PRESENT) { 820831f5dcfSAlexander Motin if (slot->curcmd->flags & MMC_RSP_136) { 821831f5dcfSAlexander Motin /* CRC is stripped so we need one byte shift. */ 822831f5dcfSAlexander Motin uint8_t extra = 0; 823831f5dcfSAlexander Motin for (i = 0; i < 4; i++) { 824831f5dcfSAlexander Motin uint32_t val = RD4(slot, SDHCI_RESPONSE + i * 4); 825831f5dcfSAlexander Motin slot->curcmd->resp[3 - i] = (val << 8) + extra; 826831f5dcfSAlexander Motin extra = val >> 24; 827831f5dcfSAlexander Motin } 828831f5dcfSAlexander Motin } else 829831f5dcfSAlexander Motin slot->curcmd->resp[0] = RD4(slot, SDHCI_RESPONSE); 830831f5dcfSAlexander Motin } 831831f5dcfSAlexander Motin /* If data ready - finish. */ 832831f5dcfSAlexander Motin if (slot->data_done) 833831f5dcfSAlexander Motin sdhci_start(slot); 834831f5dcfSAlexander Motin } 835831f5dcfSAlexander Motin 836831f5dcfSAlexander Motin static void 837831f5dcfSAlexander Motin sdhci_start_data(struct sdhci_slot *slot, struct mmc_data *data) 838831f5dcfSAlexander Motin { 839831f5dcfSAlexander Motin uint32_t target_timeout, current_timeout; 840831f5dcfSAlexander Motin uint8_t div; 841831f5dcfSAlexander Motin 842831f5dcfSAlexander Motin if (data == NULL && (slot->curcmd->flags & MMC_RSP_BUSY) == 0) { 843831f5dcfSAlexander Motin slot->data_done = 1; 844831f5dcfSAlexander Motin return; 845831f5dcfSAlexander Motin } 846831f5dcfSAlexander Motin 847831f5dcfSAlexander Motin slot->data_done = 0; 848831f5dcfSAlexander Motin 849831f5dcfSAlexander Motin /* Calculate and set data timeout.*/ 850831f5dcfSAlexander Motin /* XXX: We should have this from mmc layer, now assume 1 sec. */ 851831f5dcfSAlexander Motin target_timeout = 1000000; 852831f5dcfSAlexander Motin div = 0; 853831f5dcfSAlexander Motin current_timeout = (1 << 13) * 1000 / slot->timeout_clk; 854831f5dcfSAlexander Motin while (current_timeout < target_timeout) { 855831f5dcfSAlexander Motin div++; 856831f5dcfSAlexander Motin current_timeout <<= 1; 857831f5dcfSAlexander Motin if (div >= 0xF) 858831f5dcfSAlexander Motin break; 859831f5dcfSAlexander Motin } 860831f5dcfSAlexander Motin /* Compensate for an off-by-one error in the CaFe chip.*/ 861d6b3aaf8SOleksandr Tymoshenko if (slot->quirks & SDHCI_QUIRK_INCR_TIMEOUT_CONTROL) 862831f5dcfSAlexander Motin div++; 863831f5dcfSAlexander Motin if (div >= 0xF) { 864831f5dcfSAlexander Motin slot_printf(slot, "Timeout too large!\n"); 865831f5dcfSAlexander Motin div = 0xE; 866831f5dcfSAlexander Motin } 8678f3b7d56SOleksandr Tymoshenko if (slot->quirks & SDHCI_QUIRK_BROKEN_TIMEOUT_VAL) 8688f3b7d56SOleksandr Tymoshenko div = 0xE; 869831f5dcfSAlexander Motin WR1(slot, SDHCI_TIMEOUT_CONTROL, div); 870831f5dcfSAlexander Motin 871831f5dcfSAlexander Motin if (data == NULL) 872831f5dcfSAlexander Motin return; 873831f5dcfSAlexander Motin 874831f5dcfSAlexander Motin /* Use DMA if possible. */ 875831f5dcfSAlexander Motin if ((slot->opt & SDHCI_HAVE_DMA)) 876831f5dcfSAlexander Motin slot->flags |= SDHCI_USE_DMA; 877831f5dcfSAlexander Motin /* If data is small, broken DMA may return zeroes instead of data, */ 878d6b3aaf8SOleksandr Tymoshenko if ((slot->quirks & SDHCI_QUIRK_BROKEN_TIMINGS) && 879831f5dcfSAlexander Motin (data->len <= 512)) 880831f5dcfSAlexander Motin slot->flags &= ~SDHCI_USE_DMA; 881831f5dcfSAlexander Motin /* Some controllers require even block sizes. */ 882d6b3aaf8SOleksandr Tymoshenko if ((slot->quirks & SDHCI_QUIRK_32BIT_DMA_SIZE) && 883831f5dcfSAlexander Motin ((data->len) & 0x3)) 884831f5dcfSAlexander Motin slot->flags &= ~SDHCI_USE_DMA; 885831f5dcfSAlexander Motin /* Load DMA buffer. */ 886831f5dcfSAlexander Motin if (slot->flags & SDHCI_USE_DMA) { 887831f5dcfSAlexander Motin if (data->flags & MMC_DATA_READ) 888831f5dcfSAlexander Motin bus_dmamap_sync(slot->dmatag, slot->dmamap, BUS_DMASYNC_PREREAD); 889831f5dcfSAlexander Motin else { 890831f5dcfSAlexander Motin memcpy(slot->dmamem, data->data, 891831f5dcfSAlexander Motin (data->len < DMA_BLOCK_SIZE)?data->len:DMA_BLOCK_SIZE); 892831f5dcfSAlexander Motin bus_dmamap_sync(slot->dmatag, slot->dmamap, BUS_DMASYNC_PREWRITE); 893831f5dcfSAlexander Motin } 894831f5dcfSAlexander Motin WR4(slot, SDHCI_DMA_ADDRESS, slot->paddr); 895831f5dcfSAlexander Motin /* Interrupt aggregation: Mask border interrupt 896831f5dcfSAlexander Motin * for the last page and unmask else. */ 897831f5dcfSAlexander Motin if (data->len == DMA_BLOCK_SIZE) 898831f5dcfSAlexander Motin slot->intmask &= ~SDHCI_INT_DMA_END; 899831f5dcfSAlexander Motin else 900831f5dcfSAlexander Motin slot->intmask |= SDHCI_INT_DMA_END; 901831f5dcfSAlexander Motin WR4(slot, SDHCI_SIGNAL_ENABLE, slot->intmask); 902831f5dcfSAlexander Motin } 903831f5dcfSAlexander Motin /* Current data offset for both PIO and DMA. */ 904831f5dcfSAlexander Motin slot->offset = 0; 905831f5dcfSAlexander Motin /* Set block size and request IRQ on 4K border. */ 906831f5dcfSAlexander Motin WR2(slot, SDHCI_BLOCK_SIZE, 907831f5dcfSAlexander Motin SDHCI_MAKE_BLKSZ(DMA_BOUNDARY, (data->len < 512)?data->len:512)); 908831f5dcfSAlexander Motin /* Set block count. */ 909831f5dcfSAlexander Motin WR2(slot, SDHCI_BLOCK_COUNT, (data->len + 511) / 512); 910831f5dcfSAlexander Motin } 911831f5dcfSAlexander Motin 912831f5dcfSAlexander Motin static void 913831f5dcfSAlexander Motin sdhci_finish_data(struct sdhci_slot *slot) 914831f5dcfSAlexander Motin { 915831f5dcfSAlexander Motin struct mmc_data *data = slot->curcmd->data; 916831f5dcfSAlexander Motin 917831f5dcfSAlexander Motin slot->data_done = 1; 918831f5dcfSAlexander Motin /* Interrupt aggregation: Restore command interrupt. 919831f5dcfSAlexander Motin * Auxillary restore point for the case when data interrupt 920831f5dcfSAlexander Motin * happened first. */ 921831f5dcfSAlexander Motin if (!slot->cmd_done) { 922831f5dcfSAlexander Motin WR4(slot, SDHCI_SIGNAL_ENABLE, 923831f5dcfSAlexander Motin slot->intmask |= SDHCI_INT_RESPONSE); 924831f5dcfSAlexander Motin } 925831f5dcfSAlexander Motin /* Unload rest of data from DMA buffer. */ 926831f5dcfSAlexander Motin if (slot->flags & SDHCI_USE_DMA) { 927831f5dcfSAlexander Motin if (data->flags & MMC_DATA_READ) { 928831f5dcfSAlexander Motin size_t left = data->len - slot->offset; 929831f5dcfSAlexander Motin bus_dmamap_sync(slot->dmatag, slot->dmamap, BUS_DMASYNC_POSTREAD); 930831f5dcfSAlexander Motin memcpy((u_char*)data->data + slot->offset, slot->dmamem, 931831f5dcfSAlexander Motin (left < DMA_BLOCK_SIZE)?left:DMA_BLOCK_SIZE); 932831f5dcfSAlexander Motin } else 933831f5dcfSAlexander Motin bus_dmamap_sync(slot->dmatag, slot->dmamap, BUS_DMASYNC_POSTWRITE); 934831f5dcfSAlexander Motin } 935831f5dcfSAlexander Motin /* If there was error - reset the host. */ 936831f5dcfSAlexander Motin if (slot->curcmd->error) { 937831f5dcfSAlexander Motin sdhci_reset(slot, SDHCI_RESET_CMD); 938831f5dcfSAlexander Motin sdhci_reset(slot, SDHCI_RESET_DATA); 939831f5dcfSAlexander Motin sdhci_start(slot); 940831f5dcfSAlexander Motin return; 941831f5dcfSAlexander Motin } 942831f5dcfSAlexander Motin /* If we already have command response - finish. */ 943831f5dcfSAlexander Motin if (slot->cmd_done) 944831f5dcfSAlexander Motin sdhci_start(slot); 945831f5dcfSAlexander Motin } 946831f5dcfSAlexander Motin 947831f5dcfSAlexander Motin static void 948831f5dcfSAlexander Motin sdhci_start(struct sdhci_slot *slot) 949831f5dcfSAlexander Motin { 950831f5dcfSAlexander Motin struct mmc_request *req; 951831f5dcfSAlexander Motin 952831f5dcfSAlexander Motin req = slot->req; 953831f5dcfSAlexander Motin if (req == NULL) 954831f5dcfSAlexander Motin return; 955831f5dcfSAlexander Motin 956831f5dcfSAlexander Motin if (!(slot->flags & CMD_STARTED)) { 957831f5dcfSAlexander Motin slot->flags |= CMD_STARTED; 958831f5dcfSAlexander Motin sdhci_start_command(slot, req->cmd); 959831f5dcfSAlexander Motin return; 960831f5dcfSAlexander Motin } 961831f5dcfSAlexander Motin /* We don't need this until using Auto-CMD12 feature 962831f5dcfSAlexander Motin if (!(slot->flags & STOP_STARTED) && req->stop) { 963831f5dcfSAlexander Motin slot->flags |= STOP_STARTED; 964831f5dcfSAlexander Motin sdhci_start_command(slot, req->stop); 965831f5dcfSAlexander Motin return; 966831f5dcfSAlexander Motin } 967831f5dcfSAlexander Motin */ 9685b69a497SAlexander Motin if (sdhci_debug > 1) 9695b69a497SAlexander Motin slot_printf(slot, "result: %d\n", req->cmd->error); 9705b69a497SAlexander Motin if (!req->cmd->error && 971d6b3aaf8SOleksandr Tymoshenko (slot->quirks & SDHCI_QUIRK_RESET_AFTER_REQUEST)) { 972831f5dcfSAlexander Motin sdhci_reset(slot, SDHCI_RESET_CMD); 973831f5dcfSAlexander Motin sdhci_reset(slot, SDHCI_RESET_DATA); 974831f5dcfSAlexander Motin } 975831f5dcfSAlexander Motin 976831f5dcfSAlexander Motin /* We must be done -- bad idea to do this while locked? */ 977831f5dcfSAlexander Motin slot->req = NULL; 978831f5dcfSAlexander Motin slot->curcmd = NULL; 979831f5dcfSAlexander Motin req->done(req); 980831f5dcfSAlexander Motin } 981831f5dcfSAlexander Motin 982d6b3aaf8SOleksandr Tymoshenko int 983d6b3aaf8SOleksandr Tymoshenko sdhci_generic_request(device_t brdev, device_t reqdev, struct mmc_request *req) 984831f5dcfSAlexander Motin { 985831f5dcfSAlexander Motin struct sdhci_slot *slot = device_get_ivars(reqdev); 986831f5dcfSAlexander Motin 987831f5dcfSAlexander Motin SDHCI_LOCK(slot); 988831f5dcfSAlexander Motin if (slot->req != NULL) { 989831f5dcfSAlexander Motin SDHCI_UNLOCK(slot); 990831f5dcfSAlexander Motin return (EBUSY); 991831f5dcfSAlexander Motin } 9925b69a497SAlexander Motin if (sdhci_debug > 1) { 9935b69a497SAlexander Motin slot_printf(slot, "CMD%u arg %#x flags %#x dlen %u dflags %#x\n", 994831f5dcfSAlexander Motin req->cmd->opcode, req->cmd->arg, req->cmd->flags, 9955b69a497SAlexander Motin (req->cmd->data)?(u_int)req->cmd->data->len:0, 9965b69a497SAlexander Motin (req->cmd->data)?req->cmd->data->flags:0); 9975b69a497SAlexander Motin } 998831f5dcfSAlexander Motin slot->req = req; 999831f5dcfSAlexander Motin slot->flags = 0; 1000831f5dcfSAlexander Motin sdhci_start(slot); 1001831f5dcfSAlexander Motin SDHCI_UNLOCK(slot); 1002bea2dca2SAlexander Motin if (dumping) { 1003bea2dca2SAlexander Motin while (slot->req != NULL) { 1004d6b3aaf8SOleksandr Tymoshenko sdhci_generic_intr(slot); 1005bea2dca2SAlexander Motin DELAY(10); 1006bea2dca2SAlexander Motin } 1007bea2dca2SAlexander Motin } 1008831f5dcfSAlexander Motin return (0); 1009831f5dcfSAlexander Motin } 1010831f5dcfSAlexander Motin 1011d6b3aaf8SOleksandr Tymoshenko int 1012d6b3aaf8SOleksandr Tymoshenko sdhci_generic_get_ro(device_t brdev, device_t reqdev) 1013831f5dcfSAlexander Motin { 1014831f5dcfSAlexander Motin struct sdhci_slot *slot = device_get_ivars(reqdev); 1015831f5dcfSAlexander Motin uint32_t val; 1016831f5dcfSAlexander Motin 1017831f5dcfSAlexander Motin SDHCI_LOCK(slot); 1018831f5dcfSAlexander Motin val = RD4(slot, SDHCI_PRESENT_STATE); 1019831f5dcfSAlexander Motin SDHCI_UNLOCK(slot); 1020831f5dcfSAlexander Motin return (!(val & SDHCI_WRITE_PROTECT)); 1021831f5dcfSAlexander Motin } 1022831f5dcfSAlexander Motin 1023d6b3aaf8SOleksandr Tymoshenko int 1024d6b3aaf8SOleksandr Tymoshenko sdhci_generic_acquire_host(device_t brdev, device_t reqdev) 1025831f5dcfSAlexander Motin { 1026831f5dcfSAlexander Motin struct sdhci_slot *slot = device_get_ivars(reqdev); 1027831f5dcfSAlexander Motin int err = 0; 1028831f5dcfSAlexander Motin 1029831f5dcfSAlexander Motin SDHCI_LOCK(slot); 1030831f5dcfSAlexander Motin while (slot->bus_busy) 1031d493985aSAlexander Motin msleep(slot, &slot->mtx, 0, "sdhciah", 0); 1032831f5dcfSAlexander Motin slot->bus_busy++; 1033831f5dcfSAlexander Motin /* Activate led. */ 1034831f5dcfSAlexander Motin WR1(slot, SDHCI_HOST_CONTROL, slot->hostctrl |= SDHCI_CTRL_LED); 1035831f5dcfSAlexander Motin SDHCI_UNLOCK(slot); 1036831f5dcfSAlexander Motin return (err); 1037831f5dcfSAlexander Motin } 1038831f5dcfSAlexander Motin 1039d6b3aaf8SOleksandr Tymoshenko int 1040d6b3aaf8SOleksandr Tymoshenko sdhci_generic_release_host(device_t brdev, device_t reqdev) 1041831f5dcfSAlexander Motin { 1042831f5dcfSAlexander Motin struct sdhci_slot *slot = device_get_ivars(reqdev); 1043831f5dcfSAlexander Motin 1044831f5dcfSAlexander Motin SDHCI_LOCK(slot); 1045831f5dcfSAlexander Motin /* Deactivate led. */ 1046831f5dcfSAlexander Motin WR1(slot, SDHCI_HOST_CONTROL, slot->hostctrl &= ~SDHCI_CTRL_LED); 1047831f5dcfSAlexander Motin slot->bus_busy--; 1048831f5dcfSAlexander Motin SDHCI_UNLOCK(slot); 1049d493985aSAlexander Motin wakeup(slot); 1050831f5dcfSAlexander Motin return (0); 1051831f5dcfSAlexander Motin } 1052831f5dcfSAlexander Motin 1053831f5dcfSAlexander Motin static void 1054831f5dcfSAlexander Motin sdhci_cmd_irq(struct sdhci_slot *slot, uint32_t intmask) 1055831f5dcfSAlexander Motin { 1056831f5dcfSAlexander Motin 1057831f5dcfSAlexander Motin if (!slot->curcmd) { 1058831f5dcfSAlexander Motin slot_printf(slot, "Got command interrupt 0x%08x, but " 1059831f5dcfSAlexander Motin "there is no active command.\n", intmask); 1060831f5dcfSAlexander Motin sdhci_dumpregs(slot); 1061831f5dcfSAlexander Motin return; 1062831f5dcfSAlexander Motin } 1063831f5dcfSAlexander Motin if (intmask & SDHCI_INT_TIMEOUT) 1064831f5dcfSAlexander Motin slot->curcmd->error = MMC_ERR_TIMEOUT; 1065831f5dcfSAlexander Motin else if (intmask & SDHCI_INT_CRC) 1066831f5dcfSAlexander Motin slot->curcmd->error = MMC_ERR_BADCRC; 1067831f5dcfSAlexander Motin else if (intmask & (SDHCI_INT_END_BIT | SDHCI_INT_INDEX)) 1068831f5dcfSAlexander Motin slot->curcmd->error = MMC_ERR_FIFO; 1069831f5dcfSAlexander Motin 1070831f5dcfSAlexander Motin sdhci_finish_command(slot); 1071831f5dcfSAlexander Motin } 1072831f5dcfSAlexander Motin 1073831f5dcfSAlexander Motin static void 1074831f5dcfSAlexander Motin sdhci_data_irq(struct sdhci_slot *slot, uint32_t intmask) 1075831f5dcfSAlexander Motin { 1076831f5dcfSAlexander Motin 1077831f5dcfSAlexander Motin if (!slot->curcmd) { 1078831f5dcfSAlexander Motin slot_printf(slot, "Got data interrupt 0x%08x, but " 1079831f5dcfSAlexander Motin "there is no active command.\n", intmask); 1080831f5dcfSAlexander Motin sdhci_dumpregs(slot); 1081831f5dcfSAlexander Motin return; 1082831f5dcfSAlexander Motin } 1083831f5dcfSAlexander Motin if (slot->curcmd->data == NULL && 1084831f5dcfSAlexander Motin (slot->curcmd->flags & MMC_RSP_BUSY) == 0) { 1085831f5dcfSAlexander Motin slot_printf(slot, "Got data interrupt 0x%08x, but " 1086831f5dcfSAlexander Motin "there is no active data operation.\n", 1087831f5dcfSAlexander Motin intmask); 1088831f5dcfSAlexander Motin sdhci_dumpregs(slot); 1089831f5dcfSAlexander Motin return; 1090831f5dcfSAlexander Motin } 1091831f5dcfSAlexander Motin if (intmask & SDHCI_INT_DATA_TIMEOUT) 1092831f5dcfSAlexander Motin slot->curcmd->error = MMC_ERR_TIMEOUT; 1093*acbaa69fSOleksandr Tymoshenko else if (intmask & (SDHCI_INT_DATA_CRC | SDHCI_INT_DATA_END_BIT)) 1094831f5dcfSAlexander Motin slot->curcmd->error = MMC_ERR_BADCRC; 1095831f5dcfSAlexander Motin if (slot->curcmd->data == NULL && 1096831f5dcfSAlexander Motin (intmask & (SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL | 1097831f5dcfSAlexander Motin SDHCI_INT_DMA_END))) { 1098831f5dcfSAlexander Motin slot_printf(slot, "Got data interrupt 0x%08x, but " 1099831f5dcfSAlexander Motin "there is busy-only command.\n", intmask); 1100831f5dcfSAlexander Motin sdhci_dumpregs(slot); 1101831f5dcfSAlexander Motin slot->curcmd->error = MMC_ERR_INVALID; 1102831f5dcfSAlexander Motin } 1103831f5dcfSAlexander Motin if (slot->curcmd->error) { 1104831f5dcfSAlexander Motin /* No need to continue after any error. */ 1105831f5dcfSAlexander Motin sdhci_finish_data(slot); 1106831f5dcfSAlexander Motin return; 1107831f5dcfSAlexander Motin } 1108831f5dcfSAlexander Motin 1109831f5dcfSAlexander Motin /* Handle PIO interrupt. */ 1110831f5dcfSAlexander Motin if (intmask & (SDHCI_INT_DATA_AVAIL | SDHCI_INT_SPACE_AVAIL)) 1111831f5dcfSAlexander Motin sdhci_transfer_pio(slot); 1112831f5dcfSAlexander Motin /* Handle DMA border. */ 1113831f5dcfSAlexander Motin if (intmask & SDHCI_INT_DMA_END) { 1114831f5dcfSAlexander Motin struct mmc_data *data = slot->curcmd->data; 1115831f5dcfSAlexander Motin size_t left; 1116831f5dcfSAlexander Motin 1117831f5dcfSAlexander Motin /* Unload DMA buffer... */ 1118831f5dcfSAlexander Motin left = data->len - slot->offset; 1119831f5dcfSAlexander Motin if (data->flags & MMC_DATA_READ) { 1120831f5dcfSAlexander Motin bus_dmamap_sync(slot->dmatag, slot->dmamap, 1121831f5dcfSAlexander Motin BUS_DMASYNC_POSTREAD); 1122831f5dcfSAlexander Motin memcpy((u_char*)data->data + slot->offset, slot->dmamem, 1123831f5dcfSAlexander Motin (left < DMA_BLOCK_SIZE)?left:DMA_BLOCK_SIZE); 1124831f5dcfSAlexander Motin } else { 1125831f5dcfSAlexander Motin bus_dmamap_sync(slot->dmatag, slot->dmamap, 1126831f5dcfSAlexander Motin BUS_DMASYNC_POSTWRITE); 1127831f5dcfSAlexander Motin } 1128831f5dcfSAlexander Motin /* ... and reload it again. */ 1129831f5dcfSAlexander Motin slot->offset += DMA_BLOCK_SIZE; 1130831f5dcfSAlexander Motin left = data->len - slot->offset; 1131831f5dcfSAlexander Motin if (data->flags & MMC_DATA_READ) { 1132831f5dcfSAlexander Motin bus_dmamap_sync(slot->dmatag, slot->dmamap, 1133831f5dcfSAlexander Motin BUS_DMASYNC_PREREAD); 1134831f5dcfSAlexander Motin } else { 1135831f5dcfSAlexander Motin memcpy(slot->dmamem, (u_char*)data->data + slot->offset, 1136831f5dcfSAlexander Motin (left < DMA_BLOCK_SIZE)?left:DMA_BLOCK_SIZE); 1137831f5dcfSAlexander Motin bus_dmamap_sync(slot->dmatag, slot->dmamap, 1138831f5dcfSAlexander Motin BUS_DMASYNC_PREWRITE); 1139831f5dcfSAlexander Motin } 1140831f5dcfSAlexander Motin /* Interrupt aggregation: Mask border interrupt 1141831f5dcfSAlexander Motin * for the last page. */ 1142831f5dcfSAlexander Motin if (left == DMA_BLOCK_SIZE) { 1143831f5dcfSAlexander Motin slot->intmask &= ~SDHCI_INT_DMA_END; 1144831f5dcfSAlexander Motin WR4(slot, SDHCI_SIGNAL_ENABLE, slot->intmask); 1145831f5dcfSAlexander Motin } 1146831f5dcfSAlexander Motin /* Restart DMA. */ 1147831f5dcfSAlexander Motin WR4(slot, SDHCI_DMA_ADDRESS, slot->paddr); 1148831f5dcfSAlexander Motin } 1149831f5dcfSAlexander Motin /* We have got all data. */ 1150831f5dcfSAlexander Motin if (intmask & SDHCI_INT_DATA_END) 1151831f5dcfSAlexander Motin sdhci_finish_data(slot); 1152831f5dcfSAlexander Motin } 1153831f5dcfSAlexander Motin 1154831f5dcfSAlexander Motin static void 1155831f5dcfSAlexander Motin sdhci_acmd_irq(struct sdhci_slot *slot) 1156831f5dcfSAlexander Motin { 1157831f5dcfSAlexander Motin uint16_t err; 1158831f5dcfSAlexander Motin 1159831f5dcfSAlexander Motin err = RD4(slot, SDHCI_ACMD12_ERR); 1160831f5dcfSAlexander Motin if (!slot->curcmd) { 1161831f5dcfSAlexander Motin slot_printf(slot, "Got AutoCMD12 error 0x%04x, but " 1162831f5dcfSAlexander Motin "there is no active command.\n", err); 1163831f5dcfSAlexander Motin sdhci_dumpregs(slot); 1164831f5dcfSAlexander Motin return; 1165831f5dcfSAlexander Motin } 1166831f5dcfSAlexander Motin slot_printf(slot, "Got AutoCMD12 error 0x%04x\n", err); 1167831f5dcfSAlexander Motin sdhci_reset(slot, SDHCI_RESET_CMD); 1168831f5dcfSAlexander Motin } 1169831f5dcfSAlexander Motin 1170d6b3aaf8SOleksandr Tymoshenko void 1171d6b3aaf8SOleksandr Tymoshenko sdhci_generic_intr(struct sdhci_slot *slot) 1172831f5dcfSAlexander Motin { 1173831f5dcfSAlexander Motin uint32_t intmask; 1174831f5dcfSAlexander Motin 1175831f5dcfSAlexander Motin SDHCI_LOCK(slot); 1176831f5dcfSAlexander Motin /* Read slot interrupt status. */ 1177831f5dcfSAlexander Motin intmask = RD4(slot, SDHCI_INT_STATUS); 1178831f5dcfSAlexander Motin if (intmask == 0 || intmask == 0xffffffff) { 1179831f5dcfSAlexander Motin SDHCI_UNLOCK(slot); 1180d6b3aaf8SOleksandr Tymoshenko return; 1181831f5dcfSAlexander Motin } 11825b69a497SAlexander Motin if (sdhci_debug > 2) 11835b69a497SAlexander Motin slot_printf(slot, "Interrupt %#x\n", intmask); 11845b69a497SAlexander Motin 1185831f5dcfSAlexander Motin /* Handle card presence interrupts. */ 1186831f5dcfSAlexander Motin if (intmask & (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE)) { 1187831f5dcfSAlexander Motin WR4(slot, SDHCI_INT_STATUS, intmask & 1188831f5dcfSAlexander Motin (SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE)); 1189831f5dcfSAlexander Motin 1190831f5dcfSAlexander Motin if (intmask & SDHCI_INT_CARD_REMOVE) { 11915b69a497SAlexander Motin if (bootverbose || sdhci_debug) 1192831f5dcfSAlexander Motin slot_printf(slot, "Card removed\n"); 1193831f5dcfSAlexander Motin callout_stop(&slot->card_callout); 1194831f5dcfSAlexander Motin taskqueue_enqueue(taskqueue_swi_giant, 1195831f5dcfSAlexander Motin &slot->card_task); 1196831f5dcfSAlexander Motin } 1197831f5dcfSAlexander Motin if (intmask & SDHCI_INT_CARD_INSERT) { 11985b69a497SAlexander Motin if (bootverbose || sdhci_debug) 1199831f5dcfSAlexander Motin slot_printf(slot, "Card inserted\n"); 1200831f5dcfSAlexander Motin callout_reset(&slot->card_callout, hz / 2, 1201831f5dcfSAlexander Motin sdhci_card_delay, slot); 1202831f5dcfSAlexander Motin } 1203831f5dcfSAlexander Motin intmask &= ~(SDHCI_INT_CARD_INSERT | SDHCI_INT_CARD_REMOVE); 1204831f5dcfSAlexander Motin } 1205831f5dcfSAlexander Motin /* Handle command interrupts. */ 1206831f5dcfSAlexander Motin if (intmask & SDHCI_INT_CMD_MASK) { 1207831f5dcfSAlexander Motin WR4(slot, SDHCI_INT_STATUS, intmask & SDHCI_INT_CMD_MASK); 1208831f5dcfSAlexander Motin sdhci_cmd_irq(slot, intmask & SDHCI_INT_CMD_MASK); 1209831f5dcfSAlexander Motin } 1210831f5dcfSAlexander Motin /* Handle data interrupts. */ 1211831f5dcfSAlexander Motin if (intmask & SDHCI_INT_DATA_MASK) { 1212831f5dcfSAlexander Motin WR4(slot, SDHCI_INT_STATUS, intmask & SDHCI_INT_DATA_MASK); 1213831f5dcfSAlexander Motin sdhci_data_irq(slot, intmask & SDHCI_INT_DATA_MASK); 1214831f5dcfSAlexander Motin } 1215831f5dcfSAlexander Motin /* Handle AutoCMD12 error interrupt. */ 1216831f5dcfSAlexander Motin if (intmask & SDHCI_INT_ACMD12ERR) { 1217831f5dcfSAlexander Motin WR4(slot, SDHCI_INT_STATUS, SDHCI_INT_ACMD12ERR); 1218831f5dcfSAlexander Motin sdhci_acmd_irq(slot); 1219831f5dcfSAlexander Motin } 1220831f5dcfSAlexander Motin intmask &= ~(SDHCI_INT_CMD_MASK | SDHCI_INT_DATA_MASK); 1221831f5dcfSAlexander Motin intmask &= ~SDHCI_INT_ACMD12ERR; 1222831f5dcfSAlexander Motin intmask &= ~SDHCI_INT_ERROR; 1223831f5dcfSAlexander Motin /* Handle bus power interrupt. */ 1224831f5dcfSAlexander Motin if (intmask & SDHCI_INT_BUS_POWER) { 1225831f5dcfSAlexander Motin WR4(slot, SDHCI_INT_STATUS, SDHCI_INT_BUS_POWER); 1226831f5dcfSAlexander Motin slot_printf(slot, 1227831f5dcfSAlexander Motin "Card is consuming too much power!\n"); 1228831f5dcfSAlexander Motin intmask &= ~SDHCI_INT_BUS_POWER; 1229831f5dcfSAlexander Motin } 1230831f5dcfSAlexander Motin /* The rest is unknown. */ 1231831f5dcfSAlexander Motin if (intmask) { 1232831f5dcfSAlexander Motin WR4(slot, SDHCI_INT_STATUS, intmask); 1233831f5dcfSAlexander Motin slot_printf(slot, "Unexpected interrupt 0x%08x.\n", 1234831f5dcfSAlexander Motin intmask); 1235831f5dcfSAlexander Motin sdhci_dumpregs(slot); 1236831f5dcfSAlexander Motin } 1237831f5dcfSAlexander Motin 1238831f5dcfSAlexander Motin SDHCI_UNLOCK(slot); 1239831f5dcfSAlexander Motin } 1240831f5dcfSAlexander Motin 1241d6b3aaf8SOleksandr Tymoshenko int 1242d6b3aaf8SOleksandr Tymoshenko sdhci_generic_read_ivar(device_t bus, device_t child, int which, uintptr_t *result) 1243831f5dcfSAlexander Motin { 1244831f5dcfSAlexander Motin struct sdhci_slot *slot = device_get_ivars(child); 1245831f5dcfSAlexander Motin 1246831f5dcfSAlexander Motin switch (which) { 1247831f5dcfSAlexander Motin default: 1248831f5dcfSAlexander Motin return (EINVAL); 1249831f5dcfSAlexander Motin case MMCBR_IVAR_BUS_MODE: 1250bcd91d25SJayachandran C. *result = slot->host.ios.bus_mode; 1251831f5dcfSAlexander Motin break; 1252831f5dcfSAlexander Motin case MMCBR_IVAR_BUS_WIDTH: 1253bcd91d25SJayachandran C. *result = slot->host.ios.bus_width; 1254831f5dcfSAlexander Motin break; 1255831f5dcfSAlexander Motin case MMCBR_IVAR_CHIP_SELECT: 1256bcd91d25SJayachandran C. *result = slot->host.ios.chip_select; 1257831f5dcfSAlexander Motin break; 1258831f5dcfSAlexander Motin case MMCBR_IVAR_CLOCK: 1259bcd91d25SJayachandran C. *result = slot->host.ios.clock; 1260831f5dcfSAlexander Motin break; 1261831f5dcfSAlexander Motin case MMCBR_IVAR_F_MIN: 1262bcd91d25SJayachandran C. *result = slot->host.f_min; 1263831f5dcfSAlexander Motin break; 1264831f5dcfSAlexander Motin case MMCBR_IVAR_F_MAX: 1265bcd91d25SJayachandran C. *result = slot->host.f_max; 1266831f5dcfSAlexander Motin break; 1267831f5dcfSAlexander Motin case MMCBR_IVAR_HOST_OCR: 1268bcd91d25SJayachandran C. *result = slot->host.host_ocr; 1269831f5dcfSAlexander Motin break; 1270831f5dcfSAlexander Motin case MMCBR_IVAR_MODE: 1271bcd91d25SJayachandran C. *result = slot->host.mode; 1272831f5dcfSAlexander Motin break; 1273831f5dcfSAlexander Motin case MMCBR_IVAR_OCR: 1274bcd91d25SJayachandran C. *result = slot->host.ocr; 1275831f5dcfSAlexander Motin break; 1276831f5dcfSAlexander Motin case MMCBR_IVAR_POWER_MODE: 1277bcd91d25SJayachandran C. *result = slot->host.ios.power_mode; 1278831f5dcfSAlexander Motin break; 1279831f5dcfSAlexander Motin case MMCBR_IVAR_VDD: 1280bcd91d25SJayachandran C. *result = slot->host.ios.vdd; 1281831f5dcfSAlexander Motin break; 1282831f5dcfSAlexander Motin case MMCBR_IVAR_CAPS: 1283bcd91d25SJayachandran C. *result = slot->host.caps; 1284831f5dcfSAlexander Motin break; 1285831f5dcfSAlexander Motin case MMCBR_IVAR_TIMING: 1286bcd91d25SJayachandran C. *result = slot->host.ios.timing; 1287831f5dcfSAlexander Motin break; 12883a4a2557SAlexander Motin case MMCBR_IVAR_MAX_DATA: 1289bcd91d25SJayachandran C. *result = 65535; 12903a4a2557SAlexander Motin break; 1291831f5dcfSAlexander Motin } 1292831f5dcfSAlexander Motin return (0); 1293831f5dcfSAlexander Motin } 1294831f5dcfSAlexander Motin 1295d6b3aaf8SOleksandr Tymoshenko int 1296d6b3aaf8SOleksandr Tymoshenko sdhci_generic_write_ivar(device_t bus, device_t child, int which, uintptr_t value) 1297831f5dcfSAlexander Motin { 1298831f5dcfSAlexander Motin struct sdhci_slot *slot = device_get_ivars(child); 1299831f5dcfSAlexander Motin 1300831f5dcfSAlexander Motin switch (which) { 1301831f5dcfSAlexander Motin default: 1302831f5dcfSAlexander Motin return (EINVAL); 1303831f5dcfSAlexander Motin case MMCBR_IVAR_BUS_MODE: 1304831f5dcfSAlexander Motin slot->host.ios.bus_mode = value; 1305831f5dcfSAlexander Motin break; 1306831f5dcfSAlexander Motin case MMCBR_IVAR_BUS_WIDTH: 1307831f5dcfSAlexander Motin slot->host.ios.bus_width = value; 1308831f5dcfSAlexander Motin break; 1309831f5dcfSAlexander Motin case MMCBR_IVAR_CHIP_SELECT: 1310831f5dcfSAlexander Motin slot->host.ios.chip_select = value; 1311831f5dcfSAlexander Motin break; 1312831f5dcfSAlexander Motin case MMCBR_IVAR_CLOCK: 1313831f5dcfSAlexander Motin if (value > 0) { 131457677a3aSOleksandr Tymoshenko uint32_t max_clock; 131557677a3aSOleksandr Tymoshenko uint32_t clock; 1316831f5dcfSAlexander Motin int i; 1317831f5dcfSAlexander Motin 131857677a3aSOleksandr Tymoshenko max_clock = slot->max_clk; 131957677a3aSOleksandr Tymoshenko clock = max_clock; 132057677a3aSOleksandr Tymoshenko 132157677a3aSOleksandr Tymoshenko if (slot->version < SDHCI_SPEC_300) { 132257677a3aSOleksandr Tymoshenko for (i = 0; i < SDHCI_200_MAX_DIVIDER; 132357677a3aSOleksandr Tymoshenko i <<= 1) { 1324831f5dcfSAlexander Motin if (clock <= value) 1325831f5dcfSAlexander Motin break; 1326831f5dcfSAlexander Motin clock >>= 1; 1327831f5dcfSAlexander Motin } 132857677a3aSOleksandr Tymoshenko } 132957677a3aSOleksandr Tymoshenko else { 133057677a3aSOleksandr Tymoshenko for (i = 0; i < SDHCI_300_MAX_DIVIDER; 133157677a3aSOleksandr Tymoshenko i += 2) { 133257677a3aSOleksandr Tymoshenko if (clock <= value) 133357677a3aSOleksandr Tymoshenko break; 133457677a3aSOleksandr Tymoshenko clock = max_clock / (i + 2); 133557677a3aSOleksandr Tymoshenko } 133657677a3aSOleksandr Tymoshenko } 133757677a3aSOleksandr Tymoshenko 1338831f5dcfSAlexander Motin slot->host.ios.clock = clock; 1339831f5dcfSAlexander Motin } else 1340831f5dcfSAlexander Motin slot->host.ios.clock = 0; 1341831f5dcfSAlexander Motin break; 1342831f5dcfSAlexander Motin case MMCBR_IVAR_MODE: 1343831f5dcfSAlexander Motin slot->host.mode = value; 1344831f5dcfSAlexander Motin break; 1345831f5dcfSAlexander Motin case MMCBR_IVAR_OCR: 1346831f5dcfSAlexander Motin slot->host.ocr = value; 1347831f5dcfSAlexander Motin break; 1348831f5dcfSAlexander Motin case MMCBR_IVAR_POWER_MODE: 1349831f5dcfSAlexander Motin slot->host.ios.power_mode = value; 1350831f5dcfSAlexander Motin break; 1351831f5dcfSAlexander Motin case MMCBR_IVAR_VDD: 1352831f5dcfSAlexander Motin slot->host.ios.vdd = value; 1353831f5dcfSAlexander Motin break; 1354831f5dcfSAlexander Motin case MMCBR_IVAR_TIMING: 1355831f5dcfSAlexander Motin slot->host.ios.timing = value; 1356831f5dcfSAlexander Motin break; 1357831f5dcfSAlexander Motin case MMCBR_IVAR_CAPS: 1358831f5dcfSAlexander Motin case MMCBR_IVAR_HOST_OCR: 1359831f5dcfSAlexander Motin case MMCBR_IVAR_F_MIN: 1360831f5dcfSAlexander Motin case MMCBR_IVAR_F_MAX: 13613a4a2557SAlexander Motin case MMCBR_IVAR_MAX_DATA: 1362831f5dcfSAlexander Motin return (EINVAL); 1363831f5dcfSAlexander Motin } 1364831f5dcfSAlexander Motin return (0); 1365831f5dcfSAlexander Motin } 1366831f5dcfSAlexander Motin 1367d6b3aaf8SOleksandr Tymoshenko MODULE_VERSION(sdhci, 1); 1368