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; 84cd5bdf03SOleksandr Tymoshenko uint8_t sc_manufacturer_id; 85cd5bdf03SOleksandr Tymoshenko uint16_t sc_device_id; 86b3918833SOleksandr Tymoshenko unsigned int sc_sectorsize; 87cd5bdf03SOleksandr Tymoshenko struct mtx sc_mtx; 88cd5bdf03SOleksandr Tymoshenko struct disk *sc_disk; 89cd5bdf03SOleksandr Tymoshenko struct proc *sc_p; 90cd5bdf03SOleksandr Tymoshenko struct bio_queue_head sc_bio_queue; 9162c3a412SAdrian Chadd unsigned int sc_flags; 92*aae18dccSIan Lepore unsigned int sc_taskstate; 93cd5bdf03SOleksandr Tymoshenko }; 94cd5bdf03SOleksandr Tymoshenko 95*aae18dccSIan Lepore #define TSTATE_STOPPED 0 96*aae18dccSIan Lepore #define TSTATE_STOPPING 1 97*aae18dccSIan Lepore #define TSTATE_RUNNING 2 98*aae18dccSIan Lepore 99cd5bdf03SOleksandr Tymoshenko #define M25PXX_LOCK(_sc) mtx_lock(&(_sc)->sc_mtx) 100cd5bdf03SOleksandr Tymoshenko #define M25PXX_UNLOCK(_sc) mtx_unlock(&(_sc)->sc_mtx) 101cd5bdf03SOleksandr Tymoshenko #define M25PXX_LOCK_INIT(_sc) \ 102cd5bdf03SOleksandr Tymoshenko mtx_init(&_sc->sc_mtx, device_get_nameunit(_sc->sc_dev), \ 103cd5bdf03SOleksandr Tymoshenko "mx25l", MTX_DEF) 104cd5bdf03SOleksandr Tymoshenko #define M25PXX_LOCK_DESTROY(_sc) mtx_destroy(&_sc->sc_mtx); 105cd5bdf03SOleksandr Tymoshenko #define M25PXX_ASSERT_LOCKED(_sc) mtx_assert(&_sc->sc_mtx, MA_OWNED); 106cd5bdf03SOleksandr Tymoshenko #define M25PXX_ASSERT_UNLOCKED(_sc) mtx_assert(&_sc->sc_mtx, MA_NOTOWNED); 107cd5bdf03SOleksandr Tymoshenko 108cd5bdf03SOleksandr Tymoshenko /* disk routines */ 109cd5bdf03SOleksandr Tymoshenko static int mx25l_open(struct disk *dp); 110cd5bdf03SOleksandr Tymoshenko static int mx25l_close(struct disk *dp); 111cd5bdf03SOleksandr Tymoshenko static int mx25l_ioctl(struct disk *, u_long, void *, int, struct thread *); 112cd5bdf03SOleksandr Tymoshenko static void mx25l_strategy(struct bio *bp); 1131b468038SAdrian Chadd static int mx25l_getattr(struct bio *bp); 114cd5bdf03SOleksandr Tymoshenko static void mx25l_task(void *arg); 115cd5bdf03SOleksandr Tymoshenko 116cd5bdf03SOleksandr Tymoshenko struct mx25l_flash_ident flash_devices[] = { 117869785b4SAleksandr Rybalko { "en25f32", 0x1c, 0x3116, 64 * 1024, 64, FL_NONE }, 118869785b4SAleksandr Rybalko { "en25p32", 0x1c, 0x2016, 64 * 1024, 64, FL_NONE }, 119869785b4SAleksandr Rybalko { "en25p64", 0x1c, 0x2017, 64 * 1024, 128, FL_NONE }, 1202f57841eSAdrian Chadd { "en25q32", 0x1c, 0x3016, 64 * 1024, 64, FL_NONE }, 121869785b4SAleksandr Rybalko { "en25q64", 0x1c, 0x3017, 64 * 1024, 128, FL_ERASE_4K }, 1222f57841eSAdrian Chadd { "m25p32", 0x20, 0x2016, 64 * 1024, 64, FL_NONE }, 123a565668bSAdrian Chadd { "m25p64", 0x20, 0x2017, 64 * 1024, 128, FL_NONE }, 124869785b4SAleksandr Rybalko { "mx25ll32", 0xc2, 0x2016, 64 * 1024, 64, FL_NONE }, 125d2cf1fd5SAdrian Chadd { "mx25ll64", 0xc2, 0x2017, 64 * 1024, 128, FL_NONE }, 126d2cf1fd5SAdrian Chadd { "mx25ll128", 0xc2, 0x2018, 64 * 1024, 256, FL_ERASE_4K | FL_ERASE_32K }, 1272d46b036SStanislav Galabov { "mx25ll256", 0xc2, 0x2019, 64 * 1024, 512, FL_ERASE_4K | FL_ERASE_32K | FL_ENABLE_4B_ADDR }, 128c6905524SLuiz Otavio O Souza { "s25fl032", 0x01, 0x0215, 64 * 1024, 64, FL_NONE }, 129c6905524SLuiz Otavio O Souza { "s25fl064", 0x01, 0x0216, 64 * 1024, 128, FL_NONE }, 130d2cf1fd5SAdrian Chadd { "s25fl128", 0x01, 0x2018, 64 * 1024, 256, FL_NONE }, 1314a4ae982SAdrian Chadd { "s25fl256s", 0x01, 0x0219, 64 * 1024, 512, FL_NONE }, 132fa68dcb1SJustin Hibbits { "SST25VF010A", 0xbf, 0x2549, 4 * 1024, 32, FL_ERASE_4K | FL_ERASE_32K }, 133869785b4SAleksandr Rybalko { "SST25VF032B", 0xbf, 0x254a, 64 * 1024, 64, FL_ERASE_4K | FL_ERASE_32K }, 13470234acbSAdrian Chadd 13570234acbSAdrian Chadd /* Winbond -- w25x "blocks" are 64K, "sectors" are 4KiB */ 13670234acbSAdrian Chadd { "w25x32", 0xef, 0x3016, 64 * 1024, 64, FL_ERASE_4K }, 13740424a25SAdrian Chadd { "w25x64", 0xef, 0x3017, 64 * 1024, 128, FL_ERASE_4K }, 138869785b4SAleksandr Rybalko { "w25q32", 0xef, 0x4016, 64 * 1024, 64, FL_ERASE_4K }, 139869785b4SAleksandr Rybalko { "w25q64", 0xef, 0x4017, 64 * 1024, 128, FL_ERASE_4K }, 140450a186cSAdrian Chadd { "w25q64bv", 0xef, 0x4017, 64 * 1024, 128, FL_ERASE_4K }, 14170234acbSAdrian Chadd { "w25q128", 0xef, 0x4018, 64 * 1024, 256, FL_ERASE_4K }, 14270234acbSAdrian Chadd { "w25q256", 0xef, 0x4019, 64 * 1024, 512, FL_ERASE_4K }, 143fe56b741SBaptiste Daroussin 144fe56b741SBaptiste Daroussin /* Atmel */ 145fe56b741SBaptiste Daroussin { "at25df641", 0x1f, 0x4800, 64 * 1024, 128, FL_ERASE_4K }, 146303c3562SAdrian Chadd 147303c3562SAdrian Chadd /* GigaDevice */ 148303c3562SAdrian Chadd { "gd25q64", 0xc8, 0x4017, 64 * 1024, 128, FL_ERASE_4K }, 149cd5bdf03SOleksandr Tymoshenko }; 150cd5bdf03SOleksandr Tymoshenko 151cd5bdf03SOleksandr Tymoshenko static uint8_t 152cd5bdf03SOleksandr Tymoshenko mx25l_get_status(device_t dev) 153cd5bdf03SOleksandr Tymoshenko { 154cd5bdf03SOleksandr Tymoshenko uint8_t txBuf[2], rxBuf[2]; 155cd5bdf03SOleksandr Tymoshenko struct spi_command cmd; 156cd5bdf03SOleksandr Tymoshenko int err; 157cd5bdf03SOleksandr Tymoshenko 158cd5bdf03SOleksandr Tymoshenko memset(&cmd, 0, sizeof(cmd)); 159cd5bdf03SOleksandr Tymoshenko memset(txBuf, 0, sizeof(txBuf)); 160cd5bdf03SOleksandr Tymoshenko memset(rxBuf, 0, sizeof(rxBuf)); 161cd5bdf03SOleksandr Tymoshenko 162cd5bdf03SOleksandr Tymoshenko txBuf[0] = CMD_READ_STATUS; 163cd5bdf03SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 164cd5bdf03SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 165cd5bdf03SOleksandr Tymoshenko cmd.rx_cmd_sz = 2; 166cd5bdf03SOleksandr Tymoshenko cmd.tx_cmd_sz = 2; 167cd5bdf03SOleksandr Tymoshenko err = SPIBUS_TRANSFER(device_get_parent(dev), dev, &cmd); 168cd5bdf03SOleksandr Tymoshenko return (rxBuf[1]); 169cd5bdf03SOleksandr Tymoshenko } 170cd5bdf03SOleksandr Tymoshenko 171cd5bdf03SOleksandr Tymoshenko static void 172cd5bdf03SOleksandr Tymoshenko mx25l_wait_for_device_ready(device_t dev) 173cd5bdf03SOleksandr Tymoshenko { 174cd5bdf03SOleksandr Tymoshenko while ((mx25l_get_status(dev) & STATUS_WIP)) 175cd5bdf03SOleksandr Tymoshenko continue; 176cd5bdf03SOleksandr Tymoshenko } 177cd5bdf03SOleksandr Tymoshenko 178cd5bdf03SOleksandr Tymoshenko static struct mx25l_flash_ident* 179cd5bdf03SOleksandr Tymoshenko mx25l_get_device_ident(struct mx25l_softc *sc) 180cd5bdf03SOleksandr Tymoshenko { 181cd5bdf03SOleksandr Tymoshenko device_t dev = sc->sc_dev; 182cd5bdf03SOleksandr Tymoshenko uint8_t txBuf[8], rxBuf[8]; 183cd5bdf03SOleksandr Tymoshenko struct spi_command cmd; 184cd5bdf03SOleksandr Tymoshenko uint8_t manufacturer_id; 185cd5bdf03SOleksandr Tymoshenko uint16_t dev_id; 186cd5bdf03SOleksandr Tymoshenko int err, i; 187cd5bdf03SOleksandr Tymoshenko 188cd5bdf03SOleksandr Tymoshenko memset(&cmd, 0, sizeof(cmd)); 189cd5bdf03SOleksandr Tymoshenko memset(txBuf, 0, sizeof(txBuf)); 190cd5bdf03SOleksandr Tymoshenko memset(rxBuf, 0, sizeof(rxBuf)); 191cd5bdf03SOleksandr Tymoshenko 192cd5bdf03SOleksandr Tymoshenko txBuf[0] = CMD_READ_IDENT; 193cd5bdf03SOleksandr Tymoshenko cmd.tx_cmd = &txBuf; 194cd5bdf03SOleksandr Tymoshenko cmd.rx_cmd = &rxBuf; 195cd5bdf03SOleksandr Tymoshenko /* 196cd5bdf03SOleksandr Tymoshenko * Some compatible devices has extended two-bytes ID 197cd5bdf03SOleksandr Tymoshenko * We'll use only manufacturer/deviceid atm 198cd5bdf03SOleksandr Tymoshenko */ 199cd5bdf03SOleksandr Tymoshenko cmd.tx_cmd_sz = 4; 200cd5bdf03SOleksandr Tymoshenko cmd.rx_cmd_sz = 4; 201cd5bdf03SOleksandr Tymoshenko err = SPIBUS_TRANSFER(device_get_parent(dev), dev, &cmd); 202cd5bdf03SOleksandr Tymoshenko if (err) 203cd5bdf03SOleksandr Tymoshenko return (NULL); 204cd5bdf03SOleksandr Tymoshenko 205cd5bdf03SOleksandr Tymoshenko manufacturer_id = rxBuf[1]; 206cd5bdf03SOleksandr Tymoshenko dev_id = (rxBuf[2] << 8) | (rxBuf[3]); 207cd5bdf03SOleksandr Tymoshenko 208cd5bdf03SOleksandr Tymoshenko for (i = 0; 20973a1170aSPedro F. Giffuni i < nitems(flash_devices); i++) { 210cd5bdf03SOleksandr Tymoshenko if ((flash_devices[i].manufacturer_id == manufacturer_id) && 211cd5bdf03SOleksandr Tymoshenko (flash_devices[i].device_id == dev_id)) 212cd5bdf03SOleksandr Tymoshenko return &flash_devices[i]; 213cd5bdf03SOleksandr Tymoshenko } 214cd5bdf03SOleksandr Tymoshenko 215cd5bdf03SOleksandr Tymoshenko printf("Unknown SPI flash device. Vendor: %02x, device id: %04x\n", 216cd5bdf03SOleksandr Tymoshenko manufacturer_id, dev_id); 217cd5bdf03SOleksandr Tymoshenko return (NULL); 218cd5bdf03SOleksandr Tymoshenko } 219cd5bdf03SOleksandr Tymoshenko 220c3655ab0SOleksandr Tymoshenko static void 221c3655ab0SOleksandr Tymoshenko mx25l_set_writable(device_t dev, int writable) 222c3655ab0SOleksandr Tymoshenko { 223c3655ab0SOleksandr Tymoshenko uint8_t txBuf[1], rxBuf[1]; 224c3655ab0SOleksandr Tymoshenko struct spi_command cmd; 225c3655ab0SOleksandr Tymoshenko int err; 226c3655ab0SOleksandr Tymoshenko 227c3655ab0SOleksandr Tymoshenko memset(&cmd, 0, sizeof(cmd)); 228c3655ab0SOleksandr Tymoshenko memset(txBuf, 0, sizeof(txBuf)); 229c3655ab0SOleksandr Tymoshenko memset(rxBuf, 0, sizeof(rxBuf)); 230c3655ab0SOleksandr Tymoshenko 231c3655ab0SOleksandr Tymoshenko txBuf[0] = writable ? CMD_WRITE_ENABLE : CMD_WRITE_DISABLE; 232c3655ab0SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 233c3655ab0SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 234c3655ab0SOleksandr Tymoshenko cmd.rx_cmd_sz = 1; 235c3655ab0SOleksandr Tymoshenko cmd.tx_cmd_sz = 1; 236c3655ab0SOleksandr Tymoshenko err = SPIBUS_TRANSFER(device_get_parent(dev), dev, &cmd); 237c3655ab0SOleksandr Tymoshenko } 238c3655ab0SOleksandr Tymoshenko 239c3655ab0SOleksandr Tymoshenko static void 24053436aceSAdrian Chadd mx25l_erase_cmd(device_t dev, off_t sector, uint8_t ecmd) 241c3655ab0SOleksandr Tymoshenko { 2422d46b036SStanislav Galabov struct mx25l_softc *sc; 2432d46b036SStanislav Galabov uint8_t txBuf[5], rxBuf[5]; 244c3655ab0SOleksandr Tymoshenko struct spi_command cmd; 245c3655ab0SOleksandr Tymoshenko int err; 246c3655ab0SOleksandr Tymoshenko 2472d46b036SStanislav Galabov sc = device_get_softc(dev); 2482d46b036SStanislav Galabov 249c3655ab0SOleksandr Tymoshenko mx25l_wait_for_device_ready(dev); 250c3655ab0SOleksandr Tymoshenko mx25l_set_writable(dev, 1); 251c3655ab0SOleksandr Tymoshenko 252c3655ab0SOleksandr Tymoshenko memset(&cmd, 0, sizeof(cmd)); 253c3655ab0SOleksandr Tymoshenko memset(txBuf, 0, sizeof(txBuf)); 254c3655ab0SOleksandr Tymoshenko memset(rxBuf, 0, sizeof(rxBuf)); 255c3655ab0SOleksandr Tymoshenko 25653436aceSAdrian Chadd txBuf[0] = ecmd; 257c3655ab0SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 258c3655ab0SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 2592d46b036SStanislav Galabov if (sc->sc_flags & FL_ENABLE_4B_ADDR) { 2602d46b036SStanislav Galabov cmd.rx_cmd_sz = 5; 2612d46b036SStanislav Galabov cmd.tx_cmd_sz = 5; 2622d46b036SStanislav Galabov txBuf[1] = ((sector >> 24) & 0xff); 2632d46b036SStanislav Galabov txBuf[2] = ((sector >> 16) & 0xff); 2642d46b036SStanislav Galabov txBuf[3] = ((sector >> 8) & 0xff); 2652d46b036SStanislav Galabov txBuf[4] = (sector & 0xff); 2662d46b036SStanislav Galabov } else { 267c3655ab0SOleksandr Tymoshenko cmd.rx_cmd_sz = 4; 268c3655ab0SOleksandr Tymoshenko cmd.tx_cmd_sz = 4; 269c3655ab0SOleksandr Tymoshenko txBuf[1] = ((sector >> 16) & 0xff); 270c3655ab0SOleksandr Tymoshenko txBuf[2] = ((sector >> 8) & 0xff); 271c3655ab0SOleksandr Tymoshenko txBuf[3] = (sector & 0xff); 2722d46b036SStanislav Galabov } 273c3655ab0SOleksandr Tymoshenko err = SPIBUS_TRANSFER(device_get_parent(dev), dev, &cmd); 274c3655ab0SOleksandr Tymoshenko } 275c3655ab0SOleksandr Tymoshenko 276cd5bdf03SOleksandr Tymoshenko static int 277b3918833SOleksandr Tymoshenko mx25l_write(device_t dev, off_t offset, caddr_t data, off_t count) 278b3918833SOleksandr Tymoshenko { 279b3918833SOleksandr Tymoshenko struct mx25l_softc *sc; 280b3918833SOleksandr Tymoshenko uint8_t txBuf[8], rxBuf[8]; 281b3918833SOleksandr Tymoshenko struct spi_command cmd; 282b3918833SOleksandr Tymoshenko off_t write_offset; 283b3918833SOleksandr Tymoshenko long bytes_to_write, bytes_writen; 284b3918833SOleksandr Tymoshenko device_t pdev; 285b3918833SOleksandr Tymoshenko int err = 0; 286b3918833SOleksandr Tymoshenko 287b3918833SOleksandr Tymoshenko pdev = device_get_parent(dev); 288b3918833SOleksandr Tymoshenko sc = device_get_softc(dev); 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 bytes_writen = 0; 299b3918833SOleksandr Tymoshenko write_offset = offset; 300b3918833SOleksandr Tymoshenko 301b3918833SOleksandr Tymoshenko /* 302917721a4SAdrian Chadd * Use the erase sectorsize here since blocks are fully erased 303917721a4SAdrian Chadd * first before they're written to. 304b3918833SOleksandr Tymoshenko */ 305917721a4SAdrian Chadd if (count % sc->sc_sectorsize != 0 || offset % sc->sc_sectorsize != 0) 306917721a4SAdrian Chadd return (EIO); 307b3918833SOleksandr Tymoshenko 308b3918833SOleksandr Tymoshenko /* 309b3918833SOleksandr Tymoshenko * Assume here that we write per-sector only 310b3918833SOleksandr Tymoshenko * and sector size should be 256 bytes aligned 311b3918833SOleksandr Tymoshenko */ 312b3918833SOleksandr Tymoshenko KASSERT(write_offset % FLASH_PAGE_SIZE == 0, 313b3918833SOleksandr Tymoshenko ("offset for BIO_WRITE is not page size (%d bytes) aligned", 314b3918833SOleksandr Tymoshenko FLASH_PAGE_SIZE)); 315b3918833SOleksandr Tymoshenko 316b3918833SOleksandr Tymoshenko /* 317b3918833SOleksandr Tymoshenko * Maximum write size for CMD_PAGE_PROGRAM is 318b3918833SOleksandr Tymoshenko * FLASH_PAGE_SIZE, so split data to chunks 319b3918833SOleksandr Tymoshenko * FLASH_PAGE_SIZE bytes eash and write them 320b3918833SOleksandr Tymoshenko * one by one 321b3918833SOleksandr Tymoshenko */ 322b3918833SOleksandr Tymoshenko while (bytes_writen < count) { 323b3918833SOleksandr Tymoshenko /* 324b3918833SOleksandr Tymoshenko * If we crossed sector boundary - erase next sector 325b3918833SOleksandr Tymoshenko */ 326b3918833SOleksandr Tymoshenko if (((offset + bytes_writen) % sc->sc_sectorsize) == 0) 32753436aceSAdrian Chadd mx25l_erase_cmd(dev, offset + bytes_writen, CMD_SECTOR_ERASE); 328b3918833SOleksandr Tymoshenko 329b3918833SOleksandr Tymoshenko txBuf[0] = CMD_PAGE_PROGRAM; 3302d46b036SStanislav Galabov if (sc->sc_flags & FL_ENABLE_4B_ADDR) { 3312d46b036SStanislav Galabov txBuf[1] = ((write_offset >> 24) & 0xff); 3322d46b036SStanislav Galabov txBuf[2] = ((write_offset >> 16) & 0xff); 3332d46b036SStanislav Galabov txBuf[3] = ((write_offset >> 8) & 0xff); 3342d46b036SStanislav Galabov txBuf[4] = (write_offset & 0xff); 3352d46b036SStanislav Galabov } else { 336b3918833SOleksandr Tymoshenko txBuf[1] = ((write_offset >> 16) & 0xff); 337b3918833SOleksandr Tymoshenko txBuf[2] = ((write_offset >> 8) & 0xff); 338b3918833SOleksandr Tymoshenko txBuf[3] = (write_offset & 0xff); 3392d46b036SStanislav Galabov } 340b3918833SOleksandr Tymoshenko 341b3918833SOleksandr Tymoshenko bytes_to_write = MIN(FLASH_PAGE_SIZE, 342b3918833SOleksandr Tymoshenko count - bytes_writen); 343b3918833SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 344b3918833SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 345b3918833SOleksandr Tymoshenko cmd.tx_data = data + bytes_writen; 346b3918833SOleksandr Tymoshenko cmd.tx_data_sz = bytes_to_write; 347b3918833SOleksandr Tymoshenko cmd.rx_data = data + bytes_writen; 348b3918833SOleksandr Tymoshenko cmd.rx_data_sz = bytes_to_write; 349b3918833SOleksandr Tymoshenko 350b3918833SOleksandr Tymoshenko /* 351b3918833SOleksandr Tymoshenko * Eash completed write operation resets WEL 352b3918833SOleksandr Tymoshenko * (write enable latch) to disabled state, 353b3918833SOleksandr Tymoshenko * so we re-enable it here 354b3918833SOleksandr Tymoshenko */ 355b3918833SOleksandr Tymoshenko mx25l_wait_for_device_ready(dev); 356b3918833SOleksandr Tymoshenko mx25l_set_writable(dev, 1); 357b3918833SOleksandr Tymoshenko 358b3918833SOleksandr Tymoshenko err = SPIBUS_TRANSFER(pdev, dev, &cmd); 359b3918833SOleksandr Tymoshenko if (err) 360b3918833SOleksandr Tymoshenko break; 361b3918833SOleksandr Tymoshenko 362b3918833SOleksandr Tymoshenko bytes_writen += bytes_to_write; 363b3918833SOleksandr Tymoshenko write_offset += bytes_to_write; 364b3918833SOleksandr Tymoshenko } 365b3918833SOleksandr Tymoshenko 366b3918833SOleksandr Tymoshenko return (err); 367b3918833SOleksandr Tymoshenko } 368b3918833SOleksandr Tymoshenko 369b3918833SOleksandr Tymoshenko static int 370b3918833SOleksandr Tymoshenko mx25l_read(device_t dev, off_t offset, caddr_t data, off_t count) 371b3918833SOleksandr Tymoshenko { 372b3918833SOleksandr Tymoshenko struct mx25l_softc *sc; 373b3918833SOleksandr Tymoshenko uint8_t txBuf[8], rxBuf[8]; 374b3918833SOleksandr Tymoshenko struct spi_command cmd; 375b3918833SOleksandr Tymoshenko device_t pdev; 376b3918833SOleksandr Tymoshenko int err = 0; 377b3918833SOleksandr Tymoshenko 378b3918833SOleksandr Tymoshenko pdev = device_get_parent(dev); 379b3918833SOleksandr Tymoshenko sc = device_get_softc(dev); 380b3918833SOleksandr Tymoshenko 381b3918833SOleksandr Tymoshenko /* 382917721a4SAdrian Chadd * Enforce the disk read sectorsize not the erase sectorsize. 383917721a4SAdrian Chadd * In this way, smaller read IO is possible,dramatically 384917721a4SAdrian Chadd * speeding up filesystem/geom_compress access. 385b3918833SOleksandr Tymoshenko */ 386917721a4SAdrian Chadd if (count % sc->sc_disk->d_sectorsize != 0 387917721a4SAdrian Chadd || offset % sc->sc_disk->d_sectorsize != 0) 388917721a4SAdrian Chadd return (EIO); 389b3918833SOleksandr Tymoshenko 390b3918833SOleksandr Tymoshenko txBuf[0] = CMD_FAST_READ; 3912d46b036SStanislav Galabov if (sc->sc_flags & FL_ENABLE_4B_ADDR) { 3922d46b036SStanislav Galabov cmd.tx_cmd_sz = 6; 3932d46b036SStanislav Galabov cmd.rx_cmd_sz = 6; 3942d46b036SStanislav Galabov 3952d46b036SStanislav Galabov txBuf[1] = ((offset >> 24) & 0xff); 3962d46b036SStanislav Galabov txBuf[2] = ((offset >> 16) & 0xff); 3972d46b036SStanislav Galabov txBuf[3] = ((offset >> 8) & 0xff); 3982d46b036SStanislav Galabov txBuf[4] = (offset & 0xff); 3992d46b036SStanislav Galabov /* Dummy byte */ 4002d46b036SStanislav Galabov txBuf[5] = 0; 4012d46b036SStanislav Galabov } else { 402b3918833SOleksandr Tymoshenko cmd.tx_cmd_sz = 5; 403b3918833SOleksandr Tymoshenko cmd.rx_cmd_sz = 5; 404b3918833SOleksandr Tymoshenko 405b3918833SOleksandr Tymoshenko txBuf[1] = ((offset >> 16) & 0xff); 406b3918833SOleksandr Tymoshenko txBuf[2] = ((offset >> 8) & 0xff); 407b3918833SOleksandr Tymoshenko txBuf[3] = (offset & 0xff); 408b3918833SOleksandr Tymoshenko /* Dummy byte */ 409b3918833SOleksandr Tymoshenko txBuf[4] = 0; 4102d46b036SStanislav Galabov } 411b3918833SOleksandr Tymoshenko 412b3918833SOleksandr Tymoshenko cmd.tx_cmd = txBuf; 413b3918833SOleksandr Tymoshenko cmd.rx_cmd = rxBuf; 414b3918833SOleksandr Tymoshenko cmd.tx_data = data; 415b3918833SOleksandr Tymoshenko cmd.tx_data_sz = count; 416b3918833SOleksandr Tymoshenko cmd.rx_data = data; 417b3918833SOleksandr Tymoshenko cmd.rx_data_sz = count; 418b3918833SOleksandr Tymoshenko 419b3918833SOleksandr Tymoshenko err = SPIBUS_TRANSFER(pdev, dev, &cmd); 420b3918833SOleksandr Tymoshenko 421b3918833SOleksandr Tymoshenko return (err); 422b3918833SOleksandr Tymoshenko } 423b3918833SOleksandr Tymoshenko 424b3918833SOleksandr Tymoshenko static int 4252d46b036SStanislav Galabov mx25l_set_4b_mode(device_t dev, uint8_t command) 4262d46b036SStanislav Galabov { 4272d46b036SStanislav Galabov uint8_t txBuf[1], rxBuf[1]; 4282d46b036SStanislav Galabov struct spi_command cmd; 4292d46b036SStanislav Galabov device_t pdev; 4302d46b036SStanislav Galabov int err; 4312d46b036SStanislav Galabov 4322d46b036SStanislav Galabov memset(&cmd, 0, sizeof(cmd)); 4332d46b036SStanislav Galabov memset(txBuf, 0, sizeof(txBuf)); 4342d46b036SStanislav Galabov memset(rxBuf, 0, sizeof(rxBuf)); 4352d46b036SStanislav Galabov 4362d46b036SStanislav Galabov pdev = device_get_parent(dev); 4372d46b036SStanislav Galabov 4382d46b036SStanislav Galabov cmd.tx_cmd_sz = cmd.rx_cmd_sz = 1; 4392d46b036SStanislav Galabov 4402d46b036SStanislav Galabov cmd.tx_cmd = txBuf; 4412d46b036SStanislav Galabov cmd.rx_cmd = rxBuf; 4422d46b036SStanislav Galabov 4432d46b036SStanislav Galabov txBuf[0] = command; 4442d46b036SStanislav Galabov 4452d46b036SStanislav Galabov err = SPIBUS_TRANSFER(pdev, dev, &cmd); 4462d46b036SStanislav Galabov 4472d46b036SStanislav Galabov mx25l_wait_for_device_ready(dev); 4482d46b036SStanislav Galabov 4492d46b036SStanislav Galabov return (err); 4502d46b036SStanislav Galabov } 4512d46b036SStanislav Galabov 45275b3cfd2SAdrian Chadd #ifdef FDT 4531173c206SStanislav Galabov static struct ofw_compat_data compat_data[] = { 4541173c206SStanislav Galabov { "st,m25p", 1 }, 4551173c206SStanislav Galabov { "jedec,spi-nor", 1 }, 4561173c206SStanislav Galabov { NULL, 0 }, 4571173c206SStanislav Galabov }; 45875b3cfd2SAdrian Chadd #endif 4591173c206SStanislav Galabov 4602d46b036SStanislav Galabov static int 461cd5bdf03SOleksandr Tymoshenko mx25l_probe(device_t dev) 462cd5bdf03SOleksandr Tymoshenko { 4638f74c88aSLuiz Otavio O Souza #ifdef FDT 464009e872eSStanislav Galabov int i; 465009e872eSStanislav Galabov 4668f74c88aSLuiz Otavio O Souza if (!ofw_bus_status_okay(dev)) 4678f74c88aSLuiz Otavio O Souza return (ENXIO); 468009e872eSStanislav Galabov 469009e872eSStanislav Galabov /* First try to match the compatible property to the compat_data */ 470009e872eSStanislav Galabov if (ofw_bus_search_compatible(dev, compat_data)->ocd_data == 1) 471009e872eSStanislav Galabov goto found; 472009e872eSStanislav Galabov 473009e872eSStanislav Galabov /* 474009e872eSStanislav Galabov * Next, try to find a compatible device using the names in the 475009e872eSStanislav Galabov * flash_devices structure 476009e872eSStanislav Galabov */ 477009e872eSStanislav Galabov for (i = 0; i < nitems(flash_devices); i++) 478009e872eSStanislav Galabov if (ofw_bus_is_compatible(dev, flash_devices[i].name)) 479009e872eSStanislav Galabov goto found; 480009e872eSStanislav Galabov 4818f74c88aSLuiz Otavio O Souza return (ENXIO); 482009e872eSStanislav Galabov found: 4838f74c88aSLuiz Otavio O Souza #endif 484cd5bdf03SOleksandr Tymoshenko device_set_desc(dev, "M25Pxx Flash Family"); 4858f74c88aSLuiz Otavio O Souza 486cd5bdf03SOleksandr Tymoshenko return (0); 487cd5bdf03SOleksandr Tymoshenko } 488cd5bdf03SOleksandr Tymoshenko 489cd5bdf03SOleksandr Tymoshenko static int 490cd5bdf03SOleksandr Tymoshenko mx25l_attach(device_t dev) 491cd5bdf03SOleksandr Tymoshenko { 492cd5bdf03SOleksandr Tymoshenko struct mx25l_softc *sc; 493cd5bdf03SOleksandr Tymoshenko struct mx25l_flash_ident *ident; 494cd5bdf03SOleksandr Tymoshenko 495cd5bdf03SOleksandr Tymoshenko sc = device_get_softc(dev); 496cd5bdf03SOleksandr Tymoshenko sc->sc_dev = dev; 497cd5bdf03SOleksandr Tymoshenko M25PXX_LOCK_INIT(sc); 498cd5bdf03SOleksandr Tymoshenko 499cd5bdf03SOleksandr Tymoshenko ident = mx25l_get_device_ident(sc); 500cd5bdf03SOleksandr Tymoshenko if (ident == NULL) 501cd5bdf03SOleksandr Tymoshenko return (ENXIO); 502cd5bdf03SOleksandr Tymoshenko 503cd5bdf03SOleksandr Tymoshenko mx25l_wait_for_device_ready(sc->sc_dev); 504cd5bdf03SOleksandr Tymoshenko 505cd5bdf03SOleksandr Tymoshenko sc->sc_disk = disk_alloc(); 506cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_open = mx25l_open; 507cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_close = mx25l_close; 508cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_strategy = mx25l_strategy; 5091b468038SAdrian Chadd sc->sc_disk->d_getattr = mx25l_getattr; 510cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_ioctl = mx25l_ioctl; 511cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_name = "flash/spi"; 512cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_drv1 = sc; 513cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_maxsize = DFLTPHYS; 514917721a4SAdrian Chadd sc->sc_disk->d_sectorsize = MX25L_SECTORSIZE; 515cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_mediasize = ident->sectorsize * ident->sectorcount; 516cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_unit = device_get_unit(sc->sc_dev); 517cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_dump = NULL; /* NB: no dumps */ 518b3918833SOleksandr Tymoshenko /* Sectorsize for erase operations */ 519b3918833SOleksandr Tymoshenko sc->sc_sectorsize = ident->sectorsize; 52062c3a412SAdrian Chadd sc->sc_flags = ident->flags; 521cd5bdf03SOleksandr Tymoshenko 5222d46b036SStanislav Galabov if (sc->sc_flags & FL_ENABLE_4B_ADDR) 5232d46b036SStanislav Galabov mx25l_set_4b_mode(dev, CMD_ENTER_4B_MODE); 5242d46b036SStanislav Galabov 5252d46b036SStanislav Galabov if (sc->sc_flags & FL_DISABLE_4B_ADDR) 5262d46b036SStanislav Galabov mx25l_set_4b_mode(dev, CMD_EXIT_4B_MODE); 5272d46b036SStanislav Galabov 528cd5bdf03SOleksandr Tymoshenko /* NB: use stripesize to hold the erase/region size for RedBoot */ 529cd5bdf03SOleksandr Tymoshenko sc->sc_disk->d_stripesize = ident->sectorsize; 530cd5bdf03SOleksandr Tymoshenko 531cd5bdf03SOleksandr Tymoshenko disk_create(sc->sc_disk, DISK_VERSION); 532cd5bdf03SOleksandr Tymoshenko bioq_init(&sc->sc_bio_queue); 533cd5bdf03SOleksandr Tymoshenko 534cd5bdf03SOleksandr Tymoshenko kproc_create(&mx25l_task, sc, &sc->sc_p, 0, 0, "task: mx25l flash"); 535*aae18dccSIan Lepore sc->sc_taskstate = TSTATE_RUNNING; 536*aae18dccSIan Lepore 537cd5bdf03SOleksandr Tymoshenko device_printf(sc->sc_dev, "%s, sector %d bytes, %d sectors\n", 538cd5bdf03SOleksandr Tymoshenko ident->name, ident->sectorsize, ident->sectorcount); 539cd5bdf03SOleksandr Tymoshenko 540cd5bdf03SOleksandr Tymoshenko return (0); 541cd5bdf03SOleksandr Tymoshenko } 542cd5bdf03SOleksandr Tymoshenko 543cd5bdf03SOleksandr Tymoshenko static int 544cd5bdf03SOleksandr Tymoshenko mx25l_detach(device_t dev) 545cd5bdf03SOleksandr Tymoshenko { 546*aae18dccSIan Lepore struct mx25l_softc *sc; 547*aae18dccSIan Lepore int err; 548cd5bdf03SOleksandr Tymoshenko 549*aae18dccSIan Lepore sc = device_get_softc(dev); 550*aae18dccSIan Lepore err = 0; 551*aae18dccSIan Lepore 552*aae18dccSIan Lepore M25PXX_LOCK(sc); 553*aae18dccSIan Lepore if (sc->sc_taskstate == TSTATE_RUNNING) { 554*aae18dccSIan Lepore sc->sc_taskstate = TSTATE_STOPPING; 555*aae18dccSIan Lepore wakeup(sc); 556*aae18dccSIan Lepore while (err == 0 && sc->sc_taskstate != TSTATE_STOPPED) { 557*aae18dccSIan Lepore err = msleep(sc, &sc->sc_mtx, 0, "mx25dt", hz * 3); 558*aae18dccSIan Lepore if (err != 0) { 559*aae18dccSIan Lepore sc->sc_taskstate = TSTATE_RUNNING; 560*aae18dccSIan Lepore device_printf(dev, 561*aae18dccSIan Lepore "Failed to stop queue task\n"); 562*aae18dccSIan Lepore } 563*aae18dccSIan Lepore } 564*aae18dccSIan Lepore } 565*aae18dccSIan Lepore M25PXX_UNLOCK(sc); 566*aae18dccSIan Lepore 567*aae18dccSIan Lepore if (err == 0 && sc->sc_taskstate == TSTATE_STOPPED) { 568*aae18dccSIan Lepore disk_destroy(sc->sc_disk); 569*aae18dccSIan Lepore bioq_flush(&sc->sc_bio_queue, NULL, ENXIO); 570*aae18dccSIan Lepore M25PXX_LOCK_DESTROY(sc); 571*aae18dccSIan Lepore } 572*aae18dccSIan Lepore return (err); 573cd5bdf03SOleksandr Tymoshenko } 574cd5bdf03SOleksandr Tymoshenko 575cd5bdf03SOleksandr Tymoshenko static int 576cd5bdf03SOleksandr Tymoshenko mx25l_open(struct disk *dp) 577cd5bdf03SOleksandr Tymoshenko { 578cd5bdf03SOleksandr Tymoshenko return (0); 579cd5bdf03SOleksandr Tymoshenko } 580cd5bdf03SOleksandr Tymoshenko 581cd5bdf03SOleksandr Tymoshenko static int 582cd5bdf03SOleksandr Tymoshenko mx25l_close(struct disk *dp) 583cd5bdf03SOleksandr Tymoshenko { 584cd5bdf03SOleksandr Tymoshenko 585cd5bdf03SOleksandr Tymoshenko return (0); 586cd5bdf03SOleksandr Tymoshenko } 587cd5bdf03SOleksandr Tymoshenko 588cd5bdf03SOleksandr Tymoshenko static int 589cd5bdf03SOleksandr Tymoshenko mx25l_ioctl(struct disk *dp, u_long cmd, void *data, int fflag, 590cd5bdf03SOleksandr Tymoshenko struct thread *td) 591cd5bdf03SOleksandr Tymoshenko { 592cd5bdf03SOleksandr Tymoshenko 593cd5bdf03SOleksandr Tymoshenko return (EINVAL); 594cd5bdf03SOleksandr Tymoshenko } 595cd5bdf03SOleksandr Tymoshenko 596cd5bdf03SOleksandr Tymoshenko static void 597cd5bdf03SOleksandr Tymoshenko mx25l_strategy(struct bio *bp) 598cd5bdf03SOleksandr Tymoshenko { 599cd5bdf03SOleksandr Tymoshenko struct mx25l_softc *sc; 600cd5bdf03SOleksandr Tymoshenko 601cd5bdf03SOleksandr Tymoshenko sc = (struct mx25l_softc *)bp->bio_disk->d_drv1; 602cd5bdf03SOleksandr Tymoshenko M25PXX_LOCK(sc); 603cd5bdf03SOleksandr Tymoshenko bioq_disksort(&sc->sc_bio_queue, bp); 604cd5bdf03SOleksandr Tymoshenko wakeup(sc); 605cd5bdf03SOleksandr Tymoshenko M25PXX_UNLOCK(sc); 606cd5bdf03SOleksandr Tymoshenko } 607cd5bdf03SOleksandr Tymoshenko 6081b468038SAdrian Chadd static int 6091b468038SAdrian Chadd mx25l_getattr(struct bio *bp) 6101b468038SAdrian Chadd { 6111b468038SAdrian Chadd struct mx25l_softc *sc; 6121b468038SAdrian Chadd device_t dev; 6131b468038SAdrian Chadd 6141b468038SAdrian Chadd if (bp->bio_disk == NULL || bp->bio_disk->d_drv1 == NULL) 6151b468038SAdrian Chadd return (ENXIO); 6161b468038SAdrian Chadd 6171b468038SAdrian Chadd sc = bp->bio_disk->d_drv1; 6181b468038SAdrian Chadd dev = sc->sc_dev; 6191b468038SAdrian Chadd 6201b468038SAdrian Chadd if (strcmp(bp->bio_attribute, "SPI::device") == 0) { 6211b468038SAdrian Chadd if (bp->bio_length != sizeof(dev)) 6221b468038SAdrian Chadd return (EFAULT); 6231b468038SAdrian Chadd bcopy(&dev, bp->bio_data, sizeof(dev)); 6241b468038SAdrian Chadd } else 6251b468038SAdrian Chadd return (-1); 6261b468038SAdrian Chadd return (0); 6271b468038SAdrian Chadd } 6281b468038SAdrian Chadd 629cd5bdf03SOleksandr Tymoshenko static void 630cd5bdf03SOleksandr Tymoshenko mx25l_task(void *arg) 631cd5bdf03SOleksandr Tymoshenko { 632cd5bdf03SOleksandr Tymoshenko struct mx25l_softc *sc = (struct mx25l_softc*)arg; 633cd5bdf03SOleksandr Tymoshenko struct bio *bp; 634b3918833SOleksandr Tymoshenko device_t dev; 635cd5bdf03SOleksandr Tymoshenko 636cd5bdf03SOleksandr Tymoshenko for (;;) { 637cd5bdf03SOleksandr Tymoshenko dev = sc->sc_dev; 638cd5bdf03SOleksandr Tymoshenko M25PXX_LOCK(sc); 639cd5bdf03SOleksandr Tymoshenko do { 640*aae18dccSIan Lepore if (sc->sc_taskstate == TSTATE_STOPPING) { 641*aae18dccSIan Lepore sc->sc_taskstate = TSTATE_STOPPED; 642*aae18dccSIan Lepore M25PXX_UNLOCK(sc); 643*aae18dccSIan Lepore wakeup(sc); 644*aae18dccSIan Lepore kproc_exit(0); 645*aae18dccSIan Lepore } 646cd5bdf03SOleksandr Tymoshenko bp = bioq_first(&sc->sc_bio_queue); 647cd5bdf03SOleksandr Tymoshenko if (bp == NULL) 648*aae18dccSIan Lepore msleep(sc, &sc->sc_mtx, PRIBIO, "mx25jq", 0); 649cd5bdf03SOleksandr Tymoshenko } while (bp == NULL); 650cd5bdf03SOleksandr Tymoshenko bioq_remove(&sc->sc_bio_queue, bp); 651cd5bdf03SOleksandr Tymoshenko M25PXX_UNLOCK(sc); 652cd5bdf03SOleksandr Tymoshenko 653b3918833SOleksandr Tymoshenko switch (bp->bio_cmd) { 654b3918833SOleksandr Tymoshenko case BIO_READ: 655b3918833SOleksandr Tymoshenko bp->bio_error = mx25l_read(dev, bp->bio_offset, 656b3918833SOleksandr Tymoshenko bp->bio_data, bp->bio_bcount); 657c3655ab0SOleksandr Tymoshenko break; 658b3918833SOleksandr Tymoshenko case BIO_WRITE: 659b3918833SOleksandr Tymoshenko bp->bio_error = mx25l_write(dev, bp->bio_offset, 660b3918833SOleksandr Tymoshenko bp->bio_data, bp->bio_bcount); 661b3918833SOleksandr Tymoshenko break; 662b3918833SOleksandr Tymoshenko default: 663cd5bdf03SOleksandr Tymoshenko bp->bio_error = EINVAL; 664b3918833SOleksandr Tymoshenko } 665cd5bdf03SOleksandr Tymoshenko 666c3655ab0SOleksandr Tymoshenko 667cd5bdf03SOleksandr Tymoshenko biodone(bp); 668cd5bdf03SOleksandr Tymoshenko } 669cd5bdf03SOleksandr Tymoshenko } 670cd5bdf03SOleksandr Tymoshenko 671cd5bdf03SOleksandr Tymoshenko static devclass_t mx25l_devclass; 672cd5bdf03SOleksandr Tymoshenko 673cd5bdf03SOleksandr Tymoshenko static device_method_t mx25l_methods[] = { 674cd5bdf03SOleksandr Tymoshenko /* Device interface */ 675cd5bdf03SOleksandr Tymoshenko DEVMETHOD(device_probe, mx25l_probe), 676cd5bdf03SOleksandr Tymoshenko DEVMETHOD(device_attach, mx25l_attach), 677cd5bdf03SOleksandr Tymoshenko DEVMETHOD(device_detach, mx25l_detach), 678cd5bdf03SOleksandr Tymoshenko 679cd5bdf03SOleksandr Tymoshenko { 0, 0 } 680cd5bdf03SOleksandr Tymoshenko }; 681cd5bdf03SOleksandr Tymoshenko 682cd5bdf03SOleksandr Tymoshenko static driver_t mx25l_driver = { 683cd5bdf03SOleksandr Tymoshenko "mx25l", 684cd5bdf03SOleksandr Tymoshenko mx25l_methods, 685cd5bdf03SOleksandr Tymoshenko sizeof(struct mx25l_softc), 686cd5bdf03SOleksandr Tymoshenko }; 687cd5bdf03SOleksandr Tymoshenko 688cd5bdf03SOleksandr Tymoshenko DRIVER_MODULE(mx25l, spibus, mx25l_driver, mx25l_devclass, 0, 0); 68942c52f36SIan Lepore MODULE_DEPEND(mx25l, spibus, 1, 1, 1); 690