#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/module.h>
#include <sys/errno.h>
#include <sys/rman.h>
#include <sys/bus.h>
#include <machine/bus.h>
#include <dev/bhnd/bhndvar.h>
#include <dev/spibus/spi.h>
#include "bhnd_chipc_if.h"
#include "spibus_if.h"
#include "chipcreg.h"
#include "chipcvar.h"
#include "chipc_slicer.h"
#include "chipc_spi.h"
static int chipc_spi_probe(device_t dev);
static int chipc_spi_attach(device_t dev);
static int chipc_spi_detach(device_t dev);
static int chipc_spi_transfer(device_t dev, device_t child,
struct spi_command *cmd);
static int chipc_spi_txrx(struct chipc_spi_softc *sc, uint8_t in,
uint8_t* out);
static int chipc_spi_wait(struct chipc_spi_softc *sc);
static int
chipc_spi_probe(device_t dev)
{
device_set_desc(dev, "Broadcom ChipCommon SPI");
return (BUS_PROBE_NOWILDCARD);
}
static int
chipc_spi_attach(device_t dev)
{
struct chipc_spi_softc *sc;
struct chipc_caps *ccaps;
device_t flash_dev;
device_t spibus;
const char *flash_name;
int error;
sc = device_get_softc(dev);
sc->sc_rid = 1;
sc->sc_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &sc->sc_rid,
RF_ACTIVE);
if (sc->sc_res == NULL) {
device_printf(dev, "failed to allocate device registers\n");
return (ENXIO);
}
sc->sc_flash_rid = 0;
sc->sc_flash_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
&sc->sc_flash_rid, RF_ACTIVE);
if (sc->sc_flash_res == NULL) {
device_printf(dev, "failed to allocate flash region\n");
error = ENXIO;
goto failed;
}
if ((spibus = device_add_child(dev, "spibus",
DEVICE_UNIT_ANY)) == NULL) {
device_printf(dev, "failed to add spibus\n");
error = ENXIO;
goto failed;
}
bus_attach_children(dev);
ccaps = BHND_CHIPC_GET_CAPS(device_get_parent(dev));
flash_name = chipc_sflash_device_name(ccaps->flash_type);
if (flash_name != NULL) {
flash_dev = BUS_ADD_CHILD(spibus, 0, flash_name,
DEVICE_UNIT_ANY);
if (flash_dev == NULL) {
device_printf(dev, "failed to add %s\n", flash_name);
error = ENXIO;
goto failed;
}
chipc_register_slicer(ccaps->flash_type);
if ((error = device_probe_and_attach(flash_dev))) {
device_printf(dev, "failed to attach %s: %d\n",
flash_name, error);
goto failed;
}
}
return (0);
failed:
device_delete_children(dev);
if (sc->sc_res != NULL)
bus_release_resource(dev, SYS_RES_MEMORY, sc->sc_rid,
sc->sc_res);
if (sc->sc_flash_res != NULL)
bus_release_resource(dev, SYS_RES_MEMORY, sc->sc_flash_rid,
sc->sc_flash_res);
return (error);
}
static int
chipc_spi_detach(device_t dev)
{
struct chipc_spi_softc *sc;
int error;
sc = device_get_softc(dev);
if ((error = bus_generic_detach(dev)))
return (error);
bus_release_resource(dev, SYS_RES_MEMORY, sc->sc_rid, sc->sc_res);
bus_release_resource(dev, SYS_RES_MEMORY, sc->sc_flash_rid,
sc->sc_flash_res);
return (0);
}
static int
chipc_spi_wait(struct chipc_spi_softc *sc)
{
int i;
for (i = CHIPC_SPI_MAXTRIES; i > 0; i--)
if (!(SPI_READ(sc, CHIPC_SPI_FLASHCTL) & CHIPC_SPI_FLASHCTL_START))
break;
if (i > 0)
return (0);
BHND_WARN_DEV(sc->sc_dev, "busy: CTL=0x%x DATA=0x%x",
SPI_READ(sc, CHIPC_SPI_FLASHCTL),
SPI_READ(sc, CHIPC_SPI_FLASHDATA));
return (-1);
}
static int
chipc_spi_txrx(struct chipc_spi_softc *sc, uint8_t out, uint8_t* in)
{
uint32_t ctl;
ctl = CHIPC_SPI_FLASHCTL_START | CHIPC_SPI_FLASHCTL_CSACTIVE | out;
SPI_BARRIER_WRITE(sc);
SPI_WRITE(sc, CHIPC_SPI_FLASHCTL, ctl);
SPI_BARRIER_WRITE(sc);
if (chipc_spi_wait(sc))
return (-1);
*in = SPI_READ(sc, CHIPC_SPI_FLASHDATA) & 0xff;
return (0);
}
static int
chipc_spi_transfer(device_t dev, device_t child, struct spi_command *cmd)
{
struct chipc_spi_softc *sc;
uint8_t *buf_in;
uint8_t *buf_out;
int i;
sc = device_get_softc(dev);
KASSERT(cmd->tx_cmd_sz == cmd->rx_cmd_sz,
("TX/RX command sizes should be equal"));
KASSERT(cmd->tx_data_sz == cmd->rx_data_sz,
("TX/RX data sizes should be equal"));
if (cmd->tx_cmd_sz == 0) {
BHND_DEBUG_DEV(child, "size of command is ZERO");
return (EIO);
}
SPI_BARRIER_WRITE(sc);
SPI_WRITE(sc, CHIPC_SPI_FLASHADDR, 0);
SPI_BARRIER_WRITE(sc);
buf_out = (uint8_t *)cmd->tx_cmd;
buf_in = (uint8_t *)cmd->rx_cmd;
for (i = 0; i < cmd->tx_cmd_sz; i++)
if (chipc_spi_txrx(sc, buf_out[i], &(buf_in[i])))
return (EIO);
buf_out = (uint8_t *)cmd->tx_data;
buf_in = (uint8_t *)cmd->rx_data;
for (i = 0; i < cmd->tx_data_sz; i++)
if (chipc_spi_txrx(sc, buf_out[i], &(buf_in[i])))
return (EIO);
SPI_BARRIER_WRITE(sc);
SPI_WRITE(sc, CHIPC_SPI_FLASHCTL, 0);
SPI_BARRIER_WRITE(sc);
return (0);
}
static device_method_t chipc_spi_methods[] = {
DEVMETHOD(device_probe, chipc_spi_probe),
DEVMETHOD(device_attach, chipc_spi_attach),
DEVMETHOD(device_detach, chipc_spi_detach),
DEVMETHOD(spibus_transfer, chipc_spi_transfer),
DEVMETHOD_END
};
static driver_t chipc_spi_driver = {
"spi",
chipc_spi_methods,
sizeof(struct chipc_spi_softc),
};
DRIVER_MODULE(chipc_spi, bhnd_chipc, chipc_spi_driver, 0, 0);