1114b4164SWarner Losh /*- 2114b4164SWarner Losh * Copyright (c) 2006 Bernd Walter. All rights reserved. 3114b4164SWarner Losh * Copyright (c) 2006 M. Warner Losh. All rights reserved. 4114b4164SWarner Losh * 5114b4164SWarner Losh * Redistribution and use in source and binary forms, with or without 6114b4164SWarner Losh * modification, are permitted provided that the following conditions 7114b4164SWarner Losh * are met: 8114b4164SWarner Losh * 1. Redistributions of source code must retain the above copyright 9114b4164SWarner Losh * notice, this list of conditions and the following disclaimer. 10114b4164SWarner Losh * 2. Redistributions in binary form must reproduce the above copyright 11114b4164SWarner Losh * notice, this list of conditions and the following disclaimer in the 12114b4164SWarner Losh * documentation and/or other materials provided with the distribution. 13114b4164SWarner Losh * 14114b4164SWarner Losh * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 15114b4164SWarner Losh * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 16114b4164SWarner Losh * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 17114b4164SWarner Losh * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 18114b4164SWarner Losh * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 19114b4164SWarner Losh * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 20114b4164SWarner Losh * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 21114b4164SWarner Losh * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 22114b4164SWarner Losh * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 23114b4164SWarner Losh * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 2414eced72SWarner Losh * 2514eced72SWarner Losh * Portions of this software may have been developed with reference to 2614eced72SWarner Losh * the SD Simplified Specification. The following disclaimer may apply: 2714eced72SWarner Losh * 2814eced72SWarner Losh * The following conditions apply to the release of the simplified 2914eced72SWarner Losh * specification ("Simplified Specification") by the SD Card Association and 3014eced72SWarner Losh * the SD Group. The Simplified Specification is a subset of the complete SD 3114eced72SWarner Losh * Specification which is owned by the SD Card Association and the SD 3214eced72SWarner Losh * Group. This Simplified Specification is provided on a non-confidential 3314eced72SWarner Losh * basis subject to the disclaimers below. Any implementation of the 3414eced72SWarner Losh * Simplified Specification may require a license from the SD Card 3514eced72SWarner Losh * Association, SD Group, SD-3C LLC or other third parties. 3614eced72SWarner Losh * 3714eced72SWarner Losh * Disclaimers: 3814eced72SWarner Losh * 3914eced72SWarner Losh * The information contained in the Simplified Specification is presented only 4014eced72SWarner Losh * as a standard specification for SD Cards and SD Host/Ancillary products and 4114eced72SWarner Losh * is provided "AS-IS" without any representations or warranties of any 4214eced72SWarner Losh * kind. No responsibility is assumed by the SD Group, SD-3C LLC or the SD 4314eced72SWarner Losh * Card Association for any damages, any infringements of patents or other 4414eced72SWarner Losh * right of the SD Group, SD-3C LLC, the SD Card Association or any third 4514eced72SWarner Losh * parties, which may result from its use. No license is granted by 4614eced72SWarner Losh * implication, estoppel or otherwise under any patent or other rights of the 4714eced72SWarner Losh * SD Group, SD-3C LLC, the SD Card Association or any third party. Nothing 4814eced72SWarner Losh * herein shall be construed as an obligation by the SD Group, the SD-3C LLC 4914eced72SWarner Losh * or the SD Card Association to disclose or distribute any technical 5014eced72SWarner Losh * information, know-how or other confidential information to any third party. 51114b4164SWarner Losh */ 52114b4164SWarner Losh 53114b4164SWarner Losh #include <sys/cdefs.h> 54114b4164SWarner Losh __FBSDID("$FreeBSD$"); 55114b4164SWarner Losh 56114b4164SWarner Losh #include <sys/param.h> 57114b4164SWarner Losh #include <sys/systm.h> 58114b4164SWarner Losh #include <sys/bio.h> 59114b4164SWarner Losh #include <sys/bus.h> 60114b4164SWarner Losh #include <sys/conf.h> 61114b4164SWarner Losh #include <sys/kernel.h> 62114b4164SWarner Losh #include <sys/kthread.h> 63114b4164SWarner Losh #include <sys/lock.h> 64114b4164SWarner Losh #include <sys/malloc.h> 65114b4164SWarner Losh #include <sys/module.h> 66114b4164SWarner Losh #include <sys/mutex.h> 67114b4164SWarner Losh #include <geom/geom_disk.h> 68114b4164SWarner Losh 69114b4164SWarner Losh #include <dev/mmc/mmcvar.h> 70114b4164SWarner Losh #include <dev/mmc/mmcreg.h> 71114b4164SWarner Losh 72114b4164SWarner Losh #include "mmcbus_if.h" 73114b4164SWarner Losh 74114b4164SWarner Losh struct mmcsd_softc { 75114b4164SWarner Losh device_t dev; 76114b4164SWarner Losh struct mtx sc_mtx; 77114b4164SWarner Losh struct disk *disk; 78114b4164SWarner Losh struct proc *p; 79114b4164SWarner Losh struct bio_queue_head bio_queue; 80a7cf6274SAlexander Motin daddr_t eblock, eend; /* Range remaining after the last erase. */ 810e1466acSWarner Losh int running; 82114b4164SWarner Losh }; 83114b4164SWarner Losh 840c0903b1SWarner Losh #define MULTI_BLOCK_BROKEN 85114b4164SWarner Losh 86114b4164SWarner Losh /* bus entry points */ 87114b4164SWarner Losh static int mmcsd_probe(device_t dev); 88114b4164SWarner Losh static int mmcsd_attach(device_t dev); 89114b4164SWarner Losh static int mmcsd_detach(device_t dev); 90114b4164SWarner Losh 91114b4164SWarner Losh /* disk routines */ 92114b4164SWarner Losh static int mmcsd_open(struct disk *dp); 93114b4164SWarner Losh static int mmcsd_close(struct disk *dp); 94114b4164SWarner Losh static void mmcsd_strategy(struct bio *bp); 95114b4164SWarner Losh static void mmcsd_task(void *arg); 96114b4164SWarner Losh 97a0075e58SWarner Losh static const char *mmcsd_card_name(device_t dev); 98a0075e58SWarner Losh static int mmcsd_bus_bit_width(device_t dev); 99a0075e58SWarner Losh 100114b4164SWarner Losh #define MMCSD_LOCK(_sc) mtx_lock(&(_sc)->sc_mtx) 101114b4164SWarner Losh #define MMCSD_UNLOCK(_sc) mtx_unlock(&(_sc)->sc_mtx) 102114b4164SWarner Losh #define MMCSD_LOCK_INIT(_sc) \ 103114b4164SWarner Losh mtx_init(&_sc->sc_mtx, device_get_nameunit(_sc->dev), \ 104114b4164SWarner Losh "mmcsd", MTX_DEF) 105114b4164SWarner Losh #define MMCSD_LOCK_DESTROY(_sc) mtx_destroy(&_sc->sc_mtx); 106114b4164SWarner Losh #define MMCSD_ASSERT_LOCKED(_sc) mtx_assert(&_sc->sc_mtx, MA_OWNED); 107114b4164SWarner Losh #define MMCSD_ASSERT_UNLOCKED(_sc) mtx_assert(&_sc->sc_mtx, MA_NOTOWNED); 108114b4164SWarner Losh 109114b4164SWarner Losh static int 110114b4164SWarner Losh mmcsd_probe(device_t dev) 111114b4164SWarner Losh { 112114b4164SWarner Losh 113c18f1e26SAlexander Motin device_quiet(dev); 1140c0903b1SWarner Losh device_set_desc(dev, "MMC/SD Memory Card"); 115114b4164SWarner Losh return (0); 116114b4164SWarner Losh } 117114b4164SWarner Losh 118114b4164SWarner Losh static int 119114b4164SWarner Losh mmcsd_attach(device_t dev) 120114b4164SWarner Losh { 121114b4164SWarner Losh struct mmcsd_softc *sc; 122a0075e58SWarner Losh struct disk *d; 123a0075e58SWarner Losh intmax_t mb; 124a0075e58SWarner Losh char unit; 125114b4164SWarner Losh 126114b4164SWarner Losh sc = device_get_softc(dev); 127114b4164SWarner Losh sc->dev = dev; 128114b4164SWarner Losh MMCSD_LOCK_INIT(sc); 129114b4164SWarner Losh 130a0075e58SWarner Losh d = sc->disk = disk_alloc(); 131a0075e58SWarner Losh d->d_open = mmcsd_open; 132a0075e58SWarner Losh d->d_close = mmcsd_close; 133a0075e58SWarner Losh d->d_strategy = mmcsd_strategy; 134a0075e58SWarner Losh // d->d_dump = mmcsd_dump; Need polling mmc layer 135a0075e58SWarner Losh d->d_name = "mmcsd"; 136a0075e58SWarner Losh d->d_drv1 = sc; 1373906d42dSAlexander Motin d->d_maxsize = 4*1024*1024; /* Maximum defined SD card AU size. */ 138a0075e58SWarner Losh d->d_sectorsize = mmc_get_sector_size(dev); 139a0075e58SWarner Losh d->d_mediasize = mmc_get_media_size(dev) * d->d_sectorsize; 140a0075e58SWarner Losh d->d_unit = device_get_unit(dev); 1413906d42dSAlexander Motin d->d_flags = DISKFLAG_CANDELETE; 142a0075e58SWarner Losh /* 143a0075e58SWarner Losh * Display in most natural units. There's no cards < 1MB. 144a0075e58SWarner Losh * The SD standard goes to 2GiB, but the data format supports 145a0075e58SWarner Losh * up to 4GiB and some card makers push it up to this limit. 146a0075e58SWarner Losh * The SDHC standard only goes to 32GiB (the data format in 147a0075e58SWarner Losh * SDHC is good to 2TiB however, which isn't too ugly at 148a0075e58SWarner Losh * 2048GiBm, so we note it in passing here and don't add the 149a0075e58SWarner Losh * code to print TiB). 150a0075e58SWarner Losh */ 151a0075e58SWarner Losh mb = d->d_mediasize >> 20; /* 1MiB == 1 << 20 */ 152a0075e58SWarner Losh unit = 'M'; 15358bb6260SAlexander Motin if (mb >= 10240) { /* 1GiB = 1024 MiB */ 154a0075e58SWarner Losh unit = 'G'; 155a0075e58SWarner Losh mb /= 1024; 156a0075e58SWarner Losh } 157a0075e58SWarner Losh device_printf(dev, "%ju%cB <%s Memory Card>%s at %s %dMHz/%dbit\n", 158a0075e58SWarner Losh mb, unit, mmcsd_card_name(dev), 1590c0903b1SWarner Losh mmc_get_read_only(dev) ? " (read-only)" : "", 160a0075e58SWarner Losh device_get_nameunit(device_get_parent(dev)), 161a0075e58SWarner Losh mmc_get_tran_speed(dev) / 1000000, mmcsd_bus_bit_width(dev)); 162a0075e58SWarner Losh disk_create(d, DISK_VERSION); 163114b4164SWarner Losh bioq_init(&sc->bio_queue); 1640e1466acSWarner Losh 1650e1466acSWarner Losh sc->running = 1; 166a7cf6274SAlexander Motin sc->eblock = sc->eend = 0; 1673745c395SJulian Elischer kproc_create(&mmcsd_task, sc, &sc->p, 0, 0, "task: mmc/sd card"); 168114b4164SWarner Losh 169114b4164SWarner Losh return (0); 170114b4164SWarner Losh } 171114b4164SWarner Losh 172114b4164SWarner Losh static int 173114b4164SWarner Losh mmcsd_detach(device_t dev) 174114b4164SWarner Losh { 1750e1466acSWarner Losh struct mmcsd_softc *sc = device_get_softc(dev); 1760e1466acSWarner Losh 1770e1466acSWarner Losh /* kill thread */ 1780e1466acSWarner Losh MMCSD_LOCK(sc); 1790e1466acSWarner Losh sc->running = 0; 1800e1466acSWarner Losh wakeup(sc); 1810e1466acSWarner Losh MMCSD_UNLOCK(sc); 1820e1466acSWarner Losh 1830e1466acSWarner Losh /* wait for thread to finish. XXX probably want timeout. -sorbo */ 1840e1466acSWarner Losh MMCSD_LOCK(sc); 1850e1466acSWarner Losh while (sc->running != -1) 1860e1466acSWarner Losh msleep(sc, &sc->sc_mtx, PRIBIO, "detach", 0); 1870e1466acSWarner Losh MMCSD_UNLOCK(sc); 1880e1466acSWarner Losh 1890e1466acSWarner Losh /* kill disk */ 1900e1466acSWarner Losh disk_destroy(sc->disk); 1910e1466acSWarner Losh /* XXX destroy anything in queue */ 1920e1466acSWarner Losh 1930e1466acSWarner Losh MMCSD_LOCK_DESTROY(sc); 1940e1466acSWarner Losh 195128d0ff2SWarner Losh return (0); 196114b4164SWarner Losh } 197114b4164SWarner Losh 198114b4164SWarner Losh static int 199114b4164SWarner Losh mmcsd_open(struct disk *dp) 200114b4164SWarner Losh { 201128d0ff2SWarner Losh return (0); 202114b4164SWarner Losh } 203114b4164SWarner Losh 204114b4164SWarner Losh static int 205114b4164SWarner Losh mmcsd_close(struct disk *dp) 206114b4164SWarner Losh { 207128d0ff2SWarner Losh return (0); 208114b4164SWarner Losh } 209114b4164SWarner Losh 210114b4164SWarner Losh static void 211114b4164SWarner Losh mmcsd_strategy(struct bio *bp) 212114b4164SWarner Losh { 213114b4164SWarner Losh struct mmcsd_softc *sc; 214114b4164SWarner Losh 215114b4164SWarner Losh sc = (struct mmcsd_softc *)bp->bio_disk->d_drv1; 216114b4164SWarner Losh MMCSD_LOCK(sc); 217114b4164SWarner Losh bioq_disksort(&sc->bio_queue, bp); 218114b4164SWarner Losh wakeup(sc); 219114b4164SWarner Losh MMCSD_UNLOCK(sc); 220114b4164SWarner Losh } 221114b4164SWarner Losh 2223906d42dSAlexander Motin static daddr_t 2233906d42dSAlexander Motin mmcsd_rw(struct mmcsd_softc *sc, struct bio *bp) 224114b4164SWarner Losh { 225114b4164SWarner Losh daddr_t block, end; 226114b4164SWarner Losh struct mmc_command cmd; 227114b4164SWarner Losh struct mmc_command stop; 228114b4164SWarner Losh struct mmc_request req; 229114b4164SWarner Losh struct mmc_data data; 2303906d42dSAlexander Motin device_t dev = sc->dev; 2313906d42dSAlexander Motin int sz = sc->disk->d_sectorsize; 232114b4164SWarner Losh 2333906d42dSAlexander Motin block = bp->bio_pblkno; 234114b4164SWarner Losh end = bp->bio_pblkno + (bp->bio_bcount / sz); 2353906d42dSAlexander Motin while (block < end) { 2363906d42dSAlexander Motin char *vaddr = bp->bio_data + 2373906d42dSAlexander Motin (block - bp->bio_pblkno) * sz; 2380c0903b1SWarner Losh int numblocks; 2390c0903b1SWarner Losh #ifdef MULTI_BLOCK 2400c0903b1SWarner Losh numblocks = end - block; 2410c0903b1SWarner Losh #else 2420c0903b1SWarner Losh numblocks = 1; 2430c0903b1SWarner Losh #endif 244114b4164SWarner Losh memset(&req, 0, sizeof(req)); 245114b4164SWarner Losh memset(&cmd, 0, sizeof(cmd)); 246114b4164SWarner Losh memset(&stop, 0, sizeof(stop)); 247114b4164SWarner Losh req.cmd = &cmd; 248114b4164SWarner Losh cmd.data = &data; 249114b4164SWarner Losh if (bp->bio_cmd == BIO_READ) { 2500c0903b1SWarner Losh if (numblocks > 1) 251114b4164SWarner Losh cmd.opcode = MMC_READ_MULTIPLE_BLOCK; 252114b4164SWarner Losh else 253114b4164SWarner Losh cmd.opcode = MMC_READ_SINGLE_BLOCK; 2540c0903b1SWarner Losh } else { 2550c0903b1SWarner Losh if (numblocks > 1) 2560c0903b1SWarner Losh cmd.opcode = MMC_WRITE_MULTIPLE_BLOCK; 2570c0903b1SWarner Losh else 258114b4164SWarner Losh cmd.opcode = MMC_WRITE_BLOCK; 2590c0903b1SWarner Losh } 260c18f1e26SAlexander Motin cmd.arg = block; 261c18f1e26SAlexander Motin if (!mmc_get_high_cap(dev)) 262c18f1e26SAlexander Motin cmd.arg <<= 9; 263114b4164SWarner Losh cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC; 264114b4164SWarner Losh data.data = vaddr; 265114b4164SWarner Losh data.mrq = &req; 2660c0903b1SWarner Losh if (bp->bio_cmd == BIO_READ) 267114b4164SWarner Losh data.flags = MMC_DATA_READ; 2680c0903b1SWarner Losh else 269114b4164SWarner Losh data.flags = MMC_DATA_WRITE; 2700c0903b1SWarner Losh data.len = numblocks * sz; 2710c0903b1SWarner Losh if (numblocks > 1) { 2720c0903b1SWarner Losh data.flags |= MMC_DATA_MULTI; 273114b4164SWarner Losh stop.opcode = MMC_STOP_TRANSMISSION; 274114b4164SWarner Losh stop.arg = 0; 275114b4164SWarner Losh stop.flags = MMC_RSP_R1B | MMC_CMD_AC; 2760c0903b1SWarner Losh req.stop = &stop; 2770c0903b1SWarner Losh } 2780c0903b1SWarner Losh // printf("Len %d %lld-%lld flags %#x sz %d\n", 2790c0903b1SWarner Losh // (int)data.len, (long long)block, (long long)end, data.flags, sz); 280114b4164SWarner Losh MMCBUS_WAIT_FOR_REQUEST(device_get_parent(dev), dev, 281114b4164SWarner Losh &req); 2820c0903b1SWarner Losh if (req.cmd->error != MMC_ERR_NONE) 2830c0903b1SWarner Losh break; 2840c0903b1SWarner Losh block += numblocks; 285114b4164SWarner Losh } 2863906d42dSAlexander Motin return (block); 2873906d42dSAlexander Motin } 2883906d42dSAlexander Motin 2893906d42dSAlexander Motin static daddr_t 2903906d42dSAlexander Motin mmcsd_delete(struct mmcsd_softc *sc, struct bio *bp) 2913906d42dSAlexander Motin { 2923906d42dSAlexander Motin daddr_t block, end, start, stop; 2933906d42dSAlexander Motin struct mmc_command cmd; 2943906d42dSAlexander Motin struct mmc_request req; 2953906d42dSAlexander Motin device_t dev = sc->dev; 2963906d42dSAlexander Motin int sz = sc->disk->d_sectorsize; 2973906d42dSAlexander Motin int erase_sector; 2983906d42dSAlexander Motin 2993906d42dSAlexander Motin block = bp->bio_pblkno; 3003906d42dSAlexander Motin end = bp->bio_pblkno + (bp->bio_bcount / sz); 301a7cf6274SAlexander Motin /* Coalesce with part remaining from previous request. */ 302a7cf6274SAlexander Motin if (block > sc->eblock && block <= sc->eend) 303a7cf6274SAlexander Motin block = sc->eblock; 304a7cf6274SAlexander Motin if (end >= sc->eblock && end < sc->eend) 305a7cf6274SAlexander Motin end = sc->eend; 3063906d42dSAlexander Motin /* Safe round to the erase sector boundaries. */ 3073906d42dSAlexander Motin erase_sector = mmc_get_erase_sector(dev); 3083906d42dSAlexander Motin start = block + erase_sector - 1; /* Round up. */ 3093906d42dSAlexander Motin start -= start % erase_sector; 3103906d42dSAlexander Motin stop = end; /* Round down. */ 3113906d42dSAlexander Motin stop -= end % erase_sector; 312a7cf6274SAlexander Motin /* We can't erase area smaller then sector, store it for later. */ 313a7cf6274SAlexander Motin if (start >= stop) { 314a7cf6274SAlexander Motin sc->eblock = block; 315a7cf6274SAlexander Motin sc->eend = end; 3163906d42dSAlexander Motin return (end); 317a7cf6274SAlexander Motin } 3183906d42dSAlexander Motin 3193906d42dSAlexander Motin /* Set erase start position. */ 3203906d42dSAlexander Motin memset(&req, 0, sizeof(req)); 3213906d42dSAlexander Motin memset(&cmd, 0, sizeof(cmd)); 3223906d42dSAlexander Motin req.cmd = &cmd; 3233906d42dSAlexander Motin if (mmc_get_card_type(dev) == mode_sd) 3243906d42dSAlexander Motin cmd.opcode = SD_ERASE_WR_BLK_START; 3253906d42dSAlexander Motin else 3263906d42dSAlexander Motin cmd.opcode = MMC_ERASE_GROUP_START; 3273906d42dSAlexander Motin cmd.arg = start; 3283906d42dSAlexander Motin if (!mmc_get_high_cap(dev)) 3293906d42dSAlexander Motin cmd.arg <<= 9; 3303906d42dSAlexander Motin cmd.flags = MMC_RSP_R1 | MMC_CMD_AC; 3313906d42dSAlexander Motin MMCBUS_WAIT_FOR_REQUEST(device_get_parent(dev), dev, 3323906d42dSAlexander Motin &req); 3333906d42dSAlexander Motin if (req.cmd->error != MMC_ERR_NONE) { 3343906d42dSAlexander Motin printf("erase err1: %d\n", req.cmd->error); 3353906d42dSAlexander Motin return (block); 3363906d42dSAlexander Motin } 3373906d42dSAlexander Motin /* Set erase stop position. */ 3383906d42dSAlexander Motin memset(&req, 0, sizeof(req)); 3393906d42dSAlexander Motin memset(&cmd, 0, sizeof(cmd)); 3403906d42dSAlexander Motin req.cmd = &cmd; 3413906d42dSAlexander Motin if (mmc_get_card_type(dev) == mode_sd) 3423906d42dSAlexander Motin cmd.opcode = SD_ERASE_WR_BLK_END; 3433906d42dSAlexander Motin else 3443906d42dSAlexander Motin cmd.opcode = MMC_ERASE_GROUP_END; 3453906d42dSAlexander Motin cmd.arg = stop; 3463906d42dSAlexander Motin if (!mmc_get_high_cap(dev)) 3473906d42dSAlexander Motin cmd.arg <<= 9; 3483906d42dSAlexander Motin cmd.arg--; 3493906d42dSAlexander Motin cmd.flags = MMC_RSP_R1 | MMC_CMD_AC; 3503906d42dSAlexander Motin MMCBUS_WAIT_FOR_REQUEST(device_get_parent(dev), dev, 3513906d42dSAlexander Motin &req); 3523906d42dSAlexander Motin if (req.cmd->error != MMC_ERR_NONE) { 3533906d42dSAlexander Motin printf("erase err2: %d\n", req.cmd->error); 3543906d42dSAlexander Motin return (block); 3553906d42dSAlexander Motin } 3563906d42dSAlexander Motin /* Erase range. */ 3573906d42dSAlexander Motin memset(&req, 0, sizeof(req)); 3583906d42dSAlexander Motin memset(&cmd, 0, sizeof(cmd)); 3593906d42dSAlexander Motin req.cmd = &cmd; 3603906d42dSAlexander Motin cmd.opcode = MMC_ERASE; 3613906d42dSAlexander Motin cmd.arg = 0; 3623906d42dSAlexander Motin cmd.flags = MMC_RSP_R1B | MMC_CMD_AC; 3633906d42dSAlexander Motin MMCBUS_WAIT_FOR_REQUEST(device_get_parent(dev), dev, 3643906d42dSAlexander Motin &req); 3653906d42dSAlexander Motin if (req.cmd->error != MMC_ERR_NONE) { 3663906d42dSAlexander Motin printf("erase err3 %d\n", req.cmd->error); 3673906d42dSAlexander Motin return (block); 3683906d42dSAlexander Motin } 369a7cf6274SAlexander Motin /* Store one of remaining parts for the next call. */ 370a7cf6274SAlexander Motin if (bp->bio_pblkno >= sc->eblock || block == start) { 371a7cf6274SAlexander Motin sc->eblock = stop; /* Predict next forward. */ 372a7cf6274SAlexander Motin sc->eend = end; 373a7cf6274SAlexander Motin } else { 374a7cf6274SAlexander Motin sc->eblock = block; /* Predict next backward. */ 375a7cf6274SAlexander Motin sc->eend = start; 376a7cf6274SAlexander Motin } 3773906d42dSAlexander Motin return (end); 3783906d42dSAlexander Motin } 3793906d42dSAlexander Motin 3803906d42dSAlexander Motin static void 3813906d42dSAlexander Motin mmcsd_task(void *arg) 3823906d42dSAlexander Motin { 3833906d42dSAlexander Motin struct mmcsd_softc *sc = (struct mmcsd_softc*)arg; 3843906d42dSAlexander Motin struct bio *bp; 3853906d42dSAlexander Motin int sz; 3863906d42dSAlexander Motin daddr_t block, end; 3873906d42dSAlexander Motin device_t dev; 3883906d42dSAlexander Motin 3893906d42dSAlexander Motin dev = sc->dev; 3903906d42dSAlexander Motin while (sc->running) { 3913906d42dSAlexander Motin MMCSD_LOCK(sc); 3923906d42dSAlexander Motin do { 3933906d42dSAlexander Motin bp = bioq_first(&sc->bio_queue); 3943906d42dSAlexander Motin if (bp == NULL) 3953906d42dSAlexander Motin msleep(sc, &sc->sc_mtx, PRIBIO, "jobqueue", 0); 3963906d42dSAlexander Motin } while (bp == NULL && sc->running); 3973906d42dSAlexander Motin if (bp) 3983906d42dSAlexander Motin bioq_remove(&sc->bio_queue, bp); 3993906d42dSAlexander Motin MMCSD_UNLOCK(sc); 4003906d42dSAlexander Motin if (!sc->running) 4013906d42dSAlexander Motin break; 4023906d42dSAlexander Motin if (bp->bio_cmd != BIO_READ && mmc_get_read_only(dev)) { 4033906d42dSAlexander Motin bp->bio_error = EROFS; 4043906d42dSAlexander Motin bp->bio_resid = bp->bio_bcount; 4053906d42dSAlexander Motin bp->bio_flags |= BIO_ERROR; 4063906d42dSAlexander Motin biodone(bp); 4073906d42dSAlexander Motin continue; 4083906d42dSAlexander Motin } 4093906d42dSAlexander Motin MMCBUS_ACQUIRE_BUS(device_get_parent(dev), dev); 4103906d42dSAlexander Motin sz = sc->disk->d_sectorsize; 4113906d42dSAlexander Motin block = bp->bio_pblkno; 4123906d42dSAlexander Motin end = bp->bio_pblkno + (bp->bio_bcount / sz); 4133906d42dSAlexander Motin if (bp->bio_cmd == BIO_READ || bp->bio_cmd == BIO_WRITE) { 414a7cf6274SAlexander Motin /* Access to the remaining erase block obsoletes it. */ 415a7cf6274SAlexander Motin if (block < sc->eend && end > sc->eblock) 416a7cf6274SAlexander Motin sc->eblock = sc->eend = 0; 4173906d42dSAlexander Motin block = mmcsd_rw(sc, bp); 4183906d42dSAlexander Motin } else if (bp->bio_cmd == BIO_DELETE) { 4193906d42dSAlexander Motin block = mmcsd_delete(sc, bp); 4203906d42dSAlexander Motin } 421114b4164SWarner Losh MMCBUS_RELEASE_BUS(device_get_parent(dev), dev); 4220c0903b1SWarner Losh if (block < end) { 4230c0903b1SWarner Losh bp->bio_error = EIO; 4240c0903b1SWarner Losh bp->bio_resid = (end - block) * sz; 4250c0903b1SWarner Losh bp->bio_flags |= BIO_ERROR; 4260c0903b1SWarner Losh } 427114b4164SWarner Losh biodone(bp); 428114b4164SWarner Losh } 4290e1466acSWarner Losh 4300e1466acSWarner Losh /* tell parent we're done */ 4310e1466acSWarner Losh MMCSD_LOCK(sc); 4320e1466acSWarner Losh sc->running = -1; 4330e1466acSWarner Losh wakeup(sc); 4340e1466acSWarner Losh MMCSD_UNLOCK(sc); 4350e1466acSWarner Losh 4363745c395SJulian Elischer kproc_exit(0); 437114b4164SWarner Losh } 438114b4164SWarner Losh 439a0075e58SWarner Losh static const char * 440a0075e58SWarner Losh mmcsd_card_name(device_t dev) 441a0075e58SWarner Losh { 442a0075e58SWarner Losh if (mmc_get_card_type(dev) == mode_mmc) 443a0075e58SWarner Losh return ("MMC"); 444a0075e58SWarner Losh if (mmc_get_high_cap(dev)) 445a0075e58SWarner Losh return ("SDHC"); 446a0075e58SWarner Losh return ("SD"); 447a0075e58SWarner Losh } 448a0075e58SWarner Losh 449a0075e58SWarner Losh static int 450a0075e58SWarner Losh mmcsd_bus_bit_width(device_t dev) 451a0075e58SWarner Losh { 452a0075e58SWarner Losh if (mmc_get_bus_width(dev) == bus_width_1) 453a0075e58SWarner Losh return (1); 454a0075e58SWarner Losh if (mmc_get_bus_width(dev) == bus_width_4) 455a0075e58SWarner Losh return (4); 456a0075e58SWarner Losh return (8); 457a0075e58SWarner Losh } 458a0075e58SWarner Losh 459114b4164SWarner Losh static device_method_t mmcsd_methods[] = { 460114b4164SWarner Losh DEVMETHOD(device_probe, mmcsd_probe), 461114b4164SWarner Losh DEVMETHOD(device_attach, mmcsd_attach), 462114b4164SWarner Losh DEVMETHOD(device_detach, mmcsd_detach), 463114b4164SWarner Losh {0, 0}, 464114b4164SWarner Losh }; 465114b4164SWarner Losh 466114b4164SWarner Losh static driver_t mmcsd_driver = { 467114b4164SWarner Losh "mmcsd", 468114b4164SWarner Losh mmcsd_methods, 469114b4164SWarner Losh sizeof(struct mmcsd_softc), 470114b4164SWarner Losh }; 471114b4164SWarner Losh static devclass_t mmcsd_devclass; 472114b4164SWarner Losh 473114b4164SWarner Losh DRIVER_MODULE(mmcsd, mmc, mmcsd_driver, mmcsd_devclass, 0, 0); 474