Implement a driver for the PowerPC-base RouterBoard (RB333/600/800/1100)
Summary: This has been tested on the RB800, but should work on the RB333, RB600, and RB1100 as well. It's currently missing ECC support, but read and write are complete. Reviewers: imp Reviewed By: imp Subscribers: imp Differential Revision: https://reviews.freebsd.org/D2223
This commit is contained in:
parent
b208a147b9
commit
98be38e7fb
@ -43,6 +43,7 @@ dev/iicbus/ds1775.c optional ds1775 powermac
|
||||
dev/iicbus/max6690.c optional max6690 powermac
|
||||
dev/kbd/kbd.c optional sc | vt
|
||||
dev/nand/nfc_fsl.c optional nand mpc85xx
|
||||
dev/nand/nfc_rb.c optional nand mpc85xx
|
||||
# ofw can be either aim or fdt: fdt case handled in files. aim only powerpc specific.
|
||||
dev/ofw/openfirm.c optional aim
|
||||
dev/ofw/openfirmio.c optional aim
|
||||
|
275
sys/dev/nand/nfc_rb.c
Normal file
275
sys/dev/nand/nfc_rb.c
Normal file
@ -0,0 +1,275 @@
|
||||
/*-
|
||||
* Copyright (C) 2015 Justin Hibbits
|
||||
* All rights reserved.
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
* 1. Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
* 2. Redistributions in binary form must reproduce the above copyright
|
||||
* notice, this list of conditions and the following disclaimer in the
|
||||
* documentation and/or other materials provided with the distribution.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
||||
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
|
||||
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
||||
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
||||
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
||||
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
||||
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
||||
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
||||
* SUCH DAMAGE.
|
||||
*/
|
||||
|
||||
/* RouterBoard 600/800 NAND controller driver. */
|
||||
|
||||
#include <sys/cdefs.h>
|
||||
__FBSDID("$FreeBSD$");
|
||||
|
||||
#include <sys/param.h>
|
||||
#include <sys/systm.h>
|
||||
#include <sys/proc.h>
|
||||
#include <sys/bus.h>
|
||||
#include <sys/conf.h>
|
||||
#include <sys/kernel.h>
|
||||
#include <sys/module.h>
|
||||
#include <sys/malloc.h>
|
||||
#include <sys/rman.h>
|
||||
#include <sys/lock.h>
|
||||
#include <sys/mutex.h>
|
||||
#include <sys/time.h>
|
||||
|
||||
#include <machine/bus.h>
|
||||
|
||||
#include <dev/ofw/ofw_bus.h>
|
||||
#include <dev/ofw/ofw_bus_subr.h>
|
||||
|
||||
#include <dev/nand/nand.h>
|
||||
#include <dev/nand/nandbus.h>
|
||||
#include "nfc_if.h"
|
||||
#include "gpio_if.h"
|
||||
|
||||
#define RB_NAND_DATA (0x00)
|
||||
|
||||
struct rb_nand_softc {
|
||||
struct nand_softc nand_dev;
|
||||
struct resource *sc_mem;
|
||||
int rid;
|
||||
device_t sc_gpio;
|
||||
uint32_t sc_rdy_pin;
|
||||
uint32_t sc_nce_pin;
|
||||
uint32_t sc_cle_pin;
|
||||
uint32_t sc_ale_pin;
|
||||
};
|
||||
|
||||
static int rb_nand_attach(device_t);
|
||||
static int rb_nand_probe(device_t);
|
||||
static int rb_nand_send_command(device_t, uint8_t);
|
||||
static int rb_nand_send_address(device_t, uint8_t);
|
||||
static uint8_t rb_nand_read_byte(device_t);
|
||||
static void rb_nand_read_buf(device_t, void *, uint32_t);
|
||||
static void rb_nand_write_buf(device_t, void *, uint32_t);
|
||||
static int rb_nand_select_cs(device_t, uint8_t);
|
||||
static int rb_nand_read_rnb(device_t);
|
||||
|
||||
static device_method_t rb_nand_methods[] = {
|
||||
DEVMETHOD(device_probe, rb_nand_probe),
|
||||
DEVMETHOD(device_attach, rb_nand_attach),
|
||||
|
||||
DEVMETHOD(nfc_send_command, rb_nand_send_command),
|
||||
DEVMETHOD(nfc_send_address, rb_nand_send_address),
|
||||
DEVMETHOD(nfc_read_byte, rb_nand_read_byte),
|
||||
DEVMETHOD(nfc_read_buf, rb_nand_read_buf),
|
||||
DEVMETHOD(nfc_write_buf, rb_nand_write_buf),
|
||||
DEVMETHOD(nfc_select_cs, rb_nand_select_cs),
|
||||
DEVMETHOD(nfc_read_rnb, rb_nand_read_rnb),
|
||||
|
||||
{ 0, 0 },
|
||||
};
|
||||
|
||||
static driver_t rb_nand_driver = {
|
||||
"nand",
|
||||
rb_nand_methods,
|
||||
sizeof(struct rb_nand_softc),
|
||||
};
|
||||
|
||||
static devclass_t rb_nand_devclass;
|
||||
DRIVER_MODULE(rb_nand, ofwbus, rb_nand_driver, rb_nand_devclass, 0, 0);
|
||||
|
||||
#if 0
|
||||
static const struct nand_ecc_data rb_ecc = {
|
||||
.eccsize = 6,
|
||||
.eccmode = NAND_ECC_SOFT,
|
||||
.eccbytes = 6,
|
||||
.eccpositions = { 8, 9, 10, 13, 14, 15 },
|
||||
};
|
||||
#endif
|
||||
|
||||
static int
|
||||
rb_nand_probe(device_t dev)
|
||||
{
|
||||
const char *device_type;
|
||||
|
||||
device_type = ofw_bus_get_type(dev);
|
||||
|
||||
if (!device_type || strcmp(device_type, "rb,nand"))
|
||||
return (ENXIO);
|
||||
|
||||
device_set_desc(dev, "RouterBoard 333/600/800 NAND controller");
|
||||
return (BUS_PROBE_DEFAULT);
|
||||
}
|
||||
|
||||
static int
|
||||
rb_nand_attach(device_t dev)
|
||||
{
|
||||
struct rb_nand_softc *sc;
|
||||
phandle_t node;
|
||||
uint32_t ale[2],cle[2],nce[2],rdy[2];
|
||||
int err;
|
||||
|
||||
sc = device_get_softc(dev);
|
||||
node = ofw_bus_get_node(dev);
|
||||
|
||||
if (OF_getprop(node, "ale", ale, sizeof(ale)) <= 0) {
|
||||
return (ENXIO);
|
||||
}
|
||||
if (OF_getprop(node, "cle", cle, sizeof(cle)) <= 0) {
|
||||
return (ENXIO);
|
||||
}
|
||||
if (OF_getprop(node, "nce", nce, sizeof(nce)) <= 0) {
|
||||
return (ENXIO);
|
||||
}
|
||||
if (OF_getprop(node, "rdy", rdy, sizeof(rdy)) <= 0) {
|
||||
return (ENXIO);
|
||||
}
|
||||
|
||||
if (ale[0] != cle[0] || ale[0] != nce[0] || ale[0] != rdy[0]) {
|
||||
device_printf(dev, "GPIO handles for signals must match.\n");
|
||||
return (ENXIO);
|
||||
}
|
||||
sc->sc_ale_pin = ale[1];
|
||||
sc->sc_cle_pin = cle[1];
|
||||
sc->sc_nce_pin = nce[1];
|
||||
sc->sc_rdy_pin = rdy[1];
|
||||
|
||||
sc->sc_gpio = OF_device_from_xref(ale[0]);
|
||||
if (sc->sc_gpio == NULL) {
|
||||
device_printf(dev, "No GPIO resource found!\n");
|
||||
return (ENXIO);
|
||||
}
|
||||
|
||||
sc->sc_mem = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &sc->rid,
|
||||
RF_ACTIVE);
|
||||
if (sc->sc_mem == NULL) {
|
||||
device_printf(dev, "could not allocate resources!\n");
|
||||
return (ENXIO);
|
||||
}
|
||||
|
||||
nand_init(&sc->nand_dev, dev, NAND_ECC_SOFT, 0, 0, NULL, NULL);
|
||||
|
||||
err = nandbus_create(dev);
|
||||
|
||||
return (err);
|
||||
}
|
||||
|
||||
static int
|
||||
rb_nand_send_command(device_t dev, uint8_t command)
|
||||
{
|
||||
struct rb_nand_softc *sc;
|
||||
|
||||
nand_debug(NDBG_DRV,"rb_nand: send command %x", command);
|
||||
|
||||
sc = device_get_softc(dev);
|
||||
GPIO_PIN_SET(sc->sc_gpio, sc->sc_cle_pin, 1);
|
||||
GPIO_PIN_SET(sc->sc_gpio, sc->sc_ale_pin, 0);
|
||||
GPIO_PIN_SET(sc->sc_gpio, sc->sc_nce_pin, 0);
|
||||
bus_write_1(sc->sc_mem, RB_NAND_DATA, command);
|
||||
GPIO_PIN_SET(sc->sc_gpio, sc->sc_cle_pin, 0);
|
||||
return (0);
|
||||
}
|
||||
|
||||
static int
|
||||
rb_nand_send_address(device_t dev, uint8_t addr)
|
||||
{
|
||||
struct rb_nand_softc *sc;
|
||||
|
||||
nand_debug(NDBG_DRV,"rb_nand: send address %x", addr);
|
||||
|
||||
sc = device_get_softc(dev);
|
||||
GPIO_PIN_SET(sc->sc_gpio, sc->sc_cle_pin, 0);
|
||||
GPIO_PIN_SET(sc->sc_gpio, sc->sc_ale_pin, 1);
|
||||
GPIO_PIN_SET(sc->sc_gpio, sc->sc_nce_pin, 0);
|
||||
bus_write_1(sc->sc_mem, RB_NAND_DATA, addr);
|
||||
GPIO_PIN_SET(sc->sc_gpio, sc->sc_ale_pin, 0);
|
||||
return (0);
|
||||
}
|
||||
|
||||
static uint8_t
|
||||
rb_nand_read_byte(device_t dev)
|
||||
{
|
||||
struct rb_nand_softc *sc;
|
||||
uint8_t data;
|
||||
|
||||
sc = device_get_softc(dev);
|
||||
data = bus_read_1(sc->sc_mem, RB_NAND_DATA);
|
||||
|
||||
nand_debug(NDBG_DRV,"rb_nand: read %x", data);
|
||||
|
||||
return (data);
|
||||
}
|
||||
|
||||
static void
|
||||
rb_nand_read_buf(device_t dev, void* buf, uint32_t len)
|
||||
{
|
||||
struct rb_nand_softc *sc;
|
||||
|
||||
sc = device_get_softc(dev);
|
||||
|
||||
bus_read_region_1(sc->sc_mem, RB_NAND_DATA, buf, len);
|
||||
}
|
||||
|
||||
static void
|
||||
rb_nand_write_buf(device_t dev, void* buf, uint32_t len)
|
||||
{
|
||||
struct rb_nand_softc *sc;
|
||||
int i;
|
||||
uint8_t *b = (uint8_t*)buf;
|
||||
|
||||
sc = device_get_softc(dev);
|
||||
|
||||
for (i = 0; i < len; i++) {
|
||||
#ifdef NAND_DEBUG
|
||||
if (!(i % 16))
|
||||
printf("%s", i == 0 ? "rb_nand:\n" : "\n");
|
||||
printf(" %x", b[i]);
|
||||
if (i == len - 1)
|
||||
printf("\n");
|
||||
#endif
|
||||
bus_write_1(sc->sc_mem, RB_NAND_DATA, b[i]);
|
||||
}
|
||||
}
|
||||
|
||||
static int
|
||||
rb_nand_select_cs(device_t dev, uint8_t cs)
|
||||
{
|
||||
|
||||
if (cs > 0)
|
||||
return (ENODEV);
|
||||
|
||||
return (0);
|
||||
}
|
||||
|
||||
static int
|
||||
rb_nand_read_rnb(device_t dev)
|
||||
{
|
||||
struct rb_nand_softc *sc;
|
||||
uint32_t rdy_bit;
|
||||
|
||||
sc = device_get_softc(dev);
|
||||
GPIO_PIN_GET(sc->sc_gpio, sc->sc_rdy_pin, &rdy_bit);
|
||||
|
||||
return (rdy_bit); /* ready */
|
||||
}
|
Loading…
x
Reference in New Issue
Block a user