1cd5bdf03SOleksandr Tymoshenko /*- 2718cf2ccSPedro F. Giffuni * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 3718cf2ccSPedro F. Giffuni * 4cd5bdf03SOleksandr Tymoshenko * Copyright (c) 2006 M. Warner Losh. All rights reserved. 5cd5bdf03SOleksandr Tymoshenko * Copyright (c) 2009 Oleksandr Tymoshenko. All rights reserved. 6cd5bdf03SOleksandr Tymoshenko * 7cd5bdf03SOleksandr Tymoshenko * Redistribution and use in source and binary forms, with or without 8cd5bdf03SOleksandr Tymoshenko * modification, are permitted provided that the following conditions 9cd5bdf03SOleksandr Tymoshenko * are met: 10cd5bdf03SOleksandr Tymoshenko * 1. Redistributions of source code must retain the above copyright 11cd5bdf03SOleksandr Tymoshenko * notice, this list of conditions and the following disclaimer. 12cd5bdf03SOleksandr Tymoshenko * 2. Redistributions in binary form must reproduce the above copyright 13cd5bdf03SOleksandr Tymoshenko * notice, this list of conditions and the following disclaimer in the 14cd5bdf03SOleksandr Tymoshenko * documentation and/or other materials provided with the distribution. 15cd5bdf03SOleksandr Tymoshenko * 16cd5bdf03SOleksandr Tymoshenko * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17cd5bdf03SOleksandr Tymoshenko * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18cd5bdf03SOleksandr Tymoshenko * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19cd5bdf03SOleksandr Tymoshenko * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 20cd5bdf03SOleksandr Tymoshenko * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 21cd5bdf03SOleksandr Tymoshenko * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 22cd5bdf03SOleksandr Tymoshenko * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 23cd5bdf03SOleksandr Tymoshenko * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 24cd5bdf03SOleksandr Tymoshenko * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 25cd5bdf03SOleksandr Tymoshenko * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 26cd5bdf03SOleksandr Tymoshenko */ 27cd5bdf03SOleksandr Tymoshenko 28cd5bdf03SOleksandr Tymoshenko #include <sys/cdefs.h> 29cd5bdf03SOleksandr Tymoshenko __FBSDID("$FreeBSD$"); 30cd5bdf03SOleksandr Tymoshenko 318f74c88aSLuiz Otavio O Souza #include "opt_platform.h" 328f74c88aSLuiz Otavio O Souza 33cd5bdf03SOleksandr Tymoshenko #include <sys/param.h> 34cd5bdf03SOleksandr Tymoshenko #include <sys/systm.h> 35cd5bdf03SOleksandr Tymoshenko #include <sys/bio.h> 36cd5bdf03SOleksandr Tymoshenko #include <sys/bus.h> 37cd5bdf03SOleksandr Tymoshenko #include <sys/conf.h> 38cd5bdf03SOleksandr Tymoshenko #include <sys/kernel.h> 39cd5bdf03SOleksandr Tymoshenko #include <sys/kthread.h> 40cd5bdf03SOleksandr Tymoshenko #include <sys/lock.h> 41cd5bdf03SOleksandr Tymoshenko #include <sys/mbuf.h> 42cd5bdf03SOleksandr Tymoshenko #include <sys/malloc.h> 43cd5bdf03SOleksandr Tymoshenko #include <sys/module.h> 44cd5bdf03SOleksandr Tymoshenko #include <sys/mutex.h> 45cd5bdf03SOleksandr Tymoshenko #include <geom/geom_disk.h> 46cd5bdf03SOleksandr Tymoshenko 478f74c88aSLuiz Otavio O Souza #ifdef FDT 488f74c88aSLuiz Otavio O Souza #include <dev/fdt/fdt_common.h> 498f74c88aSLuiz Otavio O Souza #include <dev/ofw/ofw_bus_subr.h> 508f74c88aSLuiz Otavio O Souza #include <dev/ofw/openfirm.h> 518f74c88aSLuiz Otavio O Souza #endif 528f74c88aSLuiz Otavio O Souza 53cd5bdf03SOleksandr Tymoshenko #include <dev/spibus/spi.h> 54cd5bdf03SOleksandr Tymoshenko #include "spibus_if.h" 55cd5bdf03SOleksandr Tymoshenko 56cd5bdf03SOleksandr Tymoshenko #include <dev/flash/mx25lreg.h> 57cd5bdf03SOleksandr Tymoshenko 58d2cf1fd5SAdrian Chadd #define FL_NONE 0x00 59d2cf1fd5SAdrian Chadd #define FL_ERASE_4K 0x01 60d2cf1fd5SAdrian Chadd #define FL_ERASE_32K 0x02 612d46b036SStanislav Galabov #define FL_ENABLE_4B_ADDR 0x04 622d46b036SStanislav Galabov #define FL_DISABLE_4B_ADDR 0x08 63d2cf1fd5SAdrian Chadd 64917721a4SAdrian Chadd /* 65917721a4SAdrian Chadd * Define the sectorsize to be a smaller size rather than the flash 66917721a4SAdrian Chadd * sector size. Trying to run FFS off of a 64k flash sector size 67917721a4SAdrian Chadd * results in a completely un-usable system. 68917721a4SAdrian Chadd */ 69917721a4SAdrian Chadd #define MX25L_SECTORSIZE 512 70917721a4SAdrian Chadd 71cd5bdf03SOleksandr Tymoshenko struct mx25l_flash_ident 72cd5bdf03SOleksandr Tymoshenko { 73cd5bdf03SOleksandr Tymoshenko const char *name; 74cd5bdf03SOleksandr Tymoshenko uint8_t manufacturer_id; 75cd5bdf03SOleksandr Tymoshenko uint16_t device_id; 76cd5bdf03SOleksandr Tymoshenko unsigned int sectorsize; 77cd5bdf03SOleksandr Tymoshenko unsigned int sectorcount; 78d2cf1fd5SAdrian Chadd unsigned int flags; 79cd5bdf03SOleksandr Tymoshenko }; 80cd5bdf03SOleksandr Tymoshenko 81cd5bdf03SOleksandr Tymoshenko struct mx25l_softc 82cd5bdf03SOleksandr Tymoshenko { 83cd5bdf03SOleksandr Tymoshenko device_t sc_dev; 8489a1585bSIan Lepore device_t sc_parent; 85cd5bdf03SOleksandr Tymoshenko uint8_t sc_manufacturer_id; 86cd5bdf03SOleksandr Tymoshenko uint16_t sc_device_id; 87b3918833SOleksandr Tymoshenko unsigned int sc_sectorsize; 88cd5bdf03SOleksandr Tymoshenko struct mtx sc_mtx; 89cd5bdf03SOleksandr Tymoshenko struct disk *sc_disk; 90cd5bdf03SOleksandr Tymoshenko struct proc *sc_p; 91cd5bdf03SOleksandr Tymoshenko struct bio_queue_head sc_bio_queue; 9262c3a412SAdrian Chadd unsigned int sc_flags; 93aae18dccSIan Lepore unsigned int sc_taskstate; 94dac94adbSIan Lepore uint8_t sc_dummybuf[FLASH_PAGE_SIZE]; 95cd5bdf03SOleksandr Tymoshenko }; 96cd5bdf03SOleksandr Tymoshenko 97aae18dccSIan Lepore #define TSTATE_STOPPED 0 98aae18dccSIan Lepore #define TSTATE_STOPPING 1 99aae18dccSIan Lepore #define TSTATE_RUNNING 2 100aae18dccSIan Lepore 101cd5bdf03SOleksandr Tymoshenko #define M25PXX_LOCK(_sc) mtx_lock(&(_sc)->sc_mtx) 102cd5bdf03SOleksandr Tymoshenko #define M25PXX_UNLOCK(_sc) mtx_unlock(&(_sc)->sc_mtx) 103cd5bdf03SOleksandr Tymoshenko #define M25PXX_LOCK_INIT(_sc) \ 104cd5bdf03SOleksandr Tymoshenko mtx_init(&_sc->sc_mtx, device_get_nameunit(_sc->sc_dev), \ 105cd5bdf03SOleksandr Tymoshenko "mx25l", MTX_DEF) 106cd5bdf03SOleksandr Tymoshenko #define M25PXX_LOCK_DESTROY(_sc) mtx_destroy(&_sc->sc_mtx); 107cd5bdf03SOleksandr Tymoshenko #define M25PXX_ASSERT_LOCKED(_sc) mtx_assert(&_sc->sc_mtx, MA_OWNED); 108cd5bdf03SOleksandr Tymoshenko #define M25PXX_ASSERT_UNLOCKED(_sc) mtx_assert(&_sc->sc_mtx, MA_NOTOWNED); 109cd5bdf03SOleksandr Tymoshenko 110cd5bdf03SOleksandr Tymoshenko /* disk routines */ 111cd5bdf03SOleksandr Tymoshenko static int mx25l_open(struct disk *dp); 112cd5bdf03SOleksandr Tymoshenko static int mx25l_close(struct disk *dp); 113cd5bdf03SOleksandr Tymoshenko static int mx25l_ioctl(struct disk *, u_long, void *, int, struct thread *); 114cd5bdf03SOleksandr Tymoshenko static void mx25l_strategy(struct bio *bp); 1151b468038SAdrian Chadd static int mx25l_getattr(struct bio *bp); 116cd5bdf03SOleksandr Tymoshenko static void mx25l_task(void *arg); 117cd5bdf03SOleksandr Tymoshenko 118cd5bdf03SOleksandr Tymoshenko struct mx25l_flash_ident flash_devices[] = { 119869785b4SAleksandr Rybalko { "en25f32", 0x1c, 0x3116, 64 * 1024, 64, FL_NONE }, 120869785b4SAleksandr Rybalko { "en25p32", 0x1c, 0x2016, 64 * 1024, 64, FL_NONE }, 121869785b4SAleksandr Rybalko { "en25p64", 0x1c, 0x2017, 64 * 1024, 128, FL_NONE }, 1222f57841eSAdrian Chadd { "en25q32", 0x1c, 0x3016, 64 * 1024, 64, FL_NONE }, 123869785b4SAleksandr Rybalko { "en25q64", 0x1c, 0x3017, 64 * 1024, 128, FL_ERASE_4K }, 1242f57841eSAdrian Chadd { "m25p32", 0x20, 0x2016, 64 * 1024, 64, FL_NONE }, 125a565668bSAdrian Chadd { "m25p64", 0x20, 0x2017, 64 * 1024, 128, FL_NONE }, 126869785b4SAleksandr Rybalko { "mx25ll32", 0xc2, 0x2016, 64 * 1024, 64, FL_NONE }, 127d2cf1fd5SAdrian Chadd { "mx25ll64", 0xc2, 0x2017, 64 * 1024, 128, FL_NONE }, 128d2cf1fd5SAdrian Chadd { "mx25ll128", 0xc2, 0x2018, 64 * 1024, 256, FL_ERASE_4K | FL_ERASE_32K }, 1292d46b036SStanislav Galabov { "mx25ll256", 0xc2, 0x2019, 64 * 1024, 512, FL_ERASE_4K | FL_ERASE_32K | FL_ENABLE_4B_ADDR }, 130c6905524SLuiz Otavio O Souza { "s25fl032", 0x01, 0x0215, 64 * 1024, 64, FL_NONE }, 131c6905524SLuiz Otavio O Souza { "s25fl064", 0x01, 0x0216, 64 * 1024, 128, FL_NONE }, 132d2cf1fd5SAdrian Chadd { "s25fl128", 0x01, 0x2018, 64 * 1024, 256, FL_NONE }, 1334a4ae982SAdrian Chadd { "s25fl256s", 0x01, 0x0219, 64 * 1024, 512, FL_NONE }, 134fa68dcb1SJustin Hibbits { "SST25VF010A", 0xbf, 0x2549, 4 * 1024, 32, FL_ERASE_4K | FL_ERASE_32K }, 135869785b4SAleksandr Rybalko { "SST25VF032B", 0xbf, 0x254a, 64 * 1024, 64, FL_ERASE_4K | FL_ERASE_32K }, 13670234acbSAdrian Chadd 13770234acbSAdrian Chadd /* Winbond -- w25x "blocks" are 64K, "sectors" are 4KiB */ 13870234acbSAdrian Chadd { "w25x32", 0xef, 0x3016, 64 * 1024, 64, FL_ERASE_4K }, 13940424a25SAdrian Chadd { "w25x64", 0xef, 0x3017, 64 * 1024, 128, FL_ERASE_4K }, 140869785b4SAleksandr Rybalko { "w25q32", 0xef, 0x4016, 64 * 1024, 64, FL_ERASE_4K }, 141869785b4SAleksandr Rybalko { "w25q64", 0xef, 0x4017, 64 * 1024, 128, FL_ERASE_4K }, 142450a186cSAdrian Chadd { "w25q64bv", 0xef, 0x4017, 64 * 1024, 128, FL_ERASE_4K }, 14370234acbSAdrian Chadd { "w25q128", 0xef, 0x4018, 64 * 1024, 256, FL_ERASE_4K }, 14470234acbSAdrian Chadd { "w25q256", 0xef, 0x4019, 64 * 1024, 512, FL_ERASE_4K }, 145fe56b741SBaptiste Daroussin 146fe56b741SBaptiste Daroussin /* Atmel */ 147fe56b741SBaptiste Daroussin { "at25df641", 0x1f, 0x4800, 64 * 1024, 128, FL_ERASE_4K }, 148303c3562SAdrian Chadd 149303c3562SAdrian Chadd /* GigaDevice */ 150303c3562SAdrian Chadd { "gd25q64", 0xc8, 0x4017, 64 * 1024, 128, FL_ERASE_4K }, 151cd5bdf03SOleksandr Tymoshenko }; 152cd5bdf03SOleksandr Tymoshenko 153*c03ab159SIan Lepore static int 154*c03ab159SIan Lepore mx25l_wait_for_device_ready(struct mx25l_softc *sc) 155cd5bdf03SOleksandr Tymoshenko { 156cd5bdf03SOleksandr Tymoshenko uint8_t txBuf[2], rxBuf[2]; 157cd5bdf03SOleksandr Tymoshenko struct spi_command cmd; 158cd5bdf03SOleksandr Tymoshenko int err; 159cd5bdf03SOleksandr Tymoshenko 160cd5bdf03SOleksandr Tymoshenko memset(&cmd, 0, sizeof(cmd)); 161cd5bdf03SOleksandr Tymoshenko 162*c03ab159SIan Lepore do { 163cd5bdf03SOleksandr Tymoshenko txBuf[0] = CMD_READ_STATUS; 164cd5bdf03SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 165cd5bdf03SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 166cd5bdf03SOleksandr Tymoshenko cmd.rx_cmd_sz = 2; 167cd5bdf03SOleksandr Tymoshenko cmd.tx_cmd_sz = 2; 16889a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 169*c03ab159SIan Lepore } while (err == 0 && (rxBuf[1] & STATUS_WIP)); 170cd5bdf03SOleksandr Tymoshenko 171*c03ab159SIan Lepore return (err); 172cd5bdf03SOleksandr Tymoshenko } 173cd5bdf03SOleksandr Tymoshenko 174cd5bdf03SOleksandr Tymoshenko static struct mx25l_flash_ident* 175cd5bdf03SOleksandr Tymoshenko mx25l_get_device_ident(struct mx25l_softc *sc) 176cd5bdf03SOleksandr Tymoshenko { 177cd5bdf03SOleksandr Tymoshenko uint8_t txBuf[8], rxBuf[8]; 178cd5bdf03SOleksandr Tymoshenko struct spi_command cmd; 179cd5bdf03SOleksandr Tymoshenko uint8_t manufacturer_id; 180cd5bdf03SOleksandr Tymoshenko uint16_t dev_id; 181cd5bdf03SOleksandr Tymoshenko int err, i; 182cd5bdf03SOleksandr Tymoshenko 183cd5bdf03SOleksandr Tymoshenko memset(&cmd, 0, sizeof(cmd)); 184cd5bdf03SOleksandr Tymoshenko memset(txBuf, 0, sizeof(txBuf)); 185cd5bdf03SOleksandr Tymoshenko memset(rxBuf, 0, sizeof(rxBuf)); 186cd5bdf03SOleksandr Tymoshenko 187cd5bdf03SOleksandr Tymoshenko txBuf[0] = CMD_READ_IDENT; 188cd5bdf03SOleksandr Tymoshenko cmd.tx_cmd = &txBuf; 189cd5bdf03SOleksandr Tymoshenko cmd.rx_cmd = &rxBuf; 190cd5bdf03SOleksandr Tymoshenko /* 191cd5bdf03SOleksandr Tymoshenko * Some compatible devices has extended two-bytes ID 192cd5bdf03SOleksandr Tymoshenko * We'll use only manufacturer/deviceid atm 193cd5bdf03SOleksandr Tymoshenko */ 194cd5bdf03SOleksandr Tymoshenko cmd.tx_cmd_sz = 4; 195cd5bdf03SOleksandr Tymoshenko cmd.rx_cmd_sz = 4; 19689a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 197cd5bdf03SOleksandr Tymoshenko if (err) 198cd5bdf03SOleksandr Tymoshenko return (NULL); 199cd5bdf03SOleksandr Tymoshenko 200cd5bdf03SOleksandr Tymoshenko manufacturer_id = rxBuf[1]; 201cd5bdf03SOleksandr Tymoshenko dev_id = (rxBuf[2] << 8) | (rxBuf[3]); 202cd5bdf03SOleksandr Tymoshenko 203*c03ab159SIan Lepore for (i = 0; i < nitems(flash_devices); i++) { 204cd5bdf03SOleksandr Tymoshenko if ((flash_devices[i].manufacturer_id == manufacturer_id) && 205cd5bdf03SOleksandr Tymoshenko (flash_devices[i].device_id == dev_id)) 206cd5bdf03SOleksandr Tymoshenko return &flash_devices[i]; 207cd5bdf03SOleksandr Tymoshenko } 208cd5bdf03SOleksandr Tymoshenko 20989a1585bSIan Lepore device_printf(sc->sc_dev, 21089a1585bSIan Lepore "Unknown SPI flash device. Vendor: %02x, device id: %04x\n", 211cd5bdf03SOleksandr Tymoshenko manufacturer_id, dev_id); 212cd5bdf03SOleksandr Tymoshenko return (NULL); 213cd5bdf03SOleksandr Tymoshenko } 214cd5bdf03SOleksandr Tymoshenko 215*c03ab159SIan Lepore static int 21689a1585bSIan Lepore mx25l_set_writable(struct mx25l_softc *sc, int writable) 217c3655ab0SOleksandr Tymoshenko { 218c3655ab0SOleksandr Tymoshenko uint8_t txBuf[1], rxBuf[1]; 219c3655ab0SOleksandr Tymoshenko struct spi_command cmd; 220c3655ab0SOleksandr Tymoshenko int err; 221c3655ab0SOleksandr Tymoshenko 222c3655ab0SOleksandr Tymoshenko memset(&cmd, 0, sizeof(cmd)); 223c3655ab0SOleksandr Tymoshenko memset(txBuf, 0, sizeof(txBuf)); 224c3655ab0SOleksandr Tymoshenko memset(rxBuf, 0, sizeof(rxBuf)); 225c3655ab0SOleksandr Tymoshenko 226c3655ab0SOleksandr Tymoshenko txBuf[0] = writable ? CMD_WRITE_ENABLE : CMD_WRITE_DISABLE; 227c3655ab0SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 228c3655ab0SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 229c3655ab0SOleksandr Tymoshenko cmd.rx_cmd_sz = 1; 230c3655ab0SOleksandr Tymoshenko cmd.tx_cmd_sz = 1; 23189a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 232*c03ab159SIan Lepore return (err); 233c3655ab0SOleksandr Tymoshenko } 234c3655ab0SOleksandr Tymoshenko 235*c03ab159SIan Lepore static int 23689a1585bSIan Lepore mx25l_erase_cmd(struct mx25l_softc *sc, off_t sector, uint8_t ecmd) 237c3655ab0SOleksandr Tymoshenko { 2382d46b036SStanislav Galabov uint8_t txBuf[5], rxBuf[5]; 239c3655ab0SOleksandr Tymoshenko struct spi_command cmd; 240c3655ab0SOleksandr Tymoshenko int err; 241c3655ab0SOleksandr Tymoshenko 242*c03ab159SIan Lepore if ((err = mx25l_set_writable(sc, 1)) != 0) 243*c03ab159SIan Lepore return (err); 244c3655ab0SOleksandr Tymoshenko 245c3655ab0SOleksandr Tymoshenko memset(&cmd, 0, sizeof(cmd)); 246c3655ab0SOleksandr Tymoshenko memset(txBuf, 0, sizeof(txBuf)); 247c3655ab0SOleksandr Tymoshenko memset(rxBuf, 0, sizeof(rxBuf)); 248c3655ab0SOleksandr Tymoshenko 24953436aceSAdrian Chadd txBuf[0] = ecmd; 250c3655ab0SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 251c3655ab0SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 2522d46b036SStanislav Galabov if (sc->sc_flags & FL_ENABLE_4B_ADDR) { 2532d46b036SStanislav Galabov cmd.rx_cmd_sz = 5; 2542d46b036SStanislav Galabov cmd.tx_cmd_sz = 5; 2552d46b036SStanislav Galabov txBuf[1] = ((sector >> 24) & 0xff); 2562d46b036SStanislav Galabov txBuf[2] = ((sector >> 16) & 0xff); 2572d46b036SStanislav Galabov txBuf[3] = ((sector >> 8) & 0xff); 2582d46b036SStanislav Galabov txBuf[4] = (sector & 0xff); 2592d46b036SStanislav Galabov } else { 260c3655ab0SOleksandr Tymoshenko cmd.rx_cmd_sz = 4; 261c3655ab0SOleksandr Tymoshenko cmd.tx_cmd_sz = 4; 262c3655ab0SOleksandr Tymoshenko txBuf[1] = ((sector >> 16) & 0xff); 263c3655ab0SOleksandr Tymoshenko txBuf[2] = ((sector >> 8) & 0xff); 264c3655ab0SOleksandr Tymoshenko txBuf[3] = (sector & 0xff); 2652d46b036SStanislav Galabov } 266*c03ab159SIan Lepore if ((err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd)) != 0) 267*c03ab159SIan Lepore return (err); 268*c03ab159SIan Lepore err = mx25l_wait_for_device_ready(sc); 269*c03ab159SIan Lepore return (err); 270c3655ab0SOleksandr Tymoshenko } 271c3655ab0SOleksandr Tymoshenko 272cd5bdf03SOleksandr Tymoshenko static int 27389a1585bSIan Lepore mx25l_write(struct mx25l_softc *sc, off_t offset, caddr_t data, off_t count) 274b3918833SOleksandr Tymoshenko { 275b3918833SOleksandr Tymoshenko uint8_t txBuf[8], rxBuf[8]; 276b3918833SOleksandr Tymoshenko struct spi_command cmd; 27719aa9f71SIan Lepore off_t bytes_to_write; 278b3918833SOleksandr Tymoshenko int err = 0; 279b3918833SOleksandr Tymoshenko 2802d46b036SStanislav Galabov if (sc->sc_flags & FL_ENABLE_4B_ADDR) { 2812d46b036SStanislav Galabov cmd.tx_cmd_sz = 5; 2822d46b036SStanislav Galabov cmd.rx_cmd_sz = 5; 2832d46b036SStanislav Galabov } else { 284b3918833SOleksandr Tymoshenko cmd.tx_cmd_sz = 4; 285b3918833SOleksandr Tymoshenko cmd.rx_cmd_sz = 4; 2862d46b036SStanislav Galabov } 287b3918833SOleksandr Tymoshenko 288b3918833SOleksandr Tymoshenko /* 289f432eb7eSIan Lepore * Writes must be aligned to the erase sectorsize, since blocks are 290f432eb7eSIan Lepore * fully erased before they're written to. 291b3918833SOleksandr Tymoshenko */ 292917721a4SAdrian Chadd if (count % sc->sc_sectorsize != 0 || offset % sc->sc_sectorsize != 0) 293917721a4SAdrian Chadd return (EIO); 294b3918833SOleksandr Tymoshenko 295b3918833SOleksandr Tymoshenko /* 29619aa9f71SIan Lepore * Maximum write size for CMD_PAGE_PROGRAM is FLASH_PAGE_SIZE, so loop 29719aa9f71SIan Lepore * to write chunks of FLASH_PAGE_SIZE bytes each. 298b3918833SOleksandr Tymoshenko */ 29919aa9f71SIan Lepore while (count != 0) { 30019aa9f71SIan Lepore /* If we crossed a sector boundary, erase the next sector. */ 301*c03ab159SIan Lepore if (((offset) % sc->sc_sectorsize) == 0) { 302*c03ab159SIan Lepore err = mx25l_erase_cmd(sc, offset, CMD_SECTOR_ERASE); 303*c03ab159SIan Lepore if (err) 304*c03ab159SIan Lepore break; 305*c03ab159SIan Lepore } 306b3918833SOleksandr Tymoshenko 307b3918833SOleksandr Tymoshenko txBuf[0] = CMD_PAGE_PROGRAM; 3082d46b036SStanislav Galabov if (sc->sc_flags & FL_ENABLE_4B_ADDR) { 30919aa9f71SIan Lepore txBuf[1] = (offset >> 24) & 0xff; 31019aa9f71SIan Lepore txBuf[2] = (offset >> 16) & 0xff; 31119aa9f71SIan Lepore txBuf[3] = (offset >> 8) & 0xff; 31219aa9f71SIan Lepore txBuf[4] = offset & 0xff; 3132d46b036SStanislav Galabov } else { 31419aa9f71SIan Lepore txBuf[1] = (offset >> 16) & 0xff; 31519aa9f71SIan Lepore txBuf[2] = (offset >> 8) & 0xff; 31619aa9f71SIan Lepore txBuf[3] = offset & 0xff; 3172d46b036SStanislav Galabov } 318b3918833SOleksandr Tymoshenko 31919aa9f71SIan Lepore bytes_to_write = MIN(FLASH_PAGE_SIZE, count); 320b3918833SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 321b3918833SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 32219aa9f71SIan Lepore cmd.tx_data = data; 323dac94adbSIan Lepore cmd.rx_data = sc->sc_dummybuf; 32419aa9f71SIan Lepore cmd.tx_data_sz = (uint32_t)bytes_to_write; 32519aa9f71SIan Lepore cmd.rx_data_sz = (uint32_t)bytes_to_write; 326b3918833SOleksandr Tymoshenko 327b3918833SOleksandr Tymoshenko /* 32819aa9f71SIan Lepore * Each completed write operation resets WEL (write enable 32919aa9f71SIan Lepore * latch) to disabled state, so we re-enable it here. 330b3918833SOleksandr Tymoshenko */ 331*c03ab159SIan Lepore if ((err = mx25l_wait_for_device_ready(sc)) != 0) 332*c03ab159SIan Lepore break; 333*c03ab159SIan Lepore if ((err = mx25l_set_writable(sc, 1)) != 0) 334*c03ab159SIan Lepore break; 335b3918833SOleksandr Tymoshenko 33689a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 337*c03ab159SIan Lepore if (err != 0) 338*c03ab159SIan Lepore break; 339*c03ab159SIan Lepore err = mx25l_wait_for_device_ready(sc); 340b3918833SOleksandr Tymoshenko if (err) 341b3918833SOleksandr Tymoshenko break; 342b3918833SOleksandr Tymoshenko 34319aa9f71SIan Lepore data += bytes_to_write; 34419aa9f71SIan Lepore offset += bytes_to_write; 34519aa9f71SIan Lepore count -= bytes_to_write; 346b3918833SOleksandr Tymoshenko } 347b3918833SOleksandr Tymoshenko 348b3918833SOleksandr Tymoshenko return (err); 349b3918833SOleksandr Tymoshenko } 350b3918833SOleksandr Tymoshenko 351b3918833SOleksandr Tymoshenko static int 35289a1585bSIan Lepore mx25l_read(struct mx25l_softc *sc, off_t offset, caddr_t data, off_t count) 353b3918833SOleksandr Tymoshenko { 354b3918833SOleksandr Tymoshenko uint8_t txBuf[8], rxBuf[8]; 355b3918833SOleksandr Tymoshenko struct spi_command cmd; 356b3918833SOleksandr Tymoshenko int err = 0; 357b3918833SOleksandr Tymoshenko 358b3918833SOleksandr Tymoshenko /* 35919aa9f71SIan Lepore * Enforce that reads are aligned to the disk sectorsize, not the 36019aa9f71SIan Lepore * erase sectorsize. In this way, smaller read IO is possible, 36119aa9f71SIan Lepore * dramatically speeding up filesystem/geom_compress access. 362b3918833SOleksandr Tymoshenko */ 36319aa9f71SIan Lepore if (count % sc->sc_disk->d_sectorsize != 0 || 36419aa9f71SIan Lepore offset % sc->sc_disk->d_sectorsize != 0) 365917721a4SAdrian Chadd return (EIO); 366b3918833SOleksandr Tymoshenko 367b3918833SOleksandr Tymoshenko txBuf[0] = CMD_FAST_READ; 3682d46b036SStanislav Galabov if (sc->sc_flags & FL_ENABLE_4B_ADDR) { 3692d46b036SStanislav Galabov cmd.tx_cmd_sz = 6; 3702d46b036SStanislav Galabov cmd.rx_cmd_sz = 6; 3712d46b036SStanislav Galabov 37219aa9f71SIan Lepore txBuf[1] = (offset >> 24) & 0xff; 37319aa9f71SIan Lepore txBuf[2] = (offset >> 16) & 0xff; 37419aa9f71SIan Lepore txBuf[3] = (offset >> 8) & 0xff; 37519aa9f71SIan Lepore txBuf[4] = offset & 0xff; 3762d46b036SStanislav Galabov /* Dummy byte */ 3772d46b036SStanislav Galabov txBuf[5] = 0; 3782d46b036SStanislav Galabov } else { 379b3918833SOleksandr Tymoshenko cmd.tx_cmd_sz = 5; 380b3918833SOleksandr Tymoshenko cmd.rx_cmd_sz = 5; 381b3918833SOleksandr Tymoshenko 38219aa9f71SIan Lepore txBuf[1] = (offset >> 16) & 0xff; 38319aa9f71SIan Lepore txBuf[2] = (offset >> 8) & 0xff; 38419aa9f71SIan Lepore txBuf[3] = offset & 0xff; 385b3918833SOleksandr Tymoshenko /* Dummy byte */ 386b3918833SOleksandr Tymoshenko txBuf[4] = 0; 3872d46b036SStanislav Galabov } 388b3918833SOleksandr Tymoshenko 389b3918833SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 390b3918833SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 391b3918833SOleksandr Tymoshenko cmd.tx_data = data; 392b3918833SOleksandr Tymoshenko cmd.rx_data = data; 39319aa9f71SIan Lepore cmd.tx_data_sz = count; 394b3918833SOleksandr Tymoshenko cmd.rx_data_sz = count; 395b3918833SOleksandr Tymoshenko 39689a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 397b3918833SOleksandr Tymoshenko return (err); 398b3918833SOleksandr Tymoshenko } 399b3918833SOleksandr Tymoshenko 400b3918833SOleksandr Tymoshenko static int 40189a1585bSIan Lepore mx25l_set_4b_mode(struct mx25l_softc *sc, uint8_t command) 4022d46b036SStanislav Galabov { 4032d46b036SStanislav Galabov uint8_t txBuf[1], rxBuf[1]; 4042d46b036SStanislav Galabov struct spi_command cmd; 4052d46b036SStanislav Galabov int err; 4062d46b036SStanislav Galabov 4072d46b036SStanislav Galabov memset(&cmd, 0, sizeof(cmd)); 4082d46b036SStanislav Galabov memset(txBuf, 0, sizeof(txBuf)); 4092d46b036SStanislav Galabov memset(rxBuf, 0, sizeof(rxBuf)); 4102d46b036SStanislav Galabov 4112d46b036SStanislav Galabov cmd.tx_cmd_sz = cmd.rx_cmd_sz = 1; 4122d46b036SStanislav Galabov 4132d46b036SStanislav Galabov cmd.tx_cmd = txBuf; 4142d46b036SStanislav Galabov cmd.rx_cmd = rxBuf; 4152d46b036SStanislav Galabov 4162d46b036SStanislav Galabov txBuf[0] = command; 4172d46b036SStanislav Galabov 418*c03ab159SIan Lepore if ((err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd)) == 0) 419*c03ab159SIan Lepore err = mx25l_wait_for_device_ready(sc); 4202d46b036SStanislav Galabov 4212d46b036SStanislav Galabov return (err); 4222d46b036SStanislav Galabov } 4232d46b036SStanislav Galabov 42475b3cfd2SAdrian Chadd #ifdef FDT 4251173c206SStanislav Galabov static struct ofw_compat_data compat_data[] = { 4261173c206SStanislav Galabov { "st,m25p", 1 }, 4271173c206SStanislav Galabov { "jedec,spi-nor", 1 }, 4281173c206SStanislav Galabov { NULL, 0 }, 4291173c206SStanislav Galabov }; 43075b3cfd2SAdrian Chadd #endif 4311173c206SStanislav Galabov 4322d46b036SStanislav Galabov static int 433cd5bdf03SOleksandr Tymoshenko mx25l_probe(device_t dev) 434cd5bdf03SOleksandr Tymoshenko { 4358f74c88aSLuiz Otavio O Souza #ifdef FDT 436009e872eSStanislav Galabov int i; 437009e872eSStanislav Galabov 4388f74c88aSLuiz Otavio O Souza if (!ofw_bus_status_okay(dev)) 4398f74c88aSLuiz Otavio O Souza return (ENXIO); 440009e872eSStanislav Galabov 441009e872eSStanislav Galabov /* First try to match the compatible property to the compat_data */ 442009e872eSStanislav Galabov if (ofw_bus_search_compatible(dev, compat_data)->ocd_data == 1) 443009e872eSStanislav Galabov goto found; 444009e872eSStanislav Galabov 445009e872eSStanislav Galabov /* 446009e872eSStanislav Galabov * Next, try to find a compatible device using the names in the 447009e872eSStanislav Galabov * flash_devices structure 448009e872eSStanislav Galabov */ 449009e872eSStanislav Galabov for (i = 0; i < nitems(flash_devices); i++) 450009e872eSStanislav Galabov if (ofw_bus_is_compatible(dev, flash_devices[i].name)) 451009e872eSStanislav Galabov goto found; 452009e872eSStanislav Galabov 4538f74c88aSLuiz Otavio O Souza return (ENXIO); 454009e872eSStanislav Galabov found: 4558f74c88aSLuiz Otavio O Souza #endif 456cd5bdf03SOleksandr Tymoshenko device_set_desc(dev, "M25Pxx Flash Family"); 4578f74c88aSLuiz Otavio O Souza 458cd5bdf03SOleksandr Tymoshenko return (0); 459cd5bdf03SOleksandr Tymoshenko } 460cd5bdf03SOleksandr Tymoshenko 461cd5bdf03SOleksandr Tymoshenko static int 462cd5bdf03SOleksandr Tymoshenko mx25l_attach(device_t dev) 463cd5bdf03SOleksandr Tymoshenko { 464cd5bdf03SOleksandr Tymoshenko struct mx25l_softc *sc; 465cd5bdf03SOleksandr Tymoshenko struct mx25l_flash_ident *ident; 466*c03ab159SIan Lepore int err; 467cd5bdf03SOleksandr Tymoshenko 468cd5bdf03SOleksandr Tymoshenko sc = device_get_softc(dev); 469cd5bdf03SOleksandr Tymoshenko sc->sc_dev = dev; 47089a1585bSIan Lepore sc->sc_parent = device_get_parent(sc->sc_dev); 47189a1585bSIan Lepore 472cd5bdf03SOleksandr Tymoshenko M25PXX_LOCK_INIT(sc); 473cd5bdf03SOleksandr Tymoshenko 474cd5bdf03SOleksandr Tymoshenko ident = mx25l_get_device_ident(sc); 475cd5bdf03SOleksandr Tymoshenko if (ident == NULL) 476cd5bdf03SOleksandr Tymoshenko return (ENXIO); 477cd5bdf03SOleksandr Tymoshenko 478*c03ab159SIan Lepore if ((err = mx25l_wait_for_device_ready(sc)) != 0) 479*c03ab159SIan Lepore return (err); 480*c03ab159SIan Lepore 481*c03ab159SIan Lepore if (sc->sc_flags & FL_ENABLE_4B_ADDR) { 482*c03ab159SIan Lepore if ((err = mx25l_set_4b_mode(sc, CMD_ENTER_4B_MODE)) != 0) 483*c03ab159SIan Lepore return (err); 484*c03ab159SIan Lepore } else if (sc->sc_flags & FL_DISABLE_4B_ADDR) { 485*c03ab159SIan Lepore if ((err = mx25l_set_4b_mode(sc, CMD_EXIT_4B_MODE)) != 0) 486*c03ab159SIan Lepore return (err); 487*c03ab159SIan Lepore } 488cd5bdf03SOleksandr Tymoshenko 489cd5bdf03SOleksandr Tymoshenko sc->sc_disk = disk_alloc(); 490cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_open = mx25l_open; 491cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_close = mx25l_close; 492cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_strategy = mx25l_strategy; 4931b468038SAdrian Chadd sc->sc_disk->d_getattr = mx25l_getattr; 494cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_ioctl = mx25l_ioctl; 495cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_name = "flash/spi"; 496cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_drv1 = sc; 497cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_maxsize = DFLTPHYS; 498917721a4SAdrian Chadd sc->sc_disk->d_sectorsize = MX25L_SECTORSIZE; 499cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_mediasize = ident->sectorsize * ident->sectorcount; 500cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_unit = device_get_unit(sc->sc_dev); 501cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_dump = NULL; /* NB: no dumps */ 502b3918833SOleksandr Tymoshenko /* Sectorsize for erase operations */ 503b3918833SOleksandr Tymoshenko sc->sc_sectorsize = ident->sectorsize; 50462c3a412SAdrian Chadd sc->sc_flags = ident->flags; 505cd5bdf03SOleksandr Tymoshenko 506cd5bdf03SOleksandr Tymoshenko /* NB: use stripesize to hold the erase/region size for RedBoot */ 507cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_stripesize = ident->sectorsize; 508cd5bdf03SOleksandr Tymoshenko 509cd5bdf03SOleksandr Tymoshenko disk_create(sc->sc_disk, DISK_VERSION); 510cd5bdf03SOleksandr Tymoshenko bioq_init(&sc->sc_bio_queue); 511cd5bdf03SOleksandr Tymoshenko 512cd5bdf03SOleksandr Tymoshenko kproc_create(&mx25l_task, sc, &sc->sc_p, 0, 0, "task: mx25l flash"); 513aae18dccSIan Lepore sc->sc_taskstate = TSTATE_RUNNING; 514aae18dccSIan Lepore 515cd5bdf03SOleksandr Tymoshenko device_printf(sc->sc_dev, "%s, sector %d bytes, %d sectors\n", 516cd5bdf03SOleksandr Tymoshenko ident->name, ident->sectorsize, ident->sectorcount); 517cd5bdf03SOleksandr Tymoshenko 518cd5bdf03SOleksandr Tymoshenko return (0); 519cd5bdf03SOleksandr Tymoshenko } 520cd5bdf03SOleksandr Tymoshenko 521cd5bdf03SOleksandr Tymoshenko static int 522cd5bdf03SOleksandr Tymoshenko mx25l_detach(device_t dev) 523cd5bdf03SOleksandr Tymoshenko { 524aae18dccSIan Lepore struct mx25l_softc *sc; 525aae18dccSIan Lepore int err; 526cd5bdf03SOleksandr Tymoshenko 527aae18dccSIan Lepore sc = device_get_softc(dev); 528aae18dccSIan Lepore err = 0; 529aae18dccSIan Lepore 530aae18dccSIan Lepore M25PXX_LOCK(sc); 531aae18dccSIan Lepore if (sc->sc_taskstate == TSTATE_RUNNING) { 532aae18dccSIan Lepore sc->sc_taskstate = TSTATE_STOPPING; 533aae18dccSIan Lepore wakeup(sc); 534aae18dccSIan Lepore while (err == 0 && sc->sc_taskstate != TSTATE_STOPPED) { 535aae18dccSIan Lepore err = msleep(sc, &sc->sc_mtx, 0, "mx25dt", hz * 3); 536aae18dccSIan Lepore if (err != 0) { 537aae18dccSIan Lepore sc->sc_taskstate = TSTATE_RUNNING; 53889a1585bSIan Lepore device_printf(sc->sc_dev, 539aae18dccSIan Lepore "Failed to stop queue task\n"); 540aae18dccSIan Lepore } 541aae18dccSIan Lepore } 542aae18dccSIan Lepore } 543aae18dccSIan Lepore M25PXX_UNLOCK(sc); 544aae18dccSIan Lepore 545aae18dccSIan Lepore if (err == 0 && sc->sc_taskstate == TSTATE_STOPPED) { 546aae18dccSIan Lepore disk_destroy(sc->sc_disk); 547aae18dccSIan Lepore bioq_flush(&sc->sc_bio_queue, NULL, ENXIO); 548aae18dccSIan Lepore M25PXX_LOCK_DESTROY(sc); 549aae18dccSIan Lepore } 550aae18dccSIan Lepore return (err); 551cd5bdf03SOleksandr Tymoshenko } 552cd5bdf03SOleksandr Tymoshenko 553cd5bdf03SOleksandr Tymoshenko static int 554cd5bdf03SOleksandr Tymoshenko mx25l_open(struct disk *dp) 555cd5bdf03SOleksandr Tymoshenko { 556cd5bdf03SOleksandr Tymoshenko return (0); 557cd5bdf03SOleksandr Tymoshenko } 558cd5bdf03SOleksandr Tymoshenko 559cd5bdf03SOleksandr Tymoshenko static int 560cd5bdf03SOleksandr Tymoshenko mx25l_close(struct disk *dp) 561cd5bdf03SOleksandr Tymoshenko { 562cd5bdf03SOleksandr Tymoshenko 563cd5bdf03SOleksandr Tymoshenko return (0); 564cd5bdf03SOleksandr Tymoshenko } 565cd5bdf03SOleksandr Tymoshenko 566cd5bdf03SOleksandr Tymoshenko static int 567cd5bdf03SOleksandr Tymoshenko mx25l_ioctl(struct disk *dp, u_long cmd, void *data, int fflag, 568cd5bdf03SOleksandr Tymoshenko struct thread *td) 569cd5bdf03SOleksandr Tymoshenko { 570cd5bdf03SOleksandr Tymoshenko 571cd5bdf03SOleksandr Tymoshenko return (EINVAL); 572cd5bdf03SOleksandr Tymoshenko } 573cd5bdf03SOleksandr Tymoshenko 574cd5bdf03SOleksandr Tymoshenko static void 575cd5bdf03SOleksandr Tymoshenko mx25l_strategy(struct bio *bp) 576cd5bdf03SOleksandr Tymoshenko { 577cd5bdf03SOleksandr Tymoshenko struct mx25l_softc *sc; 578cd5bdf03SOleksandr Tymoshenko 579cd5bdf03SOleksandr Tymoshenko sc = (struct mx25l_softc *)bp->bio_disk->d_drv1; 580cd5bdf03SOleksandr Tymoshenko M25PXX_LOCK(sc); 581cd5bdf03SOleksandr Tymoshenko bioq_disksort(&sc->sc_bio_queue, bp); 582cd5bdf03SOleksandr Tymoshenko wakeup(sc); 583cd5bdf03SOleksandr Tymoshenko M25PXX_UNLOCK(sc); 584cd5bdf03SOleksandr Tymoshenko } 585cd5bdf03SOleksandr Tymoshenko 5861b468038SAdrian Chadd static int 5871b468038SAdrian Chadd mx25l_getattr(struct bio *bp) 5881b468038SAdrian Chadd { 5891b468038SAdrian Chadd struct mx25l_softc *sc; 5901b468038SAdrian Chadd device_t dev; 5911b468038SAdrian Chadd 5921b468038SAdrian Chadd if (bp->bio_disk == NULL || bp->bio_disk->d_drv1 == NULL) 5931b468038SAdrian Chadd return (ENXIO); 5941b468038SAdrian Chadd 5951b468038SAdrian Chadd sc = bp->bio_disk->d_drv1; 5961b468038SAdrian Chadd dev = sc->sc_dev; 5971b468038SAdrian Chadd 5981b468038SAdrian Chadd if (strcmp(bp->bio_attribute, "SPI::device") == 0) { 5991b468038SAdrian Chadd if (bp->bio_length != sizeof(dev)) 6001b468038SAdrian Chadd return (EFAULT); 6011b468038SAdrian Chadd bcopy(&dev, bp->bio_data, sizeof(dev)); 6021b468038SAdrian Chadd } else 6031b468038SAdrian Chadd return (-1); 6041b468038SAdrian Chadd return (0); 6051b468038SAdrian Chadd } 6061b468038SAdrian Chadd 607cd5bdf03SOleksandr Tymoshenko static void 608cd5bdf03SOleksandr Tymoshenko mx25l_task(void *arg) 609cd5bdf03SOleksandr Tymoshenko { 610cd5bdf03SOleksandr Tymoshenko struct mx25l_softc *sc = (struct mx25l_softc*)arg; 611cd5bdf03SOleksandr Tymoshenko struct bio *bp; 612b3918833SOleksandr Tymoshenko device_t dev; 613cd5bdf03SOleksandr Tymoshenko 614cd5bdf03SOleksandr Tymoshenko for (;;) { 615cd5bdf03SOleksandr Tymoshenko dev = sc->sc_dev; 616cd5bdf03SOleksandr Tymoshenko M25PXX_LOCK(sc); 617cd5bdf03SOleksandr Tymoshenko do { 618aae18dccSIan Lepore if (sc->sc_taskstate == TSTATE_STOPPING) { 619aae18dccSIan Lepore sc->sc_taskstate = TSTATE_STOPPED; 620aae18dccSIan Lepore M25PXX_UNLOCK(sc); 621aae18dccSIan Lepore wakeup(sc); 622aae18dccSIan Lepore kproc_exit(0); 623aae18dccSIan Lepore } 624cd5bdf03SOleksandr Tymoshenko bp = bioq_first(&sc->sc_bio_queue); 625cd5bdf03SOleksandr Tymoshenko if (bp == NULL) 626aae18dccSIan Lepore msleep(sc, &sc->sc_mtx, PRIBIO, "mx25jq", 0); 627cd5bdf03SOleksandr Tymoshenko } while (bp == NULL); 628cd5bdf03SOleksandr Tymoshenko bioq_remove(&sc->sc_bio_queue, bp); 629cd5bdf03SOleksandr Tymoshenko M25PXX_UNLOCK(sc); 630cd5bdf03SOleksandr Tymoshenko 631b3918833SOleksandr Tymoshenko switch (bp->bio_cmd) { 632b3918833SOleksandr Tymoshenko case BIO_READ: 63389a1585bSIan Lepore bp->bio_error = mx25l_read(sc, bp->bio_offset, 634b3918833SOleksandr Tymoshenko bp->bio_data, bp->bio_bcount); 635c3655ab0SOleksandr Tymoshenko break; 636b3918833SOleksandr Tymoshenko case BIO_WRITE: 63789a1585bSIan Lepore bp->bio_error = mx25l_write(sc, bp->bio_offset, 638b3918833SOleksandr Tymoshenko bp->bio_data, bp->bio_bcount); 639b3918833SOleksandr Tymoshenko break; 640b3918833SOleksandr Tymoshenko default: 641cd5bdf03SOleksandr Tymoshenko bp->bio_error = EINVAL; 642b3918833SOleksandr Tymoshenko } 643cd5bdf03SOleksandr Tymoshenko 644c3655ab0SOleksandr Tymoshenko 645cd5bdf03SOleksandr Tymoshenko biodone(bp); 646cd5bdf03SOleksandr Tymoshenko } 647cd5bdf03SOleksandr Tymoshenko } 648cd5bdf03SOleksandr Tymoshenko 649cd5bdf03SOleksandr Tymoshenko static devclass_t mx25l_devclass; 650cd5bdf03SOleksandr Tymoshenko 651cd5bdf03SOleksandr Tymoshenko static device_method_t mx25l_methods[] = { 652cd5bdf03SOleksandr Tymoshenko /* Device interface */ 653cd5bdf03SOleksandr Tymoshenko DEVMETHOD(device_probe, mx25l_probe), 654cd5bdf03SOleksandr Tymoshenko DEVMETHOD(device_attach, mx25l_attach), 655cd5bdf03SOleksandr Tymoshenko DEVMETHOD(device_detach, mx25l_detach), 656cd5bdf03SOleksandr Tymoshenko 657cd5bdf03SOleksandr Tymoshenko { 0, 0 } 658cd5bdf03SOleksandr Tymoshenko }; 659cd5bdf03SOleksandr Tymoshenko 660cd5bdf03SOleksandr Tymoshenko static driver_t mx25l_driver = { 661cd5bdf03SOleksandr Tymoshenko "mx25l", 662cd5bdf03SOleksandr Tymoshenko mx25l_methods, 663cd5bdf03SOleksandr Tymoshenko sizeof(struct mx25l_softc), 664cd5bdf03SOleksandr Tymoshenko }; 665cd5bdf03SOleksandr Tymoshenko 666cd5bdf03SOleksandr Tymoshenko DRIVER_MODULE(mx25l, spibus, mx25l_driver, mx25l_devclass, 0, 0); 66742c52f36SIan Lepore MODULE_DEPEND(mx25l, spibus, 1, 1, 1); 668