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 697aa65846SMarius Strobl #include <dev/mmc/mmcbrvar.h> 70114b4164SWarner Losh #include <dev/mmc/mmcreg.h> 717aa65846SMarius Strobl #include <dev/mmc/mmcvar.h> 72114b4164SWarner Losh 73114b4164SWarner Losh #include "mmcbus_if.h" 74114b4164SWarner Losh 757aa65846SMarius Strobl #if __FreeBSD_version < 800002 767aa65846SMarius Strobl #define kproc_create kthread_create 777aa65846SMarius Strobl #define kproc_exit kthread_exit 787aa65846SMarius Strobl #endif 797aa65846SMarius Strobl 80114b4164SWarner Losh struct mmcsd_softc { 81114b4164SWarner Losh device_t dev; 82114b4164SWarner Losh struct mtx sc_mtx; 83114b4164SWarner Losh struct disk *disk; 84114b4164SWarner Losh struct proc *p; 85114b4164SWarner Losh struct bio_queue_head bio_queue; 86a7cf6274SAlexander Motin daddr_t eblock, eend; /* Range remaining after the last erase. */ 870e1466acSWarner Losh int running; 88eb67f31aSAlexander Motin int suspend; 89114b4164SWarner Losh }; 90114b4164SWarner Losh 91bb1ef63fSWarner Losh static const char *errmsg[] = 92bb1ef63fSWarner Losh { 93bb1ef63fSWarner Losh "None", 94bb1ef63fSWarner Losh "Timeout", 95bb1ef63fSWarner Losh "Bad CRC", 96bb1ef63fSWarner Losh "Fifo", 97bb1ef63fSWarner Losh "Failed", 98bb1ef63fSWarner Losh "Invalid", 99bb1ef63fSWarner Losh "NO MEMORY" 100bb1ef63fSWarner Losh }; 101bb1ef63fSWarner Losh 102114b4164SWarner Losh /* bus entry points */ 103114b4164SWarner Losh static int mmcsd_attach(device_t dev); 104114b4164SWarner Losh static int mmcsd_detach(device_t dev); 105ae5d8757SMarius Strobl static int mmcsd_probe(device_t dev); 106114b4164SWarner Losh 107114b4164SWarner Losh /* disk routines */ 108114b4164SWarner Losh static int mmcsd_close(struct disk *dp); 109a1fda318SAlexander Motin static int mmcsd_dump(void *arg, void *virtual, vm_offset_t physical, 110a1fda318SAlexander Motin off_t offset, size_t length); 111ae5d8757SMarius Strobl static int mmcsd_open(struct disk *dp); 112ae5d8757SMarius Strobl static void mmcsd_strategy(struct bio *bp); 113114b4164SWarner Losh static void mmcsd_task(void *arg); 114114b4164SWarner Losh 115a0075e58SWarner Losh static int mmcsd_bus_bit_width(device_t dev); 116ae5d8757SMarius Strobl static daddr_t mmcsd_delete(struct mmcsd_softc *sc, struct bio *bp); 117ae5d8757SMarius Strobl static daddr_t mmcsd_rw(struct mmcsd_softc *sc, struct bio *bp); 118a0075e58SWarner Losh 119114b4164SWarner Losh #define MMCSD_LOCK(_sc) mtx_lock(&(_sc)->sc_mtx) 120114b4164SWarner Losh #define MMCSD_UNLOCK(_sc) mtx_unlock(&(_sc)->sc_mtx) 121114b4164SWarner Losh #define MMCSD_LOCK_INIT(_sc) \ 122114b4164SWarner Losh mtx_init(&_sc->sc_mtx, device_get_nameunit(_sc->dev), \ 123114b4164SWarner Losh "mmcsd", MTX_DEF) 124114b4164SWarner Losh #define MMCSD_LOCK_DESTROY(_sc) mtx_destroy(&_sc->sc_mtx); 125114b4164SWarner Losh #define MMCSD_ASSERT_LOCKED(_sc) mtx_assert(&_sc->sc_mtx, MA_OWNED); 126114b4164SWarner Losh #define MMCSD_ASSERT_UNLOCKED(_sc) mtx_assert(&_sc->sc_mtx, MA_NOTOWNED); 127114b4164SWarner Losh 128114b4164SWarner Losh static int 129114b4164SWarner Losh mmcsd_probe(device_t dev) 130114b4164SWarner Losh { 131114b4164SWarner Losh 132c18f1e26SAlexander Motin device_quiet(dev); 1330c0903b1SWarner Losh device_set_desc(dev, "MMC/SD Memory Card"); 134114b4164SWarner Losh return (0); 135114b4164SWarner Losh } 136114b4164SWarner Losh 137114b4164SWarner Losh static int 138114b4164SWarner Losh mmcsd_attach(device_t dev) 139114b4164SWarner Losh { 140114b4164SWarner Losh struct mmcsd_softc *sc; 141a0075e58SWarner Losh struct disk *d; 142a0075e58SWarner Losh intmax_t mb; 1437aa65846SMarius Strobl uint32_t speed; 1447aa65846SMarius Strobl uint32_t maxblocks; 145a0075e58SWarner Losh char unit; 146114b4164SWarner Losh 147114b4164SWarner Losh sc = device_get_softc(dev); 148114b4164SWarner Losh sc->dev = dev; 149114b4164SWarner Losh MMCSD_LOCK_INIT(sc); 150114b4164SWarner Losh 151a0075e58SWarner Losh d = sc->disk = disk_alloc(); 152a0075e58SWarner Losh d->d_open = mmcsd_open; 153a0075e58SWarner Losh d->d_close = mmcsd_close; 154a0075e58SWarner Losh d->d_strategy = mmcsd_strategy; 155a1fda318SAlexander Motin d->d_dump = mmcsd_dump; 156a0075e58SWarner Losh d->d_name = "mmcsd"; 157a0075e58SWarner Losh d->d_drv1 = sc; 1583906d42dSAlexander Motin d->d_maxsize = 4*1024*1024; /* Maximum defined SD card AU size. */ 159a0075e58SWarner Losh d->d_sectorsize = mmc_get_sector_size(dev); 1601f89a4dcSAlexander Motin d->d_mediasize = (off_t)mmc_get_media_size(dev) * d->d_sectorsize; 1612262a519SAlexander Motin d->d_stripeoffset = 0; 1622262a519SAlexander Motin d->d_stripesize = mmc_get_erase_sector(dev) * d->d_sectorsize; 163a0075e58SWarner Losh d->d_unit = device_get_unit(dev); 1643906d42dSAlexander Motin d->d_flags = DISKFLAG_CANDELETE; 165c96e8c32SWarner Losh d->d_delmaxsize = mmc_get_erase_sector(dev) * d->d_sectorsize * 1; /* conservative */ 166a0075e58SWarner Losh /* 1678fa3a540SWarner Losh * Display in most natural units. There's no cards < 1MB. The SD 1688fa3a540SWarner Losh * standard goes to 2GiB due to its reliance on FAT, but the data 1698fa3a540SWarner Losh * format supports up to 4GiB and some card makers push it up to this 1708fa3a540SWarner Losh * limit. The SDHC standard only goes to 32GiB due to FAT32, but the 1718fa3a540SWarner Losh * data format supports up to 2TiB however. 2048GB isn't too ugly, so 1728fa3a540SWarner Losh * we note it in passing here and don't add the code to print 1738fa3a540SWarner Losh * TB). Since these cards are sold in terms of MB and GB not MiB and 174c96e8c32SWarner Losh * GiB, report them like that. We also round to the nearest unit, since 175c96e8c32SWarner Losh * many cards are a few percent short, even of the power of 10 size. 176a0075e58SWarner Losh */ 177c96e8c32SWarner Losh mb = (d->d_mediasize + 1000000 / 2 - 1) / 1000000; 178a0075e58SWarner Losh unit = 'M'; 1798fa3a540SWarner Losh if (mb >= 1000) { 180a0075e58SWarner Losh unit = 'G'; 181c96e8c32SWarner Losh mb = (mb + 1000 / 2 - 1) / 1000; 182a0075e58SWarner Losh } 1837aa65846SMarius Strobl /* 1847aa65846SMarius Strobl * Report the clock speed of the underlying hardware, which might be 1857aa65846SMarius Strobl * different than what the card reports due to hardware limitations. 186bb1ef63fSWarner Losh * Report how many blocks the hardware transfers at once. 1877aa65846SMarius Strobl */ 1887aa65846SMarius Strobl speed = mmcbr_get_clock(device_get_parent(dev)); 1897aa65846SMarius Strobl maxblocks = mmc_get_max_data(dev); 1907aa65846SMarius Strobl device_printf(dev, "%ju%cB <%s>%s at %s %d.%01dMHz/%dbit/%d-block\n", 1917aa65846SMarius Strobl mb, unit, mmc_get_card_id_string(dev), 1920c0903b1SWarner Losh mmc_get_read_only(dev) ? " (read-only)" : "", 193a0075e58SWarner Losh device_get_nameunit(device_get_parent(dev)), 1947aa65846SMarius Strobl speed / 1000000, (speed / 100000) % 10, 1957aa65846SMarius Strobl mmcsd_bus_bit_width(dev), maxblocks); 196a0075e58SWarner Losh disk_create(d, DISK_VERSION); 197114b4164SWarner Losh bioq_init(&sc->bio_queue); 1980e1466acSWarner Losh 1990e1466acSWarner Losh sc->running = 1; 200eb67f31aSAlexander Motin sc->suspend = 0; 201a7cf6274SAlexander Motin sc->eblock = sc->eend = 0; 20288e07d92SRui Paulo kproc_create(&mmcsd_task, sc, &sc->p, 0, 0, "%s: mmc/sd card", 20388e07d92SRui Paulo device_get_nameunit(dev)); 204114b4164SWarner Losh 205114b4164SWarner Losh return (0); 206114b4164SWarner Losh } 207114b4164SWarner Losh 208114b4164SWarner Losh static int 209114b4164SWarner Losh mmcsd_detach(device_t dev) 210114b4164SWarner Losh { 2110e1466acSWarner Losh struct mmcsd_softc *sc = device_get_softc(dev); 2120e1466acSWarner Losh 2130e1466acSWarner Losh MMCSD_LOCK(sc); 214eb67f31aSAlexander Motin sc->suspend = 0; 215eb67f31aSAlexander Motin if (sc->running > 0) { 216eb67f31aSAlexander Motin /* kill thread */ 2170e1466acSWarner Losh sc->running = 0; 2180e1466acSWarner Losh wakeup(sc); 219eb67f31aSAlexander Motin /* wait for thread to finish. */ 2200e1466acSWarner Losh while (sc->running != -1) 221eb67f31aSAlexander Motin msleep(sc, &sc->sc_mtx, 0, "detach", 0); 222eb67f31aSAlexander Motin } 2230e1466acSWarner Losh MMCSD_UNLOCK(sc); 2240e1466acSWarner Losh 225249b0e85SAlexander Motin /* Flush the request queue. */ 226249b0e85SAlexander Motin bioq_flush(&sc->bio_queue, NULL, ENXIO); 2270e1466acSWarner Losh /* kill disk */ 2280e1466acSWarner Losh disk_destroy(sc->disk); 2290e1466acSWarner Losh 2300e1466acSWarner Losh MMCSD_LOCK_DESTROY(sc); 2310e1466acSWarner Losh 232128d0ff2SWarner Losh return (0); 233114b4164SWarner Losh } 234114b4164SWarner Losh 235114b4164SWarner Losh static int 236eb67f31aSAlexander Motin mmcsd_suspend(device_t dev) 237eb67f31aSAlexander Motin { 238eb67f31aSAlexander Motin struct mmcsd_softc *sc = device_get_softc(dev); 239eb67f31aSAlexander Motin 240eb67f31aSAlexander Motin MMCSD_LOCK(sc); 241eb67f31aSAlexander Motin sc->suspend = 1; 242eb67f31aSAlexander Motin if (sc->running > 0) { 243eb67f31aSAlexander Motin /* kill thread */ 244eb67f31aSAlexander Motin sc->running = 0; 245eb67f31aSAlexander Motin wakeup(sc); 246eb67f31aSAlexander Motin /* wait for thread to finish. */ 247eb67f31aSAlexander Motin while (sc->running != -1) 248eb67f31aSAlexander Motin msleep(sc, &sc->sc_mtx, 0, "detach", 0); 249eb67f31aSAlexander Motin } 250eb67f31aSAlexander Motin MMCSD_UNLOCK(sc); 251eb67f31aSAlexander Motin return (0); 252eb67f31aSAlexander Motin } 253eb67f31aSAlexander Motin 254eb67f31aSAlexander Motin static int 255eb67f31aSAlexander Motin mmcsd_resume(device_t dev) 256eb67f31aSAlexander Motin { 257eb67f31aSAlexander Motin struct mmcsd_softc *sc = device_get_softc(dev); 258eb67f31aSAlexander Motin 259eb67f31aSAlexander Motin MMCSD_LOCK(sc); 260eb67f31aSAlexander Motin sc->suspend = 0; 261eb67f31aSAlexander Motin if (sc->running <= 0) { 262eb67f31aSAlexander Motin sc->running = 1; 263eb67f31aSAlexander Motin MMCSD_UNLOCK(sc); 26488e07d92SRui Paulo kproc_create(&mmcsd_task, sc, &sc->p, 0, 0, "%s: mmc/sd card", 26588e07d92SRui Paulo device_get_nameunit(dev)); 266eb67f31aSAlexander Motin } else 267eb67f31aSAlexander Motin MMCSD_UNLOCK(sc); 268eb67f31aSAlexander Motin return (0); 269eb67f31aSAlexander Motin } 270eb67f31aSAlexander Motin 271eb67f31aSAlexander Motin static int 272114b4164SWarner Losh mmcsd_open(struct disk *dp) 273114b4164SWarner Losh { 274ae5d8757SMarius Strobl 275128d0ff2SWarner Losh return (0); 276114b4164SWarner Losh } 277114b4164SWarner Losh 278114b4164SWarner Losh static int 279114b4164SWarner Losh mmcsd_close(struct disk *dp) 280114b4164SWarner Losh { 281ae5d8757SMarius Strobl 282128d0ff2SWarner Losh return (0); 283114b4164SWarner Losh } 284114b4164SWarner Losh 285114b4164SWarner Losh static void 286114b4164SWarner Losh mmcsd_strategy(struct bio *bp) 287114b4164SWarner Losh { 288114b4164SWarner Losh struct mmcsd_softc *sc; 289114b4164SWarner Losh 290114b4164SWarner Losh sc = (struct mmcsd_softc *)bp->bio_disk->d_drv1; 291114b4164SWarner Losh MMCSD_LOCK(sc); 292eb67f31aSAlexander Motin if (sc->running > 0 || sc->suspend > 0) { 293114b4164SWarner Losh bioq_disksort(&sc->bio_queue, bp); 294114b4164SWarner Losh MMCSD_UNLOCK(sc); 295eb67f31aSAlexander Motin wakeup(sc); 296249b0e85SAlexander Motin } else { 297249b0e85SAlexander Motin MMCSD_UNLOCK(sc); 298249b0e85SAlexander Motin biofinish(bp, NULL, ENXIO); 299249b0e85SAlexander Motin } 300114b4164SWarner Losh } 301114b4164SWarner Losh 302bb1ef63fSWarner Losh static const char * 303bb1ef63fSWarner Losh mmcsd_errmsg(int e) 304bb1ef63fSWarner Losh { 305bb1ef63fSWarner Losh if (e < 0 || e > MMC_ERR_MAX) 306bb1ef63fSWarner Losh return "Bad error code"; 307bb1ef63fSWarner Losh return errmsg[e]; 308bb1ef63fSWarner Losh } 309bb1ef63fSWarner Losh 3103906d42dSAlexander Motin static daddr_t 3113906d42dSAlexander Motin mmcsd_rw(struct mmcsd_softc *sc, struct bio *bp) 312114b4164SWarner Losh { 313114b4164SWarner Losh daddr_t block, end; 314114b4164SWarner Losh struct mmc_command cmd; 315114b4164SWarner Losh struct mmc_command stop; 316114b4164SWarner Losh struct mmc_request req; 317114b4164SWarner Losh struct mmc_data data; 3183906d42dSAlexander Motin device_t dev = sc->dev; 3193906d42dSAlexander Motin int sz = sc->disk->d_sectorsize; 3208fa3a540SWarner Losh device_t mmcbr = device_get_parent(dev); 321114b4164SWarner Losh 3223906d42dSAlexander Motin block = bp->bio_pblkno; 323114b4164SWarner Losh end = bp->bio_pblkno + (bp->bio_bcount / sz); 3243906d42dSAlexander Motin while (block < end) { 3253906d42dSAlexander Motin char *vaddr = bp->bio_data + 3263906d42dSAlexander Motin (block - bp->bio_pblkno) * sz; 3273a4a2557SAlexander Motin int numblocks = min(end - block, mmc_get_max_data(dev)); 328114b4164SWarner Losh memset(&req, 0, sizeof(req)); 329114b4164SWarner Losh memset(&cmd, 0, sizeof(cmd)); 330114b4164SWarner Losh memset(&stop, 0, sizeof(stop)); 331a350e540SIan Lepore cmd.mrq = &req; 332114b4164SWarner Losh req.cmd = &cmd; 333114b4164SWarner Losh cmd.data = &data; 334114b4164SWarner Losh if (bp->bio_cmd == BIO_READ) { 3350c0903b1SWarner Losh if (numblocks > 1) 336114b4164SWarner Losh cmd.opcode = MMC_READ_MULTIPLE_BLOCK; 337114b4164SWarner Losh else 338114b4164SWarner Losh cmd.opcode = MMC_READ_SINGLE_BLOCK; 3390c0903b1SWarner Losh } else { 3400c0903b1SWarner Losh if (numblocks > 1) 3410c0903b1SWarner Losh cmd.opcode = MMC_WRITE_MULTIPLE_BLOCK; 3420c0903b1SWarner Losh else 343114b4164SWarner Losh cmd.opcode = MMC_WRITE_BLOCK; 3440c0903b1SWarner Losh } 345c18f1e26SAlexander Motin cmd.arg = block; 346c18f1e26SAlexander Motin if (!mmc_get_high_cap(dev)) 347c18f1e26SAlexander Motin cmd.arg <<= 9; 348114b4164SWarner Losh cmd.flags = MMC_RSP_R1 | MMC_CMD_ADTC; 349114b4164SWarner Losh data.data = vaddr; 350114b4164SWarner Losh data.mrq = &req; 3510c0903b1SWarner Losh if (bp->bio_cmd == BIO_READ) 352114b4164SWarner Losh data.flags = MMC_DATA_READ; 3530c0903b1SWarner Losh else 354114b4164SWarner Losh data.flags = MMC_DATA_WRITE; 3550c0903b1SWarner Losh data.len = numblocks * sz; 3560c0903b1SWarner Losh if (numblocks > 1) { 3570c0903b1SWarner Losh data.flags |= MMC_DATA_MULTI; 358114b4164SWarner Losh stop.opcode = MMC_STOP_TRANSMISSION; 359114b4164SWarner Losh stop.arg = 0; 360114b4164SWarner Losh stop.flags = MMC_RSP_R1B | MMC_CMD_AC; 361a350e540SIan Lepore stop.mrq = &req; 3620c0903b1SWarner Losh req.stop = &stop; 3630c0903b1SWarner Losh } 3648fa3a540SWarner Losh MMCBUS_WAIT_FOR_REQUEST(mmcbr, dev, &req); 365bb1ef63fSWarner Losh if (req.cmd->error != MMC_ERR_NONE) { 366bb1ef63fSWarner Losh device_printf(dev, "Error indicated: %d %s\n", 367bb1ef63fSWarner Losh req.cmd->error, mmcsd_errmsg(req.cmd->error)); 3680c0903b1SWarner Losh break; 369bb1ef63fSWarner Losh } 3700c0903b1SWarner Losh block += numblocks; 371114b4164SWarner Losh } 3723906d42dSAlexander Motin return (block); 3733906d42dSAlexander Motin } 3743906d42dSAlexander Motin 3753906d42dSAlexander Motin static daddr_t 3763906d42dSAlexander Motin mmcsd_delete(struct mmcsd_softc *sc, struct bio *bp) 3773906d42dSAlexander Motin { 3783906d42dSAlexander Motin daddr_t block, end, start, stop; 3793906d42dSAlexander Motin struct mmc_command cmd; 3803906d42dSAlexander Motin struct mmc_request req; 3813906d42dSAlexander Motin device_t dev = sc->dev; 3823906d42dSAlexander Motin int sz = sc->disk->d_sectorsize; 3833906d42dSAlexander Motin int erase_sector; 3848fa3a540SWarner Losh device_t mmcbr = device_get_parent(dev); 3853906d42dSAlexander Motin 3863906d42dSAlexander Motin block = bp->bio_pblkno; 3873906d42dSAlexander Motin end = bp->bio_pblkno + (bp->bio_bcount / sz); 388a7cf6274SAlexander Motin /* Coalesce with part remaining from previous request. */ 389a7cf6274SAlexander Motin if (block > sc->eblock && block <= sc->eend) 390a7cf6274SAlexander Motin block = sc->eblock; 391a7cf6274SAlexander Motin if (end >= sc->eblock && end < sc->eend) 392a7cf6274SAlexander Motin end = sc->eend; 3933906d42dSAlexander Motin /* Safe round to the erase sector boundaries. */ 3943906d42dSAlexander Motin erase_sector = mmc_get_erase_sector(dev); 3953906d42dSAlexander Motin start = block + erase_sector - 1; /* Round up. */ 3963906d42dSAlexander Motin start -= start % erase_sector; 3973906d42dSAlexander Motin stop = end; /* Round down. */ 3983906d42dSAlexander Motin stop -= end % erase_sector; 399a7cf6274SAlexander Motin /* We can't erase area smaller then sector, store it for later. */ 400a7cf6274SAlexander Motin if (start >= stop) { 401a7cf6274SAlexander Motin sc->eblock = block; 402a7cf6274SAlexander Motin sc->eend = end; 4033906d42dSAlexander Motin return (end); 404a7cf6274SAlexander Motin } 4053906d42dSAlexander Motin 4063906d42dSAlexander Motin /* Set erase start position. */ 4073906d42dSAlexander Motin memset(&req, 0, sizeof(req)); 4083906d42dSAlexander Motin memset(&cmd, 0, sizeof(cmd)); 409a350e540SIan Lepore cmd.mrq = &req; 4103906d42dSAlexander Motin req.cmd = &cmd; 4113906d42dSAlexander Motin if (mmc_get_card_type(dev) == mode_sd) 4123906d42dSAlexander Motin cmd.opcode = SD_ERASE_WR_BLK_START; 4133906d42dSAlexander Motin else 4143906d42dSAlexander Motin cmd.opcode = MMC_ERASE_GROUP_START; 4153906d42dSAlexander Motin cmd.arg = start; 4163906d42dSAlexander Motin if (!mmc_get_high_cap(dev)) 4173906d42dSAlexander Motin cmd.arg <<= 9; 4183906d42dSAlexander Motin cmd.flags = MMC_RSP_R1 | MMC_CMD_AC; 4198fa3a540SWarner Losh MMCBUS_WAIT_FOR_REQUEST(mmcbr, dev, &req); 4203906d42dSAlexander Motin if (req.cmd->error != MMC_ERR_NONE) { 4213906d42dSAlexander Motin printf("erase err1: %d\n", req.cmd->error); 4223906d42dSAlexander Motin return (block); 4233906d42dSAlexander Motin } 4243906d42dSAlexander Motin /* Set erase stop position. */ 4253906d42dSAlexander Motin memset(&req, 0, sizeof(req)); 4263906d42dSAlexander Motin memset(&cmd, 0, sizeof(cmd)); 4273906d42dSAlexander Motin req.cmd = &cmd; 4283906d42dSAlexander Motin if (mmc_get_card_type(dev) == mode_sd) 4293906d42dSAlexander Motin cmd.opcode = SD_ERASE_WR_BLK_END; 4303906d42dSAlexander Motin else 4313906d42dSAlexander Motin cmd.opcode = MMC_ERASE_GROUP_END; 4323906d42dSAlexander Motin cmd.arg = stop; 4333906d42dSAlexander Motin if (!mmc_get_high_cap(dev)) 4343906d42dSAlexander Motin cmd.arg <<= 9; 4353906d42dSAlexander Motin cmd.arg--; 4363906d42dSAlexander Motin cmd.flags = MMC_RSP_R1 | MMC_CMD_AC; 4378fa3a540SWarner Losh MMCBUS_WAIT_FOR_REQUEST(mmcbr, dev, &req); 4383906d42dSAlexander Motin if (req.cmd->error != MMC_ERR_NONE) { 4393906d42dSAlexander Motin printf("erase err2: %d\n", req.cmd->error); 4403906d42dSAlexander Motin return (block); 4413906d42dSAlexander Motin } 4423906d42dSAlexander Motin /* Erase range. */ 4433906d42dSAlexander Motin memset(&req, 0, sizeof(req)); 4443906d42dSAlexander Motin memset(&cmd, 0, sizeof(cmd)); 4453906d42dSAlexander Motin req.cmd = &cmd; 4463906d42dSAlexander Motin cmd.opcode = MMC_ERASE; 4473906d42dSAlexander Motin cmd.arg = 0; 4483906d42dSAlexander Motin cmd.flags = MMC_RSP_R1B | MMC_CMD_AC; 4498fa3a540SWarner Losh MMCBUS_WAIT_FOR_REQUEST(mmcbr, dev, &req); 4503906d42dSAlexander Motin if (req.cmd->error != MMC_ERR_NONE) { 4513906d42dSAlexander Motin printf("erase err3 %d\n", req.cmd->error); 4523906d42dSAlexander Motin return (block); 4533906d42dSAlexander Motin } 454a7cf6274SAlexander Motin /* Store one of remaining parts for the next call. */ 455a7cf6274SAlexander Motin if (bp->bio_pblkno >= sc->eblock || block == start) { 456a7cf6274SAlexander Motin sc->eblock = stop; /* Predict next forward. */ 457a7cf6274SAlexander Motin sc->eend = end; 458a7cf6274SAlexander Motin } else { 459a7cf6274SAlexander Motin sc->eblock = block; /* Predict next backward. */ 460a7cf6274SAlexander Motin sc->eend = start; 461a7cf6274SAlexander Motin } 4623906d42dSAlexander Motin return (end); 4633906d42dSAlexander Motin } 4643906d42dSAlexander Motin 465a1fda318SAlexander Motin static int 466a1fda318SAlexander Motin mmcsd_dump(void *arg, void *virtual, vm_offset_t physical, 467a1fda318SAlexander Motin off_t offset, size_t length) 468a1fda318SAlexander Motin { 469a1fda318SAlexander Motin struct disk *disk = arg; 470a1fda318SAlexander Motin struct mmcsd_softc *sc = (struct mmcsd_softc *)disk->d_drv1; 471a1fda318SAlexander Motin device_t dev = sc->dev; 472a1fda318SAlexander Motin struct bio bp; 473a1fda318SAlexander Motin daddr_t block, end; 4748fa3a540SWarner Losh device_t mmcbr = device_get_parent(dev); 475a1fda318SAlexander Motin 476a1fda318SAlexander Motin /* length zero is special and really means flush buffers to media */ 477a1fda318SAlexander Motin if (!length) 478a1fda318SAlexander Motin return (0); 479a1fda318SAlexander Motin 480a1fda318SAlexander Motin bzero(&bp, sizeof(struct bio)); 481a1fda318SAlexander Motin bp.bio_disk = disk; 482a1fda318SAlexander Motin bp.bio_pblkno = offset / disk->d_sectorsize; 483a1fda318SAlexander Motin bp.bio_bcount = length; 484a1fda318SAlexander Motin bp.bio_data = virtual; 485a1fda318SAlexander Motin bp.bio_cmd = BIO_WRITE; 486a1fda318SAlexander Motin end = bp.bio_pblkno + bp.bio_bcount / sc->disk->d_sectorsize; 4878fa3a540SWarner Losh MMCBUS_ACQUIRE_BUS(mmcbr, dev); 488a1fda318SAlexander Motin block = mmcsd_rw(sc, &bp); 4898fa3a540SWarner Losh MMCBUS_RELEASE_BUS(mmcbr, dev); 490a1fda318SAlexander Motin return ((end < block) ? EIO : 0); 491a1fda318SAlexander Motin } 492a1fda318SAlexander Motin 4933906d42dSAlexander Motin static void 4943906d42dSAlexander Motin mmcsd_task(void *arg) 4953906d42dSAlexander Motin { 4963906d42dSAlexander Motin struct mmcsd_softc *sc = (struct mmcsd_softc*)arg; 4973906d42dSAlexander Motin struct bio *bp; 4983906d42dSAlexander Motin int sz; 4993906d42dSAlexander Motin daddr_t block, end; 5008fa3a540SWarner Losh device_t dev = sc->dev; 5018fa3a540SWarner Losh device_t mmcbr = device_get_parent(sc->dev); 5023906d42dSAlexander Motin 503249b0e85SAlexander Motin while (1) { 5043906d42dSAlexander Motin MMCSD_LOCK(sc); 5053906d42dSAlexander Motin do { 506249b0e85SAlexander Motin if (sc->running == 0) 507249b0e85SAlexander Motin goto out; 508249b0e85SAlexander Motin bp = bioq_takefirst(&sc->bio_queue); 5093906d42dSAlexander Motin if (bp == NULL) 5103906d42dSAlexander Motin msleep(sc, &sc->sc_mtx, PRIBIO, "jobqueue", 0); 511249b0e85SAlexander Motin } while (bp == NULL); 5123906d42dSAlexander Motin MMCSD_UNLOCK(sc); 5133906d42dSAlexander Motin if (bp->bio_cmd != BIO_READ && mmc_get_read_only(dev)) { 5143906d42dSAlexander Motin bp->bio_error = EROFS; 5153906d42dSAlexander Motin bp->bio_resid = bp->bio_bcount; 5163906d42dSAlexander Motin bp->bio_flags |= BIO_ERROR; 5173906d42dSAlexander Motin biodone(bp); 5183906d42dSAlexander Motin continue; 5193906d42dSAlexander Motin } 5208fa3a540SWarner Losh MMCBUS_ACQUIRE_BUS(mmcbr, dev); 5213906d42dSAlexander Motin sz = sc->disk->d_sectorsize; 5223906d42dSAlexander Motin block = bp->bio_pblkno; 5233906d42dSAlexander Motin end = bp->bio_pblkno + (bp->bio_bcount / sz); 5243906d42dSAlexander Motin if (bp->bio_cmd == BIO_READ || bp->bio_cmd == BIO_WRITE) { 525a7cf6274SAlexander Motin /* Access to the remaining erase block obsoletes it. */ 526a7cf6274SAlexander Motin if (block < sc->eend && end > sc->eblock) 527a7cf6274SAlexander Motin sc->eblock = sc->eend = 0; 5283906d42dSAlexander Motin block = mmcsd_rw(sc, bp); 5293906d42dSAlexander Motin } else if (bp->bio_cmd == BIO_DELETE) { 5303906d42dSAlexander Motin block = mmcsd_delete(sc, bp); 5313906d42dSAlexander Motin } 5328fa3a540SWarner Losh MMCBUS_RELEASE_BUS(mmcbr, dev); 5330c0903b1SWarner Losh if (block < end) { 5340c0903b1SWarner Losh bp->bio_error = EIO; 5350c0903b1SWarner Losh bp->bio_resid = (end - block) * sz; 5360c0903b1SWarner Losh bp->bio_flags |= BIO_ERROR; 5370c0903b1SWarner Losh } 538114b4164SWarner Losh biodone(bp); 539114b4164SWarner Losh } 540249b0e85SAlexander Motin out: 5410e1466acSWarner Losh /* tell parent we're done */ 5420e1466acSWarner Losh sc->running = -1; 5430e1466acSWarner Losh MMCSD_UNLOCK(sc); 544eb67f31aSAlexander Motin wakeup(sc); 5450e1466acSWarner Losh 5463745c395SJulian Elischer kproc_exit(0); 547114b4164SWarner Losh } 548114b4164SWarner Losh 549a0075e58SWarner Losh static int 550a0075e58SWarner Losh mmcsd_bus_bit_width(device_t dev) 551a0075e58SWarner Losh { 552ae5d8757SMarius Strobl 553a0075e58SWarner Losh if (mmc_get_bus_width(dev) == bus_width_1) 554a0075e58SWarner Losh return (1); 555a0075e58SWarner Losh if (mmc_get_bus_width(dev) == bus_width_4) 556a0075e58SWarner Losh return (4); 557a0075e58SWarner Losh return (8); 558a0075e58SWarner Losh } 559a0075e58SWarner Losh 560114b4164SWarner Losh static device_method_t mmcsd_methods[] = { 561114b4164SWarner Losh DEVMETHOD(device_probe, mmcsd_probe), 562114b4164SWarner Losh DEVMETHOD(device_attach, mmcsd_attach), 563114b4164SWarner Losh DEVMETHOD(device_detach, mmcsd_detach), 564eb67f31aSAlexander Motin DEVMETHOD(device_suspend, mmcsd_suspend), 565eb67f31aSAlexander Motin DEVMETHOD(device_resume, mmcsd_resume), 5667aa65846SMarius Strobl DEVMETHOD_END 567114b4164SWarner Losh }; 568114b4164SWarner Losh 569114b4164SWarner Losh static driver_t mmcsd_driver = { 570114b4164SWarner Losh "mmcsd", 571114b4164SWarner Losh mmcsd_methods, 572114b4164SWarner Losh sizeof(struct mmcsd_softc), 573114b4164SWarner Losh }; 574114b4164SWarner Losh static devclass_t mmcsd_devclass; 575114b4164SWarner Losh 5767aa65846SMarius Strobl DRIVER_MODULE(mmcsd, mmc, mmcsd_driver, mmcsd_devclass, NULL, NULL); 577