#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: athflash.c,v 1.12 2021/01/04 17:42:29 thorpej Exp $");
#include <sys/param.h>
#include <sys/conf.h>
#include <sys/device.h>
#include <sys/kernel.h>
#include <sys/kmem.h>
#include <sys/proc.h>
#include <sys/systm.h>
#include <sys/bus.h>
#include <mips/atheros/include/arbusvar.h>
#ifdef FLASH_DEBUG
int flash_debug = 0;
#define DPRINTF(x) if (flash_debug) printf x
#else
#define DPRINTF(x)
#endif
struct flash_softc {
bus_space_tag_t sc_iot;
bus_space_handle_t sc_ioh;
size_t sc_size;
size_t sc_sector_size;
int sc_status;
u_int8_t *sc_buf;
};
#define FLASH_ST_BUSY 0x1
static int flash_probe(device_t, cfdata_t, void *);
static void flash_attach(device_t, device_t, void *);
static int is_block_same(struct flash_softc *, bus_size_t, const void *);
static int toggle_bit_wait(struct flash_softc *, bus_size_t, int, int, int);
static int flash_sector_erase(struct flash_softc *, bus_size_t);
static int flash_sector_write(struct flash_softc *, bus_size_t);
extern struct cfdriver athflash_cd;
CFATTACH_DECL_NEW(athflash, sizeof(struct flash_softc),
flash_probe, flash_attach, NULL, NULL);
dev_type_open(flashopen);
dev_type_close(flashclose);
dev_type_read(flashread);
dev_type_write(flashwrite);
const struct cdevsw athflash_cdevsw = {
.d_open = flashopen,
.d_close = flashclose,
.d_read = flashread,
.d_write = flashwrite,
.d_ioctl = noioctl,
.d_stop = nostop,
.d_tty = notty,
.d_poll = nopoll,
.d_mmap = nommap,
.d_kqfilter = nokqfilter,
.d_discard = nodiscard,
.d_flag = 0
};
static struct {
uint16_t vendor_id;
uint16_t device_id;
const char *name;
int sector_size;
int flash_size;
} flash_ids[] = {
{ 0x00bf, 0x2780, "SST 39VF400", 0x01000, 0x080000 },
{ 0x00bf, 0x2782, "SST 39VF160", 0x01000, 0x200000 },
{ 0xffff, 0xffff, NULL, 0, 0 }
};
static int
flash_probe(device_t parent, cfdata_t cf, void *aux)
{
struct arbus_attach_args *aa = aux;
bus_space_handle_t ioh;
int rv = 0, i;
uint16_t venid, devid;
if (strcmp(aa->aa_name, cf->cf_name) != 0)
return 0;
DPRINTF(("trying to map address %x\n", (unsigned)aa->aa_addr));
if (bus_space_map(aa->aa_bst, aa->aa_addr, aa->aa_size, 0, &ioh))
return 0;
DPRINTF(("issuing JEDEC query\n"));
bus_space_write_2(aa->aa_bst, ioh, (0x5555 << 1), 0xAAAA);
bus_space_write_2(aa->aa_bst, ioh, (0x2AAA << 1), 0x5555);
bus_space_write_2(aa->aa_bst, ioh, (0x5555 << 1), 0x9090);
delay(100);
venid = bus_space_read_2(aa->aa_bst, ioh, 0);
devid = bus_space_read_2(aa->aa_bst, ioh, 2);
bus_space_write_2(aa->aa_bst, ioh, 0x0, 0xF0F0);
for (i = 0; flash_ids[i].name != NULL; i++) {
if ((venid == flash_ids[i].vendor_id) &&
(devid == flash_ids[i].device_id)) {
rv = 1;
break;
}
}
bus_space_unmap(aa->aa_bst, ioh, aa->aa_size);
return rv;
}
static void
flash_attach(device_t parent, device_t self, void *aux)
{
char nbuf[32];
struct flash_softc *sc = device_private(self);
struct arbus_attach_args *aa = aux;
int i;
bus_space_tag_t iot = aa->aa_bst;
bus_space_handle_t ioh;
uint16_t venid, devid;
if (bus_space_map(iot, aa->aa_addr, aa->aa_size, 0, &ioh)) {
printf(": can't map i/o space\n");
return;
}
sc->sc_iot = iot;
sc->sc_ioh = ioh;
sc->sc_status = 0;
bus_space_write_2(aa->aa_bst, ioh, (0x5555 << 1), 0xAAAA);
bus_space_write_2(aa->aa_bst, ioh, (0x2AAA << 1), 0x5555);
bus_space_write_2(aa->aa_bst, ioh, (0x5555 << 1), 0x9090);
delay(100);
venid = bus_space_read_2(aa->aa_bst, ioh, 0);
devid = bus_space_read_2(aa->aa_bst, ioh, 2);
bus_space_write_2(aa->aa_bst, ioh, 0x0, 0xF0F0);
for (i = 0; flash_ids[i].name != NULL; i++) {
if ((venid == flash_ids[i].vendor_id) &&
(devid == flash_ids[i].device_id)) {
break;
}
}
KASSERT(flash_ids[i].name != NULL);
printf(": %s", flash_ids[i].name);
if (humanize_number(nbuf, sizeof(nbuf), flash_ids[i].flash_size, "B",
1024) > 0)
printf(" (%s)", nbuf);
sc->sc_size = flash_ids[i].flash_size;
sc->sc_sector_size = flash_ids[i].sector_size;
sc->sc_buf = kmem_alloc(sc->sc_sector_size, KM_SLEEP);
printf("\n");
}
int
flashopen(dev_t dev, int flag, int mode, struct lwp *l)
{
struct flash_softc *sc;
sc = device_lookup_private(&athflash_cd, minor(dev));
if (sc == NULL)
return ENXIO;
if (sc->sc_status & FLASH_ST_BUSY)
return EBUSY;
sc->sc_status |= FLASH_ST_BUSY;
return 0;
}
int
flashclose(dev_t dev, int flag, int mode, struct lwp *l)
{
struct flash_softc *sc;
sc = device_lookup_private(&athflash_cd, minor(dev));
sc->sc_status &= ~FLASH_ST_BUSY;
return 0;
}
int
flashread(dev_t dev, struct uio *uio, int flag)
{
struct flash_softc *sc;
bus_space_tag_t iot;
bus_space_handle_t ioh;
bus_size_t off;
int total;
int count;
int error;
sc = device_lookup_private(&athflash_cd, minor(dev));
iot = sc->sc_iot;
ioh = sc->sc_ioh;
off = uio->uio_offset;
total = uimin(sc->sc_size - off, uio->uio_resid);
while (total > 0) {
count = uimin(sc->sc_sector_size, uio->uio_resid);
bus_space_read_region_1(iot, ioh, off, sc->sc_buf, count);
if ((error = uiomove(sc->sc_buf, count, uio)) != 0)
return error;
off += count;
total -= count;
}
return 0;
}
int
flashwrite(dev_t dev, struct uio *uio, int flag)
{
struct flash_softc *sc;
bus_size_t off;
int stat;
int error;
sc = device_lookup_private(&athflash_cd, minor(dev));
if (sc->sc_size < uio->uio_offset + uio->uio_resid)
return ENOSPC;
if (uio->uio_offset % sc->sc_sector_size)
return EINVAL;
if (uio->uio_resid % sc->sc_sector_size)
return EINVAL;
for (off = uio->uio_offset;
uio->uio_resid > 0;
off += sc->sc_sector_size) {
error = uiomove(sc->sc_buf, sc->sc_sector_size, uio);
if (error != 0)
return error;
if (is_block_same(sc, off, sc->sc_buf))
continue;
if ((stat = flash_sector_erase(sc, off)) != 0) {
printf("sector erase failed status = 0x%x\n", stat);
return EIO;
}
if ((stat = flash_sector_write(sc, off)) != 0) {
printf("sector write failed status = 0x%x\n", stat);
return EIO;
}
}
return 0;
}
static int
is_block_same(struct flash_softc *sc, bus_size_t offset, const void *bufp)
{
bus_space_tag_t iot = sc->sc_iot;
bus_space_handle_t ioh = sc->sc_ioh;
const u_int8_t *p = bufp;
int count = sc->sc_sector_size;
while (count-- > 0) {
if (bus_space_read_1(iot, ioh, offset++) != *p++)
return 0;
}
return 1;
}
static int
toggle_bit_wait(struct flash_softc *sc, bus_size_t offset,
int typtmo, int maxtmo, int spin)
{
bus_space_tag_t iot = sc->sc_iot;
bus_space_handle_t ioh = sc->sc_ioh;
uint8_t d1, d2;
while (maxtmo > 0) {
if (spin) {
DELAY(typtmo);
} else {
tsleep(sc, PRIBIO, "blockerase",
(typtmo / hz) + 1);
}
d1 = bus_space_read_1(iot, ioh, offset);
d2 = bus_space_read_2(iot, ioh, offset);
if ((d1 & 0x40) == (d2 & 0x40)) {
return 0;
}
maxtmo -= typtmo;
}
return (ETIMEDOUT);
}
static int
flash_sector_erase(struct flash_softc *sc, bus_size_t offset)
{
bus_space_tag_t iot = sc->sc_iot;
bus_space_handle_t ioh = sc->sc_ioh;
DPRINTF(("flash_sector_erase offset = %08lx\n", offset));
bus_space_write_2(iot, ioh, (0x5555 << 1), 0xAAAA);
bus_space_write_2(iot, ioh, (0x2AAA << 1), 0x5555);
bus_space_write_2(iot, ioh, (0x5555 << 1), 0x8080);
bus_space_write_2(iot, ioh, (0x5555 << 1), 0xAAAA);
bus_space_write_2(iot, ioh, (0x2AAA << 1), 0x5555);
bus_space_write_2(iot, ioh, offset, 0x3030);
return toggle_bit_wait(sc, offset, 10000, 60000000, 0);
}
static int
flash_sector_write(struct flash_softc *sc, bus_size_t offset)
{
bus_space_tag_t iot = sc->sc_iot;
bus_space_handle_t ioh = sc->sc_ioh;
bus_size_t fence;
const u_int16_t *p;
p = (u_int16_t *) sc->sc_buf;
fence = offset + sc->sc_sector_size;
do {
bus_space_write_2(iot, ioh, (0x5555 << 1), 0xAAAA);
bus_space_write_2(iot, ioh, (0x2AAA << 1), 0x5555);
bus_space_write_2(iot, ioh, (0xAAAA << 1), 0xA0A0);
bus_space_write_2(iot, ioh, offset, *p);
if (toggle_bit_wait(sc, offset, 10, 1000, 1) != 0)
return ETIMEDOUT;
p++;
offset += 2;
} while (offset < fence);
return 0;
}