1cd5bdf03SOleksandr Tymoshenko /*- 2718cf2ccSPedro F. Giffuni * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 3718cf2ccSPedro F. Giffuni * 4cd5bdf03SOleksandr Tymoshenko * Copyright (c) 2009 Oleksandr Tymoshenko. All rights reserved. 5d8920513SIan Lepore * Copyright (c) 2018 Ian Lepore. All rights reserved. 6f86e6000SWarner Losh * Copyright (c) 2006 M. Warner Losh <imp@FreeBSD.org> 7cd5bdf03SOleksandr Tymoshenko * 8cd5bdf03SOleksandr Tymoshenko * Redistribution and use in source and binary forms, with or without 9cd5bdf03SOleksandr Tymoshenko * modification, are permitted provided that the following conditions 10cd5bdf03SOleksandr Tymoshenko * are met: 11cd5bdf03SOleksandr Tymoshenko * 1. Redistributions of source code must retain the above copyright 12cd5bdf03SOleksandr Tymoshenko * notice, this list of conditions and the following disclaimer. 13cd5bdf03SOleksandr Tymoshenko * 2. Redistributions in binary form must reproduce the above copyright 14cd5bdf03SOleksandr Tymoshenko * notice, this list of conditions and the following disclaimer in the 15cd5bdf03SOleksandr Tymoshenko * documentation and/or other materials provided with the distribution. 16cd5bdf03SOleksandr Tymoshenko * 17cd5bdf03SOleksandr Tymoshenko * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 18cd5bdf03SOleksandr Tymoshenko * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 19cd5bdf03SOleksandr Tymoshenko * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 20cd5bdf03SOleksandr Tymoshenko * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 21cd5bdf03SOleksandr Tymoshenko * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 22cd5bdf03SOleksandr Tymoshenko * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 23cd5bdf03SOleksandr Tymoshenko * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 24cd5bdf03SOleksandr Tymoshenko * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 25cd5bdf03SOleksandr Tymoshenko * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 26cd5bdf03SOleksandr Tymoshenko * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 27cd5bdf03SOleksandr Tymoshenko */ 28cd5bdf03SOleksandr Tymoshenko 29cd5bdf03SOleksandr Tymoshenko #include <sys/cdefs.h> 30cd5bdf03SOleksandr Tymoshenko __FBSDID("$FreeBSD$"); 31cd5bdf03SOleksandr Tymoshenko 328f74c88aSLuiz Otavio O Souza #include "opt_platform.h" 338f74c88aSLuiz Otavio O Souza 34cd5bdf03SOleksandr Tymoshenko #include <sys/param.h> 35cd5bdf03SOleksandr Tymoshenko #include <sys/systm.h> 36cd5bdf03SOleksandr Tymoshenko #include <sys/bio.h> 37cd5bdf03SOleksandr Tymoshenko #include <sys/bus.h> 38cd5bdf03SOleksandr Tymoshenko #include <sys/conf.h> 39cd5bdf03SOleksandr Tymoshenko #include <sys/kernel.h> 40cd5bdf03SOleksandr Tymoshenko #include <sys/kthread.h> 41cd5bdf03SOleksandr Tymoshenko #include <sys/lock.h> 42cd5bdf03SOleksandr Tymoshenko #include <sys/mbuf.h> 43cd5bdf03SOleksandr Tymoshenko #include <sys/malloc.h> 44cd5bdf03SOleksandr Tymoshenko #include <sys/module.h> 45cd5bdf03SOleksandr Tymoshenko #include <sys/mutex.h> 46cd5bdf03SOleksandr Tymoshenko #include <geom/geom_disk.h> 47cd5bdf03SOleksandr Tymoshenko 488f74c88aSLuiz Otavio O Souza #ifdef FDT 498f74c88aSLuiz Otavio O Souza #include <dev/fdt/fdt_common.h> 508f74c88aSLuiz Otavio O Souza #include <dev/ofw/ofw_bus_subr.h> 518f74c88aSLuiz Otavio O Souza #include <dev/ofw/openfirm.h> 528f74c88aSLuiz Otavio O Souza #endif 538f74c88aSLuiz Otavio O Souza 54cd5bdf03SOleksandr Tymoshenko #include <dev/spibus/spi.h> 55cd5bdf03SOleksandr Tymoshenko #include "spibus_if.h" 56cd5bdf03SOleksandr Tymoshenko 57cd5bdf03SOleksandr Tymoshenko #include <dev/flash/mx25lreg.h> 58cd5bdf03SOleksandr Tymoshenko 59d2cf1fd5SAdrian Chadd #define FL_NONE 0x00 60d2cf1fd5SAdrian Chadd #define FL_ERASE_4K 0x01 61d2cf1fd5SAdrian Chadd #define FL_ERASE_32K 0x02 622d46b036SStanislav Galabov #define FL_ENABLE_4B_ADDR 0x04 632d46b036SStanislav Galabov #define FL_DISABLE_4B_ADDR 0x08 64d2cf1fd5SAdrian Chadd 65917721a4SAdrian Chadd /* 66917721a4SAdrian Chadd * Define the sectorsize to be a smaller size rather than the flash 67917721a4SAdrian Chadd * sector size. Trying to run FFS off of a 64k flash sector size 68917721a4SAdrian Chadd * results in a completely un-usable system. 69917721a4SAdrian Chadd */ 70917721a4SAdrian Chadd #define MX25L_SECTORSIZE 512 71917721a4SAdrian Chadd 72cd5bdf03SOleksandr Tymoshenko struct mx25l_flash_ident 73cd5bdf03SOleksandr Tymoshenko { 74cd5bdf03SOleksandr Tymoshenko const char *name; 75cd5bdf03SOleksandr Tymoshenko uint8_t manufacturer_id; 76cd5bdf03SOleksandr Tymoshenko uint16_t device_id; 77cd5bdf03SOleksandr Tymoshenko unsigned int sectorsize; 78cd5bdf03SOleksandr Tymoshenko unsigned int sectorcount; 79d2cf1fd5SAdrian Chadd unsigned int flags; 80cd5bdf03SOleksandr Tymoshenko }; 81cd5bdf03SOleksandr Tymoshenko 82cd5bdf03SOleksandr Tymoshenko struct mx25l_softc 83cd5bdf03SOleksandr Tymoshenko { 84cd5bdf03SOleksandr Tymoshenko device_t sc_dev; 8589a1585bSIan Lepore device_t sc_parent; 86cd5bdf03SOleksandr Tymoshenko uint8_t sc_manufacturer_id; 87cd5bdf03SOleksandr Tymoshenko uint16_t sc_device_id; 883c9af13cSIan Lepore unsigned int sc_erasesize; 89cd5bdf03SOleksandr Tymoshenko struct mtx sc_mtx; 90cd5bdf03SOleksandr Tymoshenko struct disk *sc_disk; 91cd5bdf03SOleksandr Tymoshenko struct proc *sc_p; 92cd5bdf03SOleksandr Tymoshenko struct bio_queue_head sc_bio_queue; 9362c3a412SAdrian Chadd unsigned int sc_flags; 94aae18dccSIan Lepore unsigned int sc_taskstate; 95dac94adbSIan Lepore uint8_t sc_dummybuf[FLASH_PAGE_SIZE]; 96cd5bdf03SOleksandr Tymoshenko }; 97cd5bdf03SOleksandr Tymoshenko 98aae18dccSIan Lepore #define TSTATE_STOPPED 0 99aae18dccSIan Lepore #define TSTATE_STOPPING 1 100aae18dccSIan Lepore #define TSTATE_RUNNING 2 101aae18dccSIan Lepore 102cd5bdf03SOleksandr Tymoshenko #define M25PXX_LOCK(_sc) mtx_lock(&(_sc)->sc_mtx) 103cd5bdf03SOleksandr Tymoshenko #define M25PXX_UNLOCK(_sc) mtx_unlock(&(_sc)->sc_mtx) 104cd5bdf03SOleksandr Tymoshenko #define M25PXX_LOCK_INIT(_sc) \ 105cd5bdf03SOleksandr Tymoshenko mtx_init(&_sc->sc_mtx, device_get_nameunit(_sc->sc_dev), \ 106cd5bdf03SOleksandr Tymoshenko "mx25l", MTX_DEF) 107cd5bdf03SOleksandr Tymoshenko #define M25PXX_LOCK_DESTROY(_sc) mtx_destroy(&_sc->sc_mtx); 108cd5bdf03SOleksandr Tymoshenko #define M25PXX_ASSERT_LOCKED(_sc) mtx_assert(&_sc->sc_mtx, MA_OWNED); 109cd5bdf03SOleksandr Tymoshenko #define M25PXX_ASSERT_UNLOCKED(_sc) mtx_assert(&_sc->sc_mtx, MA_NOTOWNED); 110cd5bdf03SOleksandr Tymoshenko 111cd5bdf03SOleksandr Tymoshenko /* disk routines */ 112cd5bdf03SOleksandr Tymoshenko static int mx25l_open(struct disk *dp); 113cd5bdf03SOleksandr Tymoshenko static int mx25l_close(struct disk *dp); 114cd5bdf03SOleksandr Tymoshenko static int mx25l_ioctl(struct disk *, u_long, void *, int, struct thread *); 115cd5bdf03SOleksandr Tymoshenko static void mx25l_strategy(struct bio *bp); 1161b468038SAdrian Chadd static int mx25l_getattr(struct bio *bp); 117cd5bdf03SOleksandr Tymoshenko static void mx25l_task(void *arg); 118cd5bdf03SOleksandr Tymoshenko 1196dfd0500SIan Lepore static struct mx25l_flash_ident flash_devices[] = { 120869785b4SAleksandr Rybalko { "en25f32", 0x1c, 0x3116, 64 * 1024, 64, FL_NONE }, 121869785b4SAleksandr Rybalko { "en25p32", 0x1c, 0x2016, 64 * 1024, 64, FL_NONE }, 122869785b4SAleksandr Rybalko { "en25p64", 0x1c, 0x2017, 64 * 1024, 128, FL_NONE }, 1232f57841eSAdrian Chadd { "en25q32", 0x1c, 0x3016, 64 * 1024, 64, FL_NONE }, 124869785b4SAleksandr Rybalko { "en25q64", 0x1c, 0x3017, 64 * 1024, 128, FL_ERASE_4K }, 1252f57841eSAdrian Chadd { "m25p32", 0x20, 0x2016, 64 * 1024, 64, FL_NONE }, 126a565668bSAdrian Chadd { "m25p64", 0x20, 0x2017, 64 * 1024, 128, FL_NONE }, 127bb5125a4SEmmanuel Vadot { "mx25l1606e", 0xc2, 0x2015, 64 * 1024, 32, FL_ERASE_4K}, 128869785b4SAleksandr Rybalko { "mx25ll32", 0xc2, 0x2016, 64 * 1024, 64, FL_NONE }, 129d2cf1fd5SAdrian Chadd { "mx25ll64", 0xc2, 0x2017, 64 * 1024, 128, FL_NONE }, 130d2cf1fd5SAdrian Chadd { "mx25ll128", 0xc2, 0x2018, 64 * 1024, 256, FL_ERASE_4K | FL_ERASE_32K }, 1312d46b036SStanislav Galabov { "mx25ll256", 0xc2, 0x2019, 64 * 1024, 512, FL_ERASE_4K | FL_ERASE_32K | FL_ENABLE_4B_ADDR }, 132c6905524SLuiz Otavio O Souza { "s25fl032", 0x01, 0x0215, 64 * 1024, 64, FL_NONE }, 133c6905524SLuiz Otavio O Souza { "s25fl064", 0x01, 0x0216, 64 * 1024, 128, FL_NONE }, 134d2cf1fd5SAdrian Chadd { "s25fl128", 0x01, 0x2018, 64 * 1024, 256, FL_NONE }, 1354a4ae982SAdrian Chadd { "s25fl256s", 0x01, 0x0219, 64 * 1024, 512, FL_NONE }, 136fa68dcb1SJustin Hibbits { "SST25VF010A", 0xbf, 0x2549, 4 * 1024, 32, FL_ERASE_4K | FL_ERASE_32K }, 137869785b4SAleksandr Rybalko { "SST25VF032B", 0xbf, 0x254a, 64 * 1024, 64, FL_ERASE_4K | FL_ERASE_32K }, 13870234acbSAdrian Chadd 13970234acbSAdrian Chadd /* Winbond -- w25x "blocks" are 64K, "sectors" are 4KiB */ 14070234acbSAdrian Chadd { "w25x32", 0xef, 0x3016, 64 * 1024, 64, FL_ERASE_4K }, 14140424a25SAdrian Chadd { "w25x64", 0xef, 0x3017, 64 * 1024, 128, FL_ERASE_4K }, 142869785b4SAleksandr Rybalko { "w25q32", 0xef, 0x4016, 64 * 1024, 64, FL_ERASE_4K }, 143869785b4SAleksandr Rybalko { "w25q64", 0xef, 0x4017, 64 * 1024, 128, FL_ERASE_4K }, 144450a186cSAdrian Chadd { "w25q64bv", 0xef, 0x4017, 64 * 1024, 128, FL_ERASE_4K }, 14570234acbSAdrian Chadd { "w25q128", 0xef, 0x4018, 64 * 1024, 256, FL_ERASE_4K }, 14670234acbSAdrian Chadd { "w25q256", 0xef, 0x4019, 64 * 1024, 512, FL_ERASE_4K }, 147fe56b741SBaptiste Daroussin 148fe56b741SBaptiste Daroussin /* Atmel */ 149fe56b741SBaptiste Daroussin { "at25df641", 0x1f, 0x4800, 64 * 1024, 128, FL_ERASE_4K }, 150303c3562SAdrian Chadd 151303c3562SAdrian Chadd /* GigaDevice */ 152303c3562SAdrian Chadd { "gd25q64", 0xc8, 0x4017, 64 * 1024, 128, FL_ERASE_4K }, 153d1ecd3acSEmmanuel Vadot { "gd25q128", 0xc8, 0x4018, 64 * 1024, 256, FL_ERASE_4K }, 154cd5bdf03SOleksandr Tymoshenko }; 155cd5bdf03SOleksandr Tymoshenko 156c03ab159SIan Lepore static int 157c03ab159SIan Lepore mx25l_wait_for_device_ready(struct mx25l_softc *sc) 158cd5bdf03SOleksandr Tymoshenko { 159cd5bdf03SOleksandr Tymoshenko uint8_t txBuf[2], rxBuf[2]; 160cd5bdf03SOleksandr Tymoshenko struct spi_command cmd; 161cd5bdf03SOleksandr Tymoshenko int err; 162cd5bdf03SOleksandr Tymoshenko 163cd5bdf03SOleksandr Tymoshenko memset(&cmd, 0, sizeof(cmd)); 164cd5bdf03SOleksandr Tymoshenko 165c03ab159SIan Lepore do { 166cd5bdf03SOleksandr Tymoshenko txBuf[0] = CMD_READ_STATUS; 167cd5bdf03SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 168cd5bdf03SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 169cd5bdf03SOleksandr Tymoshenko cmd.rx_cmd_sz = 2; 170cd5bdf03SOleksandr Tymoshenko cmd.tx_cmd_sz = 2; 17189a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 172c03ab159SIan Lepore } while (err == 0 && (rxBuf[1] & STATUS_WIP)); 173cd5bdf03SOleksandr Tymoshenko 174c03ab159SIan Lepore return (err); 175cd5bdf03SOleksandr Tymoshenko } 176cd5bdf03SOleksandr Tymoshenko 177cd5bdf03SOleksandr Tymoshenko static struct mx25l_flash_ident* 178cd5bdf03SOleksandr Tymoshenko mx25l_get_device_ident(struct mx25l_softc *sc) 179cd5bdf03SOleksandr Tymoshenko { 180cd5bdf03SOleksandr Tymoshenko uint8_t txBuf[8], rxBuf[8]; 181cd5bdf03SOleksandr Tymoshenko struct spi_command cmd; 182cd5bdf03SOleksandr Tymoshenko uint8_t manufacturer_id; 183cd5bdf03SOleksandr Tymoshenko uint16_t dev_id; 184cd5bdf03SOleksandr Tymoshenko int err, i; 185cd5bdf03SOleksandr Tymoshenko 186cd5bdf03SOleksandr Tymoshenko memset(&cmd, 0, sizeof(cmd)); 187cd5bdf03SOleksandr Tymoshenko memset(txBuf, 0, sizeof(txBuf)); 188cd5bdf03SOleksandr Tymoshenko memset(rxBuf, 0, sizeof(rxBuf)); 189cd5bdf03SOleksandr Tymoshenko 190cd5bdf03SOleksandr Tymoshenko txBuf[0] = CMD_READ_IDENT; 191cd5bdf03SOleksandr Tymoshenko cmd.tx_cmd = &txBuf; 192cd5bdf03SOleksandr Tymoshenko cmd.rx_cmd = &rxBuf; 193cd5bdf03SOleksandr Tymoshenko /* 194cd5bdf03SOleksandr Tymoshenko * Some compatible devices has extended two-bytes ID 195cd5bdf03SOleksandr Tymoshenko * We'll use only manufacturer/deviceid atm 196cd5bdf03SOleksandr Tymoshenko */ 197cd5bdf03SOleksandr Tymoshenko cmd.tx_cmd_sz = 4; 198cd5bdf03SOleksandr Tymoshenko cmd.rx_cmd_sz = 4; 19989a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 200cd5bdf03SOleksandr Tymoshenko if (err) 201cd5bdf03SOleksandr Tymoshenko return (NULL); 202cd5bdf03SOleksandr Tymoshenko 203cd5bdf03SOleksandr Tymoshenko manufacturer_id = rxBuf[1]; 204cd5bdf03SOleksandr Tymoshenko dev_id = (rxBuf[2] << 8) | (rxBuf[3]); 205cd5bdf03SOleksandr Tymoshenko 206c03ab159SIan Lepore for (i = 0; i < nitems(flash_devices); i++) { 207cd5bdf03SOleksandr Tymoshenko if ((flash_devices[i].manufacturer_id == manufacturer_id) && 208cd5bdf03SOleksandr Tymoshenko (flash_devices[i].device_id == dev_id)) 209cd5bdf03SOleksandr Tymoshenko return &flash_devices[i]; 210cd5bdf03SOleksandr Tymoshenko } 211cd5bdf03SOleksandr Tymoshenko 21289a1585bSIan Lepore device_printf(sc->sc_dev, 21389a1585bSIan Lepore "Unknown SPI flash device. Vendor: %02x, device id: %04x\n", 214cd5bdf03SOleksandr Tymoshenko manufacturer_id, dev_id); 215cd5bdf03SOleksandr Tymoshenko return (NULL); 216cd5bdf03SOleksandr Tymoshenko } 217cd5bdf03SOleksandr Tymoshenko 218c03ab159SIan Lepore static int 21989a1585bSIan Lepore mx25l_set_writable(struct mx25l_softc *sc, int writable) 220c3655ab0SOleksandr Tymoshenko { 221c3655ab0SOleksandr Tymoshenko uint8_t txBuf[1], rxBuf[1]; 222c3655ab0SOleksandr Tymoshenko struct spi_command cmd; 223c3655ab0SOleksandr Tymoshenko int err; 224c3655ab0SOleksandr Tymoshenko 225c3655ab0SOleksandr Tymoshenko memset(&cmd, 0, sizeof(cmd)); 226c3655ab0SOleksandr Tymoshenko memset(txBuf, 0, sizeof(txBuf)); 227c3655ab0SOleksandr Tymoshenko memset(rxBuf, 0, sizeof(rxBuf)); 228c3655ab0SOleksandr Tymoshenko 229c3655ab0SOleksandr Tymoshenko txBuf[0] = writable ? CMD_WRITE_ENABLE : CMD_WRITE_DISABLE; 230c3655ab0SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 231c3655ab0SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 232c3655ab0SOleksandr Tymoshenko cmd.rx_cmd_sz = 1; 233c3655ab0SOleksandr Tymoshenko cmd.tx_cmd_sz = 1; 23489a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 235c03ab159SIan Lepore return (err); 236c3655ab0SOleksandr Tymoshenko } 237c3655ab0SOleksandr Tymoshenko 238c03ab159SIan Lepore static int 2393c9af13cSIan Lepore mx25l_erase_cmd(struct mx25l_softc *sc, off_t sector) 240c3655ab0SOleksandr Tymoshenko { 2412d46b036SStanislav Galabov uint8_t txBuf[5], rxBuf[5]; 242c3655ab0SOleksandr Tymoshenko struct spi_command cmd; 243c3655ab0SOleksandr Tymoshenko int err; 244c3655ab0SOleksandr Tymoshenko 245c03ab159SIan Lepore if ((err = mx25l_set_writable(sc, 1)) != 0) 246c03ab159SIan Lepore return (err); 247c3655ab0SOleksandr Tymoshenko 248c3655ab0SOleksandr Tymoshenko memset(&cmd, 0, sizeof(cmd)); 249c3655ab0SOleksandr Tymoshenko memset(txBuf, 0, sizeof(txBuf)); 250c3655ab0SOleksandr Tymoshenko memset(rxBuf, 0, sizeof(rxBuf)); 251c3655ab0SOleksandr Tymoshenko 252c3655ab0SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 253c3655ab0SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 2543c9af13cSIan Lepore 2553c9af13cSIan Lepore if (sc->sc_flags & FL_ERASE_4K) 2563c9af13cSIan Lepore txBuf[0] = CMD_BLOCK_4K_ERASE; 2573c9af13cSIan Lepore else if (sc->sc_flags & FL_ERASE_32K) 2583c9af13cSIan Lepore txBuf[0] = CMD_BLOCK_32K_ERASE; 2593c9af13cSIan Lepore else 2603c9af13cSIan Lepore txBuf[0] = CMD_SECTOR_ERASE; 2613c9af13cSIan Lepore 2622d46b036SStanislav Galabov if (sc->sc_flags & FL_ENABLE_4B_ADDR) { 2632d46b036SStanislav Galabov cmd.rx_cmd_sz = 5; 2642d46b036SStanislav Galabov cmd.tx_cmd_sz = 5; 2652d46b036SStanislav Galabov txBuf[1] = ((sector >> 24) & 0xff); 2662d46b036SStanislav Galabov txBuf[2] = ((sector >> 16) & 0xff); 2672d46b036SStanislav Galabov txBuf[3] = ((sector >> 8) & 0xff); 2682d46b036SStanislav Galabov txBuf[4] = (sector & 0xff); 2692d46b036SStanislav Galabov } else { 270c3655ab0SOleksandr Tymoshenko cmd.rx_cmd_sz = 4; 271c3655ab0SOleksandr Tymoshenko cmd.tx_cmd_sz = 4; 272c3655ab0SOleksandr Tymoshenko txBuf[1] = ((sector >> 16) & 0xff); 273c3655ab0SOleksandr Tymoshenko txBuf[2] = ((sector >> 8) & 0xff); 274c3655ab0SOleksandr Tymoshenko txBuf[3] = (sector & 0xff); 2752d46b036SStanislav Galabov } 276c03ab159SIan Lepore if ((err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd)) != 0) 277c03ab159SIan Lepore return (err); 278c03ab159SIan Lepore err = mx25l_wait_for_device_ready(sc); 279c03ab159SIan Lepore return (err); 280c3655ab0SOleksandr Tymoshenko } 281c3655ab0SOleksandr Tymoshenko 282cd5bdf03SOleksandr Tymoshenko static int 28389a1585bSIan Lepore mx25l_write(struct mx25l_softc *sc, off_t offset, caddr_t data, off_t count) 284b3918833SOleksandr Tymoshenko { 285b3918833SOleksandr Tymoshenko uint8_t txBuf[8], rxBuf[8]; 286b3918833SOleksandr Tymoshenko struct spi_command cmd; 28719aa9f71SIan Lepore off_t bytes_to_write; 288b3918833SOleksandr Tymoshenko int err = 0; 289b3918833SOleksandr Tymoshenko 2902d46b036SStanislav Galabov if (sc->sc_flags & FL_ENABLE_4B_ADDR) { 2912d46b036SStanislav Galabov cmd.tx_cmd_sz = 5; 2922d46b036SStanislav Galabov cmd.rx_cmd_sz = 5; 2932d46b036SStanislav Galabov } else { 294b3918833SOleksandr Tymoshenko cmd.tx_cmd_sz = 4; 295b3918833SOleksandr Tymoshenko cmd.rx_cmd_sz = 4; 2962d46b036SStanislav Galabov } 297b3918833SOleksandr Tymoshenko 298b3918833SOleksandr Tymoshenko /* 299f432eb7eSIan Lepore * Writes must be aligned to the erase sectorsize, since blocks are 300f432eb7eSIan Lepore * fully erased before they're written to. 301b3918833SOleksandr Tymoshenko */ 3023c9af13cSIan Lepore if (count % sc->sc_erasesize != 0 || offset % sc->sc_erasesize != 0) 303917721a4SAdrian Chadd return (EIO); 304b3918833SOleksandr Tymoshenko 305b3918833SOleksandr Tymoshenko /* 30619aa9f71SIan Lepore * Maximum write size for CMD_PAGE_PROGRAM is FLASH_PAGE_SIZE, so loop 30719aa9f71SIan Lepore * to write chunks of FLASH_PAGE_SIZE bytes each. 308b3918833SOleksandr Tymoshenko */ 30919aa9f71SIan Lepore while (count != 0) { 31019aa9f71SIan Lepore /* If we crossed a sector boundary, erase the next sector. */ 3113c9af13cSIan Lepore if (((offset) % sc->sc_erasesize) == 0) { 3123c9af13cSIan Lepore err = mx25l_erase_cmd(sc, offset); 313c03ab159SIan Lepore if (err) 314c03ab159SIan Lepore break; 315c03ab159SIan Lepore } 316b3918833SOleksandr Tymoshenko 317b3918833SOleksandr Tymoshenko txBuf[0] = CMD_PAGE_PROGRAM; 3182d46b036SStanislav Galabov if (sc->sc_flags & FL_ENABLE_4B_ADDR) { 31919aa9f71SIan Lepore txBuf[1] = (offset >> 24) & 0xff; 32019aa9f71SIan Lepore txBuf[2] = (offset >> 16) & 0xff; 32119aa9f71SIan Lepore txBuf[3] = (offset >> 8) & 0xff; 32219aa9f71SIan Lepore txBuf[4] = offset & 0xff; 3232d46b036SStanislav Galabov } else { 32419aa9f71SIan Lepore txBuf[1] = (offset >> 16) & 0xff; 32519aa9f71SIan Lepore txBuf[2] = (offset >> 8) & 0xff; 32619aa9f71SIan Lepore txBuf[3] = offset & 0xff; 3272d46b036SStanislav Galabov } 328b3918833SOleksandr Tymoshenko 32919aa9f71SIan Lepore bytes_to_write = MIN(FLASH_PAGE_SIZE, count); 330b3918833SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 331b3918833SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 33219aa9f71SIan Lepore cmd.tx_data = data; 333dac94adbSIan Lepore cmd.rx_data = sc->sc_dummybuf; 33419aa9f71SIan Lepore cmd.tx_data_sz = (uint32_t)bytes_to_write; 33519aa9f71SIan Lepore cmd.rx_data_sz = (uint32_t)bytes_to_write; 336b3918833SOleksandr Tymoshenko 337b3918833SOleksandr Tymoshenko /* 33819aa9f71SIan Lepore * Each completed write operation resets WEL (write enable 33919aa9f71SIan Lepore * latch) to disabled state, so we re-enable it here. 340b3918833SOleksandr Tymoshenko */ 341c03ab159SIan Lepore if ((err = mx25l_wait_for_device_ready(sc)) != 0) 342c03ab159SIan Lepore break; 343c03ab159SIan Lepore if ((err = mx25l_set_writable(sc, 1)) != 0) 344c03ab159SIan Lepore break; 345b3918833SOleksandr Tymoshenko 34689a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 347c03ab159SIan Lepore if (err != 0) 348c03ab159SIan Lepore break; 349c03ab159SIan Lepore err = mx25l_wait_for_device_ready(sc); 350b3918833SOleksandr Tymoshenko if (err) 351b3918833SOleksandr Tymoshenko break; 352b3918833SOleksandr Tymoshenko 35319aa9f71SIan Lepore data += bytes_to_write; 35419aa9f71SIan Lepore offset += bytes_to_write; 35519aa9f71SIan Lepore count -= bytes_to_write; 356b3918833SOleksandr Tymoshenko } 357b3918833SOleksandr Tymoshenko 358b3918833SOleksandr Tymoshenko return (err); 359b3918833SOleksandr Tymoshenko } 360b3918833SOleksandr Tymoshenko 361b3918833SOleksandr Tymoshenko static int 36289a1585bSIan Lepore mx25l_read(struct mx25l_softc *sc, off_t offset, caddr_t data, off_t count) 363b3918833SOleksandr Tymoshenko { 364b3918833SOleksandr Tymoshenko uint8_t txBuf[8], rxBuf[8]; 365b3918833SOleksandr Tymoshenko struct spi_command cmd; 366b3918833SOleksandr Tymoshenko int err = 0; 367b3918833SOleksandr Tymoshenko 368b3918833SOleksandr Tymoshenko /* 36919aa9f71SIan Lepore * Enforce that reads are aligned to the disk sectorsize, not the 37019aa9f71SIan Lepore * erase sectorsize. In this way, smaller read IO is possible, 37119aa9f71SIan Lepore * dramatically speeding up filesystem/geom_compress access. 372b3918833SOleksandr Tymoshenko */ 37319aa9f71SIan Lepore if (count % sc->sc_disk->d_sectorsize != 0 || 37419aa9f71SIan Lepore offset % sc->sc_disk->d_sectorsize != 0) 375917721a4SAdrian Chadd return (EIO); 376b3918833SOleksandr Tymoshenko 377b3918833SOleksandr Tymoshenko txBuf[0] = CMD_FAST_READ; 3782d46b036SStanislav Galabov if (sc->sc_flags & FL_ENABLE_4B_ADDR) { 3792d46b036SStanislav Galabov cmd.tx_cmd_sz = 6; 3802d46b036SStanislav Galabov cmd.rx_cmd_sz = 6; 3812d46b036SStanislav Galabov 38219aa9f71SIan Lepore txBuf[1] = (offset >> 24) & 0xff; 38319aa9f71SIan Lepore txBuf[2] = (offset >> 16) & 0xff; 38419aa9f71SIan Lepore txBuf[3] = (offset >> 8) & 0xff; 38519aa9f71SIan Lepore txBuf[4] = offset & 0xff; 3862d46b036SStanislav Galabov /* Dummy byte */ 3872d46b036SStanislav Galabov txBuf[5] = 0; 3882d46b036SStanislav Galabov } else { 389b3918833SOleksandr Tymoshenko cmd.tx_cmd_sz = 5; 390b3918833SOleksandr Tymoshenko cmd.rx_cmd_sz = 5; 391b3918833SOleksandr Tymoshenko 39219aa9f71SIan Lepore txBuf[1] = (offset >> 16) & 0xff; 39319aa9f71SIan Lepore txBuf[2] = (offset >> 8) & 0xff; 39419aa9f71SIan Lepore txBuf[3] = offset & 0xff; 395b3918833SOleksandr Tymoshenko /* Dummy byte */ 396b3918833SOleksandr Tymoshenko txBuf[4] = 0; 3972d46b036SStanislav Galabov } 398b3918833SOleksandr Tymoshenko 399b3918833SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 400b3918833SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 401b3918833SOleksandr Tymoshenko cmd.tx_data = data; 402b3918833SOleksandr Tymoshenko cmd.rx_data = data; 40319aa9f71SIan Lepore cmd.tx_data_sz = count; 404b3918833SOleksandr Tymoshenko cmd.rx_data_sz = count; 405b3918833SOleksandr Tymoshenko 40689a1585bSIan Lepore err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd); 407b3918833SOleksandr Tymoshenko return (err); 408b3918833SOleksandr Tymoshenko } 409b3918833SOleksandr Tymoshenko 410b3918833SOleksandr Tymoshenko static int 41189a1585bSIan Lepore mx25l_set_4b_mode(struct mx25l_softc *sc, uint8_t command) 4122d46b036SStanislav Galabov { 4132d46b036SStanislav Galabov uint8_t txBuf[1], rxBuf[1]; 4142d46b036SStanislav Galabov struct spi_command cmd; 4152d46b036SStanislav Galabov int err; 4162d46b036SStanislav Galabov 4172d46b036SStanislav Galabov memset(&cmd, 0, sizeof(cmd)); 4182d46b036SStanislav Galabov memset(txBuf, 0, sizeof(txBuf)); 4192d46b036SStanislav Galabov memset(rxBuf, 0, sizeof(rxBuf)); 4202d46b036SStanislav Galabov 4212d46b036SStanislav Galabov cmd.tx_cmd_sz = cmd.rx_cmd_sz = 1; 4222d46b036SStanislav Galabov 4232d46b036SStanislav Galabov cmd.tx_cmd = txBuf; 4242d46b036SStanislav Galabov cmd.rx_cmd = rxBuf; 4252d46b036SStanislav Galabov 4262d46b036SStanislav Galabov txBuf[0] = command; 4272d46b036SStanislav Galabov 428c03ab159SIan Lepore if ((err = SPIBUS_TRANSFER(sc->sc_parent, sc->sc_dev, &cmd)) == 0) 429c03ab159SIan Lepore err = mx25l_wait_for_device_ready(sc); 4302d46b036SStanislav Galabov 4312d46b036SStanislav Galabov return (err); 4322d46b036SStanislav Galabov } 4332d46b036SStanislav Galabov 43475b3cfd2SAdrian Chadd #ifdef FDT 4351173c206SStanislav Galabov static struct ofw_compat_data compat_data[] = { 4361173c206SStanislav Galabov { "st,m25p", 1 }, 4371173c206SStanislav Galabov { "jedec,spi-nor", 1 }, 4381173c206SStanislav Galabov { NULL, 0 }, 4391173c206SStanislav Galabov }; 44075b3cfd2SAdrian Chadd #endif 4411173c206SStanislav Galabov 4422d46b036SStanislav Galabov static int 443cd5bdf03SOleksandr Tymoshenko mx25l_probe(device_t dev) 444cd5bdf03SOleksandr Tymoshenko { 4458f74c88aSLuiz Otavio O Souza #ifdef FDT 446009e872eSStanislav Galabov int i; 447009e872eSStanislav Galabov 4488f74c88aSLuiz Otavio O Souza if (!ofw_bus_status_okay(dev)) 4498f74c88aSLuiz Otavio O Souza return (ENXIO); 450009e872eSStanislav Galabov 451009e872eSStanislav Galabov /* First try to match the compatible property to the compat_data */ 452009e872eSStanislav Galabov if (ofw_bus_search_compatible(dev, compat_data)->ocd_data == 1) 453009e872eSStanislav Galabov goto found; 454009e872eSStanislav Galabov 455009e872eSStanislav Galabov /* 456009e872eSStanislav Galabov * Next, try to find a compatible device using the names in the 457009e872eSStanislav Galabov * flash_devices structure 458009e872eSStanislav Galabov */ 459009e872eSStanislav Galabov for (i = 0; i < nitems(flash_devices); i++) 460009e872eSStanislav Galabov if (ofw_bus_is_compatible(dev, flash_devices[i].name)) 461009e872eSStanislav Galabov goto found; 462009e872eSStanislav Galabov 4638f74c88aSLuiz Otavio O Souza return (ENXIO); 464009e872eSStanislav Galabov found: 4658f74c88aSLuiz Otavio O Souza #endif 466cd5bdf03SOleksandr Tymoshenko device_set_desc(dev, "M25Pxx Flash Family"); 4678f74c88aSLuiz Otavio O Souza 468cd5bdf03SOleksandr Tymoshenko return (0); 469cd5bdf03SOleksandr Tymoshenko } 470cd5bdf03SOleksandr Tymoshenko 471cd5bdf03SOleksandr Tymoshenko static int 472cd5bdf03SOleksandr Tymoshenko mx25l_attach(device_t dev) 473cd5bdf03SOleksandr Tymoshenko { 474cd5bdf03SOleksandr Tymoshenko struct mx25l_softc *sc; 475cd5bdf03SOleksandr Tymoshenko struct mx25l_flash_ident *ident; 476c03ab159SIan Lepore int err; 477cd5bdf03SOleksandr Tymoshenko 478cd5bdf03SOleksandr Tymoshenko sc = device_get_softc(dev); 479cd5bdf03SOleksandr Tymoshenko sc->sc_dev = dev; 48089a1585bSIan Lepore sc->sc_parent = device_get_parent(sc->sc_dev); 48189a1585bSIan Lepore 482cd5bdf03SOleksandr Tymoshenko M25PXX_LOCK_INIT(sc); 483cd5bdf03SOleksandr Tymoshenko 484cd5bdf03SOleksandr Tymoshenko ident = mx25l_get_device_ident(sc); 485cd5bdf03SOleksandr Tymoshenko if (ident == NULL) 486cd5bdf03SOleksandr Tymoshenko return (ENXIO); 487cd5bdf03SOleksandr Tymoshenko 488c03ab159SIan Lepore if ((err = mx25l_wait_for_device_ready(sc)) != 0) 489c03ab159SIan Lepore return (err); 490c03ab159SIan Lepore 4913c9af13cSIan Lepore sc->sc_flags = ident->flags; 4923c9af13cSIan Lepore 4933c9af13cSIan Lepore if (sc->sc_flags & FL_ERASE_4K) 4943c9af13cSIan Lepore sc->sc_erasesize = 4 * 1024; 4953c9af13cSIan Lepore else if (sc->sc_flags & FL_ERASE_32K) 4963c9af13cSIan Lepore sc->sc_erasesize = 32 * 1024; 4973c9af13cSIan Lepore else 4983c9af13cSIan Lepore sc->sc_erasesize = ident->sectorsize; 4993c9af13cSIan Lepore 500c03ab159SIan Lepore if (sc->sc_flags & FL_ENABLE_4B_ADDR) { 501c03ab159SIan Lepore if ((err = mx25l_set_4b_mode(sc, CMD_ENTER_4B_MODE)) != 0) 502c03ab159SIan Lepore return (err); 503c03ab159SIan Lepore } else if (sc->sc_flags & FL_DISABLE_4B_ADDR) { 504c03ab159SIan Lepore if ((err = mx25l_set_4b_mode(sc, CMD_EXIT_4B_MODE)) != 0) 505c03ab159SIan Lepore return (err); 506c03ab159SIan Lepore } 507cd5bdf03SOleksandr Tymoshenko 508cd5bdf03SOleksandr Tymoshenko sc->sc_disk = disk_alloc(); 509cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_open = mx25l_open; 510cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_close = mx25l_close; 511cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_strategy = mx25l_strategy; 5121b468038SAdrian Chadd sc->sc_disk->d_getattr = mx25l_getattr; 513cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_ioctl = mx25l_ioctl; 51468dd7795SIan Lepore sc->sc_disk->d_name = "flash/spi"; 515cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_drv1 = sc; 516cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_maxsize = DFLTPHYS; 517917721a4SAdrian Chadd sc->sc_disk->d_sectorsize = MX25L_SECTORSIZE; 518cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_mediasize = ident->sectorsize * ident->sectorcount; 5193c9af13cSIan Lepore sc->sc_disk->d_stripesize = sc->sc_erasesize; 520cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_unit = device_get_unit(sc->sc_dev); 521cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_dump = NULL; /* NB: no dumps */ 522d8920513SIan Lepore strlcpy(sc->sc_disk->d_descr, ident->name, 523d8920513SIan Lepore sizeof(sc->sc_disk->d_descr)); 524cd5bdf03SOleksandr Tymoshenko 525cd5bdf03SOleksandr Tymoshenko disk_create(sc->sc_disk, DISK_VERSION); 526cd5bdf03SOleksandr Tymoshenko bioq_init(&sc->sc_bio_queue); 527cd5bdf03SOleksandr Tymoshenko 528cd5bdf03SOleksandr Tymoshenko kproc_create(&mx25l_task, sc, &sc->sc_p, 0, 0, "task: mx25l flash"); 529aae18dccSIan Lepore sc->sc_taskstate = TSTATE_RUNNING; 530aae18dccSIan Lepore 531d8920513SIan Lepore device_printf(sc->sc_dev, 532d8920513SIan Lepore "device type %s, size %dK in %d sectors of %dK, erase size %dK\n", 533d8920513SIan Lepore ident->name, 534d8920513SIan Lepore ident->sectorcount * ident->sectorsize / 1024, 535d8920513SIan Lepore ident->sectorcount, ident->sectorsize / 1024, 536d8920513SIan Lepore sc->sc_erasesize / 1024); 537cd5bdf03SOleksandr Tymoshenko 538cd5bdf03SOleksandr Tymoshenko return (0); 539cd5bdf03SOleksandr Tymoshenko } 540cd5bdf03SOleksandr Tymoshenko 541cd5bdf03SOleksandr Tymoshenko static int 542cd5bdf03SOleksandr Tymoshenko mx25l_detach(device_t dev) 543cd5bdf03SOleksandr Tymoshenko { 544aae18dccSIan Lepore struct mx25l_softc *sc; 545aae18dccSIan Lepore int err; 546cd5bdf03SOleksandr Tymoshenko 547aae18dccSIan Lepore sc = device_get_softc(dev); 548aae18dccSIan Lepore err = 0; 549aae18dccSIan Lepore 550aae18dccSIan Lepore M25PXX_LOCK(sc); 551aae18dccSIan Lepore if (sc->sc_taskstate == TSTATE_RUNNING) { 552aae18dccSIan Lepore sc->sc_taskstate = TSTATE_STOPPING; 553aae18dccSIan Lepore wakeup(sc); 554aae18dccSIan Lepore while (err == 0 && sc->sc_taskstate != TSTATE_STOPPED) { 555aae18dccSIan Lepore err = msleep(sc, &sc->sc_mtx, 0, "mx25dt", hz * 3); 556aae18dccSIan Lepore if (err != 0) { 557aae18dccSIan Lepore sc->sc_taskstate = TSTATE_RUNNING; 55889a1585bSIan Lepore device_printf(sc->sc_dev, 559aae18dccSIan Lepore "Failed to stop queue task\n"); 560aae18dccSIan Lepore } 561aae18dccSIan Lepore } 562aae18dccSIan Lepore } 563aae18dccSIan Lepore M25PXX_UNLOCK(sc); 564aae18dccSIan Lepore 565aae18dccSIan Lepore if (err == 0 && sc->sc_taskstate == TSTATE_STOPPED) { 566aae18dccSIan Lepore disk_destroy(sc->sc_disk); 567aae18dccSIan Lepore bioq_flush(&sc->sc_bio_queue, NULL, ENXIO); 568aae18dccSIan Lepore M25PXX_LOCK_DESTROY(sc); 569aae18dccSIan Lepore } 570aae18dccSIan Lepore return (err); 571cd5bdf03SOleksandr Tymoshenko } 572cd5bdf03SOleksandr Tymoshenko 573cd5bdf03SOleksandr Tymoshenko static int 574cd5bdf03SOleksandr Tymoshenko mx25l_open(struct disk *dp) 575cd5bdf03SOleksandr Tymoshenko { 576cd5bdf03SOleksandr Tymoshenko return (0); 577cd5bdf03SOleksandr Tymoshenko } 578cd5bdf03SOleksandr Tymoshenko 579cd5bdf03SOleksandr Tymoshenko static int 580cd5bdf03SOleksandr Tymoshenko mx25l_close(struct disk *dp) 581cd5bdf03SOleksandr Tymoshenko { 582cd5bdf03SOleksandr Tymoshenko 583cd5bdf03SOleksandr Tymoshenko return (0); 584cd5bdf03SOleksandr Tymoshenko } 585cd5bdf03SOleksandr Tymoshenko 586cd5bdf03SOleksandr Tymoshenko static int 587cd5bdf03SOleksandr Tymoshenko mx25l_ioctl(struct disk *dp, u_long cmd, void *data, int fflag, 588cd5bdf03SOleksandr Tymoshenko struct thread *td) 589cd5bdf03SOleksandr Tymoshenko { 590cd5bdf03SOleksandr Tymoshenko 591cd5bdf03SOleksandr Tymoshenko return (EINVAL); 592cd5bdf03SOleksandr Tymoshenko } 593cd5bdf03SOleksandr Tymoshenko 594cd5bdf03SOleksandr Tymoshenko static void 595cd5bdf03SOleksandr Tymoshenko mx25l_strategy(struct bio *bp) 596cd5bdf03SOleksandr Tymoshenko { 597cd5bdf03SOleksandr Tymoshenko struct mx25l_softc *sc; 598cd5bdf03SOleksandr Tymoshenko 599cd5bdf03SOleksandr Tymoshenko sc = (struct mx25l_softc *)bp->bio_disk->d_drv1; 600cd5bdf03SOleksandr Tymoshenko M25PXX_LOCK(sc); 601cd5bdf03SOleksandr Tymoshenko bioq_disksort(&sc->sc_bio_queue, bp); 602cd5bdf03SOleksandr Tymoshenko wakeup(sc); 603cd5bdf03SOleksandr Tymoshenko M25PXX_UNLOCK(sc); 604cd5bdf03SOleksandr Tymoshenko } 605cd5bdf03SOleksandr Tymoshenko 6061b468038SAdrian Chadd static int 6071b468038SAdrian Chadd mx25l_getattr(struct bio *bp) 6081b468038SAdrian Chadd { 6091b468038SAdrian Chadd struct mx25l_softc *sc; 6101b468038SAdrian Chadd device_t dev; 6111b468038SAdrian Chadd 6121b468038SAdrian Chadd if (bp->bio_disk == NULL || bp->bio_disk->d_drv1 == NULL) 6131b468038SAdrian Chadd return (ENXIO); 6141b468038SAdrian Chadd 6151b468038SAdrian Chadd sc = bp->bio_disk->d_drv1; 6161b468038SAdrian Chadd dev = sc->sc_dev; 6171b468038SAdrian Chadd 6181b468038SAdrian Chadd if (strcmp(bp->bio_attribute, "SPI::device") == 0) { 6191b468038SAdrian Chadd if (bp->bio_length != sizeof(dev)) 6201b468038SAdrian Chadd return (EFAULT); 6211b468038SAdrian Chadd bcopy(&dev, bp->bio_data, sizeof(dev)); 6221b468038SAdrian Chadd } else 6231b468038SAdrian Chadd return (-1); 6241b468038SAdrian Chadd return (0); 6251b468038SAdrian Chadd } 6261b468038SAdrian Chadd 627cd5bdf03SOleksandr Tymoshenko static void 628cd5bdf03SOleksandr Tymoshenko mx25l_task(void *arg) 629cd5bdf03SOleksandr Tymoshenko { 630cd5bdf03SOleksandr Tymoshenko struct mx25l_softc *sc = (struct mx25l_softc*)arg; 631cd5bdf03SOleksandr Tymoshenko struct bio *bp; 632b3918833SOleksandr Tymoshenko device_t dev; 633cd5bdf03SOleksandr Tymoshenko 634cd5bdf03SOleksandr Tymoshenko for (;;) { 635cd5bdf03SOleksandr Tymoshenko dev = sc->sc_dev; 636cd5bdf03SOleksandr Tymoshenko M25PXX_LOCK(sc); 637cd5bdf03SOleksandr Tymoshenko do { 638aae18dccSIan Lepore if (sc->sc_taskstate == TSTATE_STOPPING) { 639aae18dccSIan Lepore sc->sc_taskstate = TSTATE_STOPPED; 640aae18dccSIan Lepore M25PXX_UNLOCK(sc); 641aae18dccSIan Lepore wakeup(sc); 642aae18dccSIan Lepore kproc_exit(0); 643aae18dccSIan Lepore } 644cd5bdf03SOleksandr Tymoshenko bp = bioq_first(&sc->sc_bio_queue); 645cd5bdf03SOleksandr Tymoshenko if (bp == NULL) 646aae18dccSIan Lepore msleep(sc, &sc->sc_mtx, PRIBIO, "mx25jq", 0); 647cd5bdf03SOleksandr Tymoshenko } while (bp == NULL); 648cd5bdf03SOleksandr Tymoshenko bioq_remove(&sc->sc_bio_queue, bp); 649cd5bdf03SOleksandr Tymoshenko M25PXX_UNLOCK(sc); 650cd5bdf03SOleksandr Tymoshenko 651b3918833SOleksandr Tymoshenko switch (bp->bio_cmd) { 652b3918833SOleksandr Tymoshenko case BIO_READ: 65389a1585bSIan Lepore bp->bio_error = mx25l_read(sc, bp->bio_offset, 654b3918833SOleksandr Tymoshenko bp->bio_data, bp->bio_bcount); 655c3655ab0SOleksandr Tymoshenko break; 656b3918833SOleksandr Tymoshenko case BIO_WRITE: 65789a1585bSIan Lepore bp->bio_error = mx25l_write(sc, bp->bio_offset, 658b3918833SOleksandr Tymoshenko bp->bio_data, bp->bio_bcount); 659b3918833SOleksandr Tymoshenko break; 660b3918833SOleksandr Tymoshenko default: 661*d176b803SScott Long bp->bio_error = EOPNOTSUPP; 662b3918833SOleksandr Tymoshenko } 663cd5bdf03SOleksandr Tymoshenko 664c3655ab0SOleksandr Tymoshenko 665cd5bdf03SOleksandr Tymoshenko biodone(bp); 666cd5bdf03SOleksandr Tymoshenko } 667cd5bdf03SOleksandr Tymoshenko } 668cd5bdf03SOleksandr Tymoshenko 669cd5bdf03SOleksandr Tymoshenko static devclass_t mx25l_devclass; 670cd5bdf03SOleksandr Tymoshenko 671cd5bdf03SOleksandr Tymoshenko static device_method_t mx25l_methods[] = { 672cd5bdf03SOleksandr Tymoshenko /* Device interface */ 673cd5bdf03SOleksandr Tymoshenko DEVMETHOD(device_probe, mx25l_probe), 674cd5bdf03SOleksandr Tymoshenko DEVMETHOD(device_attach, mx25l_attach), 675cd5bdf03SOleksandr Tymoshenko DEVMETHOD(device_detach, mx25l_detach), 676cd5bdf03SOleksandr Tymoshenko 677cd5bdf03SOleksandr Tymoshenko { 0, 0 } 678cd5bdf03SOleksandr Tymoshenko }; 679cd5bdf03SOleksandr Tymoshenko 680cd5bdf03SOleksandr Tymoshenko static driver_t mx25l_driver = { 681cd5bdf03SOleksandr Tymoshenko "mx25l", 682cd5bdf03SOleksandr Tymoshenko mx25l_methods, 683cd5bdf03SOleksandr Tymoshenko sizeof(struct mx25l_softc), 684cd5bdf03SOleksandr Tymoshenko }; 685cd5bdf03SOleksandr Tymoshenko 686cd5bdf03SOleksandr Tymoshenko DRIVER_MODULE(mx25l, spibus, mx25l_driver, mx25l_devclass, 0, 0); 68742c52f36SIan Lepore MODULE_DEPEND(mx25l, spibus, 1, 1, 1); 6887de871aaSEmmanuel Vadot #ifdef FDT 689fb4f7d70SIan Lepore MODULE_DEPEND(mx25l, fdt_slicer, 1, 1, 1); 690db63d251SIan Lepore SPIBUS_FDT_PNP_INFO(compat_data); 6917de871aaSEmmanuel Vadot #endif 692