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; 84*89a1585bSIan 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 153cd5bdf03SOleksandr Tymoshenko static uint8_t 154*89a1585bSIan Lepore mx25l_get_status(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 memset(txBuf, 0, sizeof(txBuf)); 162cd5bdf03SOleksandr Tymoshenko memset(rxBuf, 0, sizeof(rxBuf)); 163cd5bdf03SOleksandr Tymoshenko 164cd5bdf03SOleksandr Tymoshenko txBuf[0] = CMD_READ_STATUS; 165cd5bdf03SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 166cd5bdf03SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 167cd5bdf03SOleksandr Tymoshenko cmd.rx_cmd_sz = 2; 168cd5bdf03SOleksandr Tymoshenko cmd.tx_cmd_sz = 2; 169*89a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 170cd5bdf03SOleksandr Tymoshenko return (rxBuf[1]); 171cd5bdf03SOleksandr Tymoshenko } 172cd5bdf03SOleksandr Tymoshenko 173cd5bdf03SOleksandr Tymoshenko static void 174*89a1585bSIan Lepore mx25l_wait_for_device_ready(struct mx25l_softc *sc) 175cd5bdf03SOleksandr Tymoshenko { 176*89a1585bSIan Lepore while ((mx25l_get_status(sc) & STATUS_WIP)) 177cd5bdf03SOleksandr Tymoshenko continue; 178cd5bdf03SOleksandr Tymoshenko } 179cd5bdf03SOleksandr Tymoshenko 180cd5bdf03SOleksandr Tymoshenko static struct mx25l_flash_ident* 181cd5bdf03SOleksandr Tymoshenko mx25l_get_device_ident(struct mx25l_softc *sc) 182cd5bdf03SOleksandr Tymoshenko { 183cd5bdf03SOleksandr Tymoshenko uint8_t txBuf[8], rxBuf[8]; 184cd5bdf03SOleksandr Tymoshenko struct spi_command cmd; 185cd5bdf03SOleksandr Tymoshenko uint8_t manufacturer_id; 186cd5bdf03SOleksandr Tymoshenko uint16_t dev_id; 187cd5bdf03SOleksandr Tymoshenko int err, i; 188cd5bdf03SOleksandr Tymoshenko 189cd5bdf03SOleksandr Tymoshenko memset(&cmd, 0, sizeof(cmd)); 190cd5bdf03SOleksandr Tymoshenko memset(txBuf, 0, sizeof(txBuf)); 191cd5bdf03SOleksandr Tymoshenko memset(rxBuf, 0, sizeof(rxBuf)); 192cd5bdf03SOleksandr Tymoshenko 193cd5bdf03SOleksandr Tymoshenko txBuf[0] = CMD_READ_IDENT; 194cd5bdf03SOleksandr Tymoshenko cmd.tx_cmd = &txBuf; 195cd5bdf03SOleksandr Tymoshenko cmd.rx_cmd = &rxBuf; 196cd5bdf03SOleksandr Tymoshenko /* 197cd5bdf03SOleksandr Tymoshenko * Some compatible devices has extended two-bytes ID 198cd5bdf03SOleksandr Tymoshenko * We'll use only manufacturer/deviceid atm 199cd5bdf03SOleksandr Tymoshenko */ 200cd5bdf03SOleksandr Tymoshenko cmd.tx_cmd_sz = 4; 201cd5bdf03SOleksandr Tymoshenko cmd.rx_cmd_sz = 4; 202*89a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 203cd5bdf03SOleksandr Tymoshenko if (err) 204cd5bdf03SOleksandr Tymoshenko return (NULL); 205cd5bdf03SOleksandr Tymoshenko 206cd5bdf03SOleksandr Tymoshenko manufacturer_id = rxBuf[1]; 207cd5bdf03SOleksandr Tymoshenko dev_id = (rxBuf[2] << 8) | (rxBuf[3]); 208cd5bdf03SOleksandr Tymoshenko 209cd5bdf03SOleksandr Tymoshenko for (i = 0; 21073a1170aSPedro F. Giffuni i < nitems(flash_devices); i++) { 211cd5bdf03SOleksandr Tymoshenko if ((flash_devices[i].manufacturer_id == manufacturer_id) && 212cd5bdf03SOleksandr Tymoshenko (flash_devices[i].device_id == dev_id)) 213cd5bdf03SOleksandr Tymoshenko return &flash_devices[i]; 214cd5bdf03SOleksandr Tymoshenko } 215cd5bdf03SOleksandr Tymoshenko 216*89a1585bSIan Lepore device_printf(sc->sc_dev, 217*89a1585bSIan Lepore "Unknown SPI flash device. Vendor: %02x, device id: %04x\n", 218cd5bdf03SOleksandr Tymoshenko manufacturer_id, dev_id); 219cd5bdf03SOleksandr Tymoshenko return (NULL); 220cd5bdf03SOleksandr Tymoshenko } 221cd5bdf03SOleksandr Tymoshenko 222c3655ab0SOleksandr Tymoshenko static void 223*89a1585bSIan Lepore mx25l_set_writable(struct mx25l_softc *sc, int writable) 224c3655ab0SOleksandr Tymoshenko { 225c3655ab0SOleksandr Tymoshenko uint8_t txBuf[1], rxBuf[1]; 226c3655ab0SOleksandr Tymoshenko struct spi_command cmd; 227c3655ab0SOleksandr Tymoshenko int err; 228c3655ab0SOleksandr Tymoshenko 229c3655ab0SOleksandr Tymoshenko memset(&cmd, 0, sizeof(cmd)); 230c3655ab0SOleksandr Tymoshenko memset(txBuf, 0, sizeof(txBuf)); 231c3655ab0SOleksandr Tymoshenko memset(rxBuf, 0, sizeof(rxBuf)); 232c3655ab0SOleksandr Tymoshenko 233c3655ab0SOleksandr Tymoshenko txBuf[0] = writable ? CMD_WRITE_ENABLE : CMD_WRITE_DISABLE; 234c3655ab0SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 235c3655ab0SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 236c3655ab0SOleksandr Tymoshenko cmd.rx_cmd_sz = 1; 237c3655ab0SOleksandr Tymoshenko cmd.tx_cmd_sz = 1; 238*89a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 239c3655ab0SOleksandr Tymoshenko } 240c3655ab0SOleksandr Tymoshenko 241c3655ab0SOleksandr Tymoshenko static void 242*89a1585bSIan Lepore mx25l_erase_cmd(struct mx25l_softc *sc, off_t sector, uint8_t ecmd) 243c3655ab0SOleksandr Tymoshenko { 2442d46b036SStanislav Galabov uint8_t txBuf[5], rxBuf[5]; 245c3655ab0SOleksandr Tymoshenko struct spi_command cmd; 246c3655ab0SOleksandr Tymoshenko int err; 247c3655ab0SOleksandr Tymoshenko 248*89a1585bSIan Lepore mx25l_set_writable(sc, 1); 249c3655ab0SOleksandr Tymoshenko 250c3655ab0SOleksandr Tymoshenko memset(&cmd, 0, sizeof(cmd)); 251c3655ab0SOleksandr Tymoshenko memset(txBuf, 0, sizeof(txBuf)); 252c3655ab0SOleksandr Tymoshenko memset(rxBuf, 0, sizeof(rxBuf)); 253c3655ab0SOleksandr Tymoshenko 25453436aceSAdrian Chadd txBuf[0] = ecmd; 255c3655ab0SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 256c3655ab0SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 2572d46b036SStanislav Galabov if (sc->sc_flags & FL_ENABLE_4B_ADDR) { 2582d46b036SStanislav Galabov cmd.rx_cmd_sz = 5; 2592d46b036SStanislav Galabov cmd.tx_cmd_sz = 5; 2602d46b036SStanislav Galabov txBuf[1] = ((sector >> 24) & 0xff); 2612d46b036SStanislav Galabov txBuf[2] = ((sector >> 16) & 0xff); 2622d46b036SStanislav Galabov txBuf[3] = ((sector >> 8) & 0xff); 2632d46b036SStanislav Galabov txBuf[4] = (sector & 0xff); 2642d46b036SStanislav Galabov } else { 265c3655ab0SOleksandr Tymoshenko cmd.rx_cmd_sz = 4; 266c3655ab0SOleksandr Tymoshenko cmd.tx_cmd_sz = 4; 267c3655ab0SOleksandr Tymoshenko txBuf[1] = ((sector >> 16) & 0xff); 268c3655ab0SOleksandr Tymoshenko txBuf[2] = ((sector >> 8) & 0xff); 269c3655ab0SOleksandr Tymoshenko txBuf[3] = (sector & 0xff); 2702d46b036SStanislav Galabov } 271*89a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 272*89a1585bSIan Lepore mx25l_wait_for_device_ready(sc); 273c3655ab0SOleksandr Tymoshenko } 274c3655ab0SOleksandr Tymoshenko 275cd5bdf03SOleksandr Tymoshenko static int 276*89a1585bSIan Lepore mx25l_write(struct mx25l_softc *sc, off_t offset, caddr_t data, off_t count) 277b3918833SOleksandr Tymoshenko { 278b3918833SOleksandr Tymoshenko uint8_t txBuf[8], rxBuf[8]; 279b3918833SOleksandr Tymoshenko struct spi_command cmd; 28019aa9f71SIan Lepore off_t bytes_to_write; 281b3918833SOleksandr Tymoshenko int err = 0; 282b3918833SOleksandr Tymoshenko 2832d46b036SStanislav Galabov if (sc->sc_flags & FL_ENABLE_4B_ADDR) { 2842d46b036SStanislav Galabov cmd.tx_cmd_sz = 5; 2852d46b036SStanislav Galabov cmd.rx_cmd_sz = 5; 2862d46b036SStanislav Galabov } else { 287b3918833SOleksandr Tymoshenko cmd.tx_cmd_sz = 4; 288b3918833SOleksandr Tymoshenko cmd.rx_cmd_sz = 4; 2892d46b036SStanislav Galabov } 290b3918833SOleksandr Tymoshenko 291b3918833SOleksandr Tymoshenko /* 292f432eb7eSIan Lepore * Writes must be aligned to the erase sectorsize, since blocks are 293f432eb7eSIan Lepore * fully erased before they're written to. 294b3918833SOleksandr Tymoshenko */ 295917721a4SAdrian Chadd if (count % sc->sc_sectorsize != 0 || offset % sc->sc_sectorsize != 0) 296917721a4SAdrian Chadd return (EIO); 297b3918833SOleksandr Tymoshenko 298b3918833SOleksandr Tymoshenko /* 29919aa9f71SIan Lepore * Maximum write size for CMD_PAGE_PROGRAM is FLASH_PAGE_SIZE, so loop 30019aa9f71SIan Lepore * to write chunks of FLASH_PAGE_SIZE bytes each. 301b3918833SOleksandr Tymoshenko */ 30219aa9f71SIan Lepore while (count != 0) { 30319aa9f71SIan Lepore /* If we crossed a sector boundary, erase the next sector. */ 30419aa9f71SIan Lepore if (((offset) % sc->sc_sectorsize) == 0) 305*89a1585bSIan Lepore mx25l_erase_cmd(sc, offset, CMD_SECTOR_ERASE); 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*89a1585bSIan Lepore mx25l_wait_for_device_ready(sc); 332*89a1585bSIan Lepore mx25l_set_writable(sc, 1); 333b3918833SOleksandr Tymoshenko 334*89a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 335*89a1585bSIan Lepore mx25l_wait_for_device_ready(sc); 336b3918833SOleksandr Tymoshenko if (err) 337b3918833SOleksandr Tymoshenko break; 338b3918833SOleksandr Tymoshenko 33919aa9f71SIan Lepore data += bytes_to_write; 34019aa9f71SIan Lepore offset += bytes_to_write; 34119aa9f71SIan Lepore count -= bytes_to_write; 342b3918833SOleksandr Tymoshenko } 343b3918833SOleksandr Tymoshenko 344b3918833SOleksandr Tymoshenko return (err); 345b3918833SOleksandr Tymoshenko } 346b3918833SOleksandr Tymoshenko 347b3918833SOleksandr Tymoshenko static int 348*89a1585bSIan Lepore mx25l_read(struct mx25l_softc *sc, off_t offset, caddr_t data, off_t count) 349b3918833SOleksandr Tymoshenko { 350b3918833SOleksandr Tymoshenko uint8_t txBuf[8], rxBuf[8]; 351b3918833SOleksandr Tymoshenko struct spi_command cmd; 352b3918833SOleksandr Tymoshenko int err = 0; 353b3918833SOleksandr Tymoshenko 354b3918833SOleksandr Tymoshenko /* 35519aa9f71SIan Lepore * Enforce that reads are aligned to the disk sectorsize, not the 35619aa9f71SIan Lepore * erase sectorsize. In this way, smaller read IO is possible, 35719aa9f71SIan Lepore * dramatically speeding up filesystem/geom_compress access. 358b3918833SOleksandr Tymoshenko */ 35919aa9f71SIan Lepore if (count % sc->sc_disk->d_sectorsize != 0 || 36019aa9f71SIan Lepore offset % sc->sc_disk->d_sectorsize != 0) 361917721a4SAdrian Chadd return (EIO); 362b3918833SOleksandr Tymoshenko 363b3918833SOleksandr Tymoshenko txBuf[0] = CMD_FAST_READ; 3642d46b036SStanislav Galabov if (sc->sc_flags & FL_ENABLE_4B_ADDR) { 3652d46b036SStanislav Galabov cmd.tx_cmd_sz = 6; 3662d46b036SStanislav Galabov cmd.rx_cmd_sz = 6; 3672d46b036SStanislav Galabov 36819aa9f71SIan Lepore txBuf[1] = (offset >> 24) & 0xff; 36919aa9f71SIan Lepore txBuf[2] = (offset >> 16) & 0xff; 37019aa9f71SIan Lepore txBuf[3] = (offset >> 8) & 0xff; 37119aa9f71SIan Lepore txBuf[4] = offset & 0xff; 3722d46b036SStanislav Galabov /* Dummy byte */ 3732d46b036SStanislav Galabov txBuf[5] = 0; 3742d46b036SStanislav Galabov } else { 375b3918833SOleksandr Tymoshenko cmd.tx_cmd_sz = 5; 376b3918833SOleksandr Tymoshenko cmd.rx_cmd_sz = 5; 377b3918833SOleksandr Tymoshenko 37819aa9f71SIan Lepore txBuf[1] = (offset >> 16) & 0xff; 37919aa9f71SIan Lepore txBuf[2] = (offset >> 8) & 0xff; 38019aa9f71SIan Lepore txBuf[3] = offset & 0xff; 381b3918833SOleksandr Tymoshenko /* Dummy byte */ 382b3918833SOleksandr Tymoshenko txBuf[4] = 0; 3832d46b036SStanislav Galabov } 384b3918833SOleksandr Tymoshenko 385b3918833SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 386b3918833SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 387b3918833SOleksandr Tymoshenko cmd.tx_data = data; 388b3918833SOleksandr Tymoshenko cmd.rx_data = data; 38919aa9f71SIan Lepore cmd.tx_data_sz = count; 390b3918833SOleksandr Tymoshenko cmd.rx_data_sz = count; 391b3918833SOleksandr Tymoshenko 392*89a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 393b3918833SOleksandr Tymoshenko 394b3918833SOleksandr Tymoshenko return (err); 395b3918833SOleksandr Tymoshenko } 396b3918833SOleksandr Tymoshenko 397b3918833SOleksandr Tymoshenko static int 398*89a1585bSIan Lepore mx25l_set_4b_mode(struct mx25l_softc *sc, uint8_t command) 3992d46b036SStanislav Galabov { 4002d46b036SStanislav Galabov uint8_t txBuf[1], rxBuf[1]; 4012d46b036SStanislav Galabov struct spi_command cmd; 4022d46b036SStanislav Galabov int err; 4032d46b036SStanislav Galabov 4042d46b036SStanislav Galabov memset(&cmd, 0, sizeof(cmd)); 4052d46b036SStanislav Galabov memset(txBuf, 0, sizeof(txBuf)); 4062d46b036SStanislav Galabov memset(rxBuf, 0, sizeof(rxBuf)); 4072d46b036SStanislav Galabov 4082d46b036SStanislav Galabov cmd.tx_cmd_sz = cmd.rx_cmd_sz = 1; 4092d46b036SStanislav Galabov 4102d46b036SStanislav Galabov cmd.tx_cmd = txBuf; 4112d46b036SStanislav Galabov cmd.rx_cmd = rxBuf; 4122d46b036SStanislav Galabov 4132d46b036SStanislav Galabov txBuf[0] = command; 4142d46b036SStanislav Galabov 415*89a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 4162d46b036SStanislav Galabov 417*89a1585bSIan Lepore mx25l_wait_for_device_ready(sc); 4182d46b036SStanislav Galabov 4192d46b036SStanislav Galabov return (err); 4202d46b036SStanislav Galabov } 4212d46b036SStanislav Galabov 42275b3cfd2SAdrian Chadd #ifdef FDT 4231173c206SStanislav Galabov static struct ofw_compat_data compat_data[] = { 4241173c206SStanislav Galabov { "st,m25p", 1 }, 4251173c206SStanislav Galabov { "jedec,spi-nor", 1 }, 4261173c206SStanislav Galabov { NULL, 0 }, 4271173c206SStanislav Galabov }; 42875b3cfd2SAdrian Chadd #endif 4291173c206SStanislav Galabov 4302d46b036SStanislav Galabov static int 431cd5bdf03SOleksandr Tymoshenko mx25l_probe(device_t dev) 432cd5bdf03SOleksandr Tymoshenko { 4338f74c88aSLuiz Otavio O Souza #ifdef FDT 434009e872eSStanislav Galabov int i; 435009e872eSStanislav Galabov 4368f74c88aSLuiz Otavio O Souza if (!ofw_bus_status_okay(dev)) 4378f74c88aSLuiz Otavio O Souza return (ENXIO); 438009e872eSStanislav Galabov 439009e872eSStanislav Galabov /* First try to match the compatible property to the compat_data */ 440009e872eSStanislav Galabov if (ofw_bus_search_compatible(dev, compat_data)->ocd_data == 1) 441009e872eSStanislav Galabov goto found; 442009e872eSStanislav Galabov 443009e872eSStanislav Galabov /* 444009e872eSStanislav Galabov * Next, try to find a compatible device using the names in the 445009e872eSStanislav Galabov * flash_devices structure 446009e872eSStanislav Galabov */ 447009e872eSStanislav Galabov for (i = 0; i < nitems(flash_devices); i++) 448009e872eSStanislav Galabov if (ofw_bus_is_compatible(dev, flash_devices[i].name)) 449009e872eSStanislav Galabov goto found; 450009e872eSStanislav Galabov 4518f74c88aSLuiz Otavio O Souza return (ENXIO); 452009e872eSStanislav Galabov found: 4538f74c88aSLuiz Otavio O Souza #endif 454cd5bdf03SOleksandr Tymoshenko device_set_desc(dev, "M25Pxx Flash Family"); 4558f74c88aSLuiz Otavio O Souza 456cd5bdf03SOleksandr Tymoshenko return (0); 457cd5bdf03SOleksandr Tymoshenko } 458cd5bdf03SOleksandr Tymoshenko 459cd5bdf03SOleksandr Tymoshenko static int 460cd5bdf03SOleksandr Tymoshenko mx25l_attach(device_t dev) 461cd5bdf03SOleksandr Tymoshenko { 462cd5bdf03SOleksandr Tymoshenko struct mx25l_softc *sc; 463cd5bdf03SOleksandr Tymoshenko struct mx25l_flash_ident *ident; 464cd5bdf03SOleksandr Tymoshenko 465cd5bdf03SOleksandr Tymoshenko sc = device_get_softc(dev); 466cd5bdf03SOleksandr Tymoshenko sc->sc_dev = dev; 467*89a1585bSIan Lepore sc->sc_parent = device_get_parent(sc->sc_dev); 468*89a1585bSIan Lepore 469cd5bdf03SOleksandr Tymoshenko M25PXX_LOCK_INIT(sc); 470cd5bdf03SOleksandr Tymoshenko 471cd5bdf03SOleksandr Tymoshenko ident = mx25l_get_device_ident(sc); 472cd5bdf03SOleksandr Tymoshenko if (ident == NULL) 473cd5bdf03SOleksandr Tymoshenko return (ENXIO); 474cd5bdf03SOleksandr Tymoshenko 475*89a1585bSIan Lepore mx25l_wait_for_device_ready(sc); 476cd5bdf03SOleksandr Tymoshenko 477cd5bdf03SOleksandr Tymoshenko sc->sc_disk = disk_alloc(); 478cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_open = mx25l_open; 479cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_close = mx25l_close; 480cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_strategy = mx25l_strategy; 4811b468038SAdrian Chadd sc->sc_disk->d_getattr = mx25l_getattr; 482cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_ioctl = mx25l_ioctl; 483cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_name = "flash/spi"; 484cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_drv1 = sc; 485cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_maxsize = DFLTPHYS; 486917721a4SAdrian Chadd sc->sc_disk->d_sectorsize = MX25L_SECTORSIZE; 487cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_mediasize = ident->sectorsize * ident->sectorcount; 488cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_unit = device_get_unit(sc->sc_dev); 489cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_dump = NULL; /* NB: no dumps */ 490b3918833SOleksandr Tymoshenko /* Sectorsize for erase operations */ 491b3918833SOleksandr Tymoshenko sc->sc_sectorsize = ident->sectorsize; 49262c3a412SAdrian Chadd sc->sc_flags = ident->flags; 493cd5bdf03SOleksandr Tymoshenko 4942d46b036SStanislav Galabov if (sc->sc_flags & FL_ENABLE_4B_ADDR) 495*89a1585bSIan Lepore mx25l_set_4b_mode(sc, CMD_ENTER_4B_MODE); 4962d46b036SStanislav Galabov 4972d46b036SStanislav Galabov if (sc->sc_flags & FL_DISABLE_4B_ADDR) 498*89a1585bSIan Lepore mx25l_set_4b_mode(sc, CMD_EXIT_4B_MODE); 4992d46b036SStanislav Galabov 500cd5bdf03SOleksandr Tymoshenko /* NB: use stripesize to hold the erase/region size for RedBoot */ 501cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_stripesize = ident->sectorsize; 502cd5bdf03SOleksandr Tymoshenko 503cd5bdf03SOleksandr Tymoshenko disk_create(sc->sc_disk, DISK_VERSION); 504cd5bdf03SOleksandr Tymoshenko bioq_init(&sc->sc_bio_queue); 505cd5bdf03SOleksandr Tymoshenko 506cd5bdf03SOleksandr Tymoshenko kproc_create(&mx25l_task, sc, &sc->sc_p, 0, 0, "task: mx25l flash"); 507aae18dccSIan Lepore sc->sc_taskstate = TSTATE_RUNNING; 508aae18dccSIan Lepore 509cd5bdf03SOleksandr Tymoshenko device_printf(sc->sc_dev, "%s, sector %d bytes, %d sectors\n", 510cd5bdf03SOleksandr Tymoshenko ident->name, ident->sectorsize, ident->sectorcount); 511cd5bdf03SOleksandr Tymoshenko 512cd5bdf03SOleksandr Tymoshenko return (0); 513cd5bdf03SOleksandr Tymoshenko } 514cd5bdf03SOleksandr Tymoshenko 515cd5bdf03SOleksandr Tymoshenko static int 516cd5bdf03SOleksandr Tymoshenko mx25l_detach(device_t dev) 517cd5bdf03SOleksandr Tymoshenko { 518aae18dccSIan Lepore struct mx25l_softc *sc; 519aae18dccSIan Lepore int err; 520cd5bdf03SOleksandr Tymoshenko 521aae18dccSIan Lepore sc = device_get_softc(dev); 522aae18dccSIan Lepore err = 0; 523aae18dccSIan Lepore 524aae18dccSIan Lepore M25PXX_LOCK(sc); 525aae18dccSIan Lepore if (sc->sc_taskstate == TSTATE_RUNNING) { 526aae18dccSIan Lepore sc->sc_taskstate = TSTATE_STOPPING; 527aae18dccSIan Lepore wakeup(sc); 528aae18dccSIan Lepore while (err == 0 && sc->sc_taskstate != TSTATE_STOPPED) { 529aae18dccSIan Lepore err = msleep(sc, &sc->sc_mtx, 0, "mx25dt", hz * 3); 530aae18dccSIan Lepore if (err != 0) { 531aae18dccSIan Lepore sc->sc_taskstate = TSTATE_RUNNING; 532*89a1585bSIan Lepore device_printf(sc->sc_dev, 533aae18dccSIan Lepore "Failed to stop queue task\n"); 534aae18dccSIan Lepore } 535aae18dccSIan Lepore } 536aae18dccSIan Lepore } 537aae18dccSIan Lepore M25PXX_UNLOCK(sc); 538aae18dccSIan Lepore 539aae18dccSIan Lepore if (err == 0 && sc->sc_taskstate == TSTATE_STOPPED) { 540aae18dccSIan Lepore disk_destroy(sc->sc_disk); 541aae18dccSIan Lepore bioq_flush(&sc->sc_bio_queue, NULL, ENXIO); 542aae18dccSIan Lepore M25PXX_LOCK_DESTROY(sc); 543aae18dccSIan Lepore } 544aae18dccSIan Lepore return (err); 545cd5bdf03SOleksandr Tymoshenko } 546cd5bdf03SOleksandr Tymoshenko 547cd5bdf03SOleksandr Tymoshenko static int 548cd5bdf03SOleksandr Tymoshenko mx25l_open(struct disk *dp) 549cd5bdf03SOleksandr Tymoshenko { 550cd5bdf03SOleksandr Tymoshenko return (0); 551cd5bdf03SOleksandr Tymoshenko } 552cd5bdf03SOleksandr Tymoshenko 553cd5bdf03SOleksandr Tymoshenko static int 554cd5bdf03SOleksandr Tymoshenko mx25l_close(struct disk *dp) 555cd5bdf03SOleksandr Tymoshenko { 556cd5bdf03SOleksandr Tymoshenko 557cd5bdf03SOleksandr Tymoshenko return (0); 558cd5bdf03SOleksandr Tymoshenko } 559cd5bdf03SOleksandr Tymoshenko 560cd5bdf03SOleksandr Tymoshenko static int 561cd5bdf03SOleksandr Tymoshenko mx25l_ioctl(struct disk *dp, u_long cmd, void *data, int fflag, 562cd5bdf03SOleksandr Tymoshenko struct thread *td) 563cd5bdf03SOleksandr Tymoshenko { 564cd5bdf03SOleksandr Tymoshenko 565cd5bdf03SOleksandr Tymoshenko return (EINVAL); 566cd5bdf03SOleksandr Tymoshenko } 567cd5bdf03SOleksandr Tymoshenko 568cd5bdf03SOleksandr Tymoshenko static void 569cd5bdf03SOleksandr Tymoshenko mx25l_strategy(struct bio *bp) 570cd5bdf03SOleksandr Tymoshenko { 571cd5bdf03SOleksandr Tymoshenko struct mx25l_softc *sc; 572cd5bdf03SOleksandr Tymoshenko 573cd5bdf03SOleksandr Tymoshenko sc = (struct mx25l_softc *)bp->bio_disk->d_drv1; 574cd5bdf03SOleksandr Tymoshenko M25PXX_LOCK(sc); 575cd5bdf03SOleksandr Tymoshenko bioq_disksort(&sc->sc_bio_queue, bp); 576cd5bdf03SOleksandr Tymoshenko wakeup(sc); 577cd5bdf03SOleksandr Tymoshenko M25PXX_UNLOCK(sc); 578cd5bdf03SOleksandr Tymoshenko } 579cd5bdf03SOleksandr Tymoshenko 5801b468038SAdrian Chadd static int 5811b468038SAdrian Chadd mx25l_getattr(struct bio *bp) 5821b468038SAdrian Chadd { 5831b468038SAdrian Chadd struct mx25l_softc *sc; 5841b468038SAdrian Chadd device_t dev; 5851b468038SAdrian Chadd 5861b468038SAdrian Chadd if (bp->bio_disk == NULL || bp->bio_disk->d_drv1 == NULL) 5871b468038SAdrian Chadd return (ENXIO); 5881b468038SAdrian Chadd 5891b468038SAdrian Chadd sc = bp->bio_disk->d_drv1; 5901b468038SAdrian Chadd dev = sc->sc_dev; 5911b468038SAdrian Chadd 5921b468038SAdrian Chadd if (strcmp(bp->bio_attribute, "SPI::device") == 0) { 5931b468038SAdrian Chadd if (bp->bio_length != sizeof(dev)) 5941b468038SAdrian Chadd return (EFAULT); 5951b468038SAdrian Chadd bcopy(&dev, bp->bio_data, sizeof(dev)); 5961b468038SAdrian Chadd } else 5971b468038SAdrian Chadd return (-1); 5981b468038SAdrian Chadd return (0); 5991b468038SAdrian Chadd } 6001b468038SAdrian Chadd 601cd5bdf03SOleksandr Tymoshenko static void 602cd5bdf03SOleksandr Tymoshenko mx25l_task(void *arg) 603cd5bdf03SOleksandr Tymoshenko { 604cd5bdf03SOleksandr Tymoshenko struct mx25l_softc *sc = (struct mx25l_softc*)arg; 605cd5bdf03SOleksandr Tymoshenko struct bio *bp; 606b3918833SOleksandr Tymoshenko device_t dev; 607cd5bdf03SOleksandr Tymoshenko 608cd5bdf03SOleksandr Tymoshenko for (;;) { 609cd5bdf03SOleksandr Tymoshenko dev = sc->sc_dev; 610cd5bdf03SOleksandr Tymoshenko M25PXX_LOCK(sc); 611cd5bdf03SOleksandr Tymoshenko do { 612aae18dccSIan Lepore if (sc->sc_taskstate == TSTATE_STOPPING) { 613aae18dccSIan Lepore sc->sc_taskstate = TSTATE_STOPPED; 614aae18dccSIan Lepore M25PXX_UNLOCK(sc); 615aae18dccSIan Lepore wakeup(sc); 616aae18dccSIan Lepore kproc_exit(0); 617aae18dccSIan Lepore } 618cd5bdf03SOleksandr Tymoshenko bp = bioq_first(&sc->sc_bio_queue); 619cd5bdf03SOleksandr Tymoshenko if (bp == NULL) 620aae18dccSIan Lepore msleep(sc, &sc->sc_mtx, PRIBIO, "mx25jq", 0); 621cd5bdf03SOleksandr Tymoshenko } while (bp == NULL); 622cd5bdf03SOleksandr Tymoshenko bioq_remove(&sc->sc_bio_queue, bp); 623cd5bdf03SOleksandr Tymoshenko M25PXX_UNLOCK(sc); 624cd5bdf03SOleksandr Tymoshenko 625b3918833SOleksandr Tymoshenko switch (bp->bio_cmd) { 626b3918833SOleksandr Tymoshenko case BIO_READ: 627*89a1585bSIan Lepore bp->bio_error = mx25l_read(sc, bp->bio_offset, 628b3918833SOleksandr Tymoshenko bp->bio_data, bp->bio_bcount); 629c3655ab0SOleksandr Tymoshenko break; 630b3918833SOleksandr Tymoshenko case BIO_WRITE: 631*89a1585bSIan Lepore bp->bio_error = mx25l_write(sc, bp->bio_offset, 632b3918833SOleksandr Tymoshenko bp->bio_data, bp->bio_bcount); 633b3918833SOleksandr Tymoshenko break; 634b3918833SOleksandr Tymoshenko default: 635cd5bdf03SOleksandr Tymoshenko bp->bio_error = EINVAL; 636b3918833SOleksandr Tymoshenko } 637cd5bdf03SOleksandr Tymoshenko 638c3655ab0SOleksandr Tymoshenko 639cd5bdf03SOleksandr Tymoshenko biodone(bp); 640cd5bdf03SOleksandr Tymoshenko } 641cd5bdf03SOleksandr Tymoshenko } 642cd5bdf03SOleksandr Tymoshenko 643cd5bdf03SOleksandr Tymoshenko static devclass_t mx25l_devclass; 644cd5bdf03SOleksandr Tymoshenko 645cd5bdf03SOleksandr Tymoshenko static device_method_t mx25l_methods[] = { 646cd5bdf03SOleksandr Tymoshenko /* Device interface */ 647cd5bdf03SOleksandr Tymoshenko DEVMETHOD(device_probe, mx25l_probe), 648cd5bdf03SOleksandr Tymoshenko DEVMETHOD(device_attach, mx25l_attach), 649cd5bdf03SOleksandr Tymoshenko DEVMETHOD(device_detach, mx25l_detach), 650cd5bdf03SOleksandr Tymoshenko 651cd5bdf03SOleksandr Tymoshenko { 0, 0 } 652cd5bdf03SOleksandr Tymoshenko }; 653cd5bdf03SOleksandr Tymoshenko 654cd5bdf03SOleksandr Tymoshenko static driver_t mx25l_driver = { 655cd5bdf03SOleksandr Tymoshenko "mx25l", 656cd5bdf03SOleksandr Tymoshenko mx25l_methods, 657cd5bdf03SOleksandr Tymoshenko sizeof(struct mx25l_softc), 658cd5bdf03SOleksandr Tymoshenko }; 659cd5bdf03SOleksandr Tymoshenko 660cd5bdf03SOleksandr Tymoshenko DRIVER_MODULE(mx25l, spibus, mx25l_driver, mx25l_devclass, 0, 0); 66142c52f36SIan Lepore MODULE_DEPEND(mx25l, spibus, 1, 1, 1); 662