#include <sys/cdefs.h>
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/module.h>
#include <sys/bus.h>
#include <sys/rman.h>
#include <dev/ofw/ofw_bus.h>
#include <dev/ofw/ofw_bus_subr.h>
#include <machine/bus.h>
#include <arm/freescale/fsl_ocotpreg.h>
#include <arm/freescale/fsl_ocotpvar.h>
#include <vm/vm.h>
#include <vm/pmap.h>
#include <dev/fdt/fdt_common.h>
static uint32_t *ocotp_regs;
static vm_size_t ocotp_size;
static void
fsl_ocotp_devmap(void)
{
phandle_t child, root;
u_long base, size;
if ((root = OF_finddevice("/")) == -1)
goto fatal;
if ((child = fdt_depth_search_compatible(root, "fsl,imx6q-ocotp", 0)) == 0)
goto fatal;
if (fdt_regsize(child, &base, &size) != 0)
goto fatal;
ocotp_size = (vm_size_t)size;
if ((ocotp_regs = pmap_mapdev((vm_paddr_t)base, ocotp_size)) == NULL)
goto fatal;
return;
fatal:
panic("cannot find/map the ocotp registers");
}
struct ocotp_softc {
device_t dev;
struct resource *mem_res;
};
static struct ocotp_softc *ocotp_sc;
static inline uint32_t
RD4(struct ocotp_softc *sc, bus_size_t off)
{
return (bus_read_4(sc->mem_res, off));
}
static int
ocotp_detach(device_t dev)
{
return (EBUSY);
}
static int
ocotp_attach(device_t dev)
{
struct ocotp_softc *sc;
int err, rid;
sc = device_get_softc(dev);
sc->dev = dev;
rid = 0;
sc->mem_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
RF_ACTIVE);
if (sc->mem_res == NULL) {
device_printf(dev, "Cannot allocate memory resources\n");
err = ENXIO;
goto out;
}
ocotp_sc = sc;
if (ocotp_regs != NULL)
pmap_unmapdev(ocotp_regs, ocotp_size);
err = 0;
out:
if (err != 0)
ocotp_detach(dev);
return (err);
}
static int
ocotp_probe(device_t dev)
{
if (!ofw_bus_status_okay(dev))
return (ENXIO);
if (ofw_bus_is_compatible(dev, "fsl,imx6q-ocotp") == 0)
return (ENXIO);
device_set_desc(dev,
"Freescale On-Chip One-Time-Programmable Memory");
return (BUS_PROBE_DEFAULT);
}
uint32_t
fsl_ocotp_read_4(bus_size_t off)
{
if (off > FSL_OCOTP_LAST_REG)
panic("fsl_ocotp_read_4: offset out of range");
if (ocotp_sc != NULL)
return (RD4(ocotp_sc, off));
if (ocotp_regs == NULL)
fsl_ocotp_devmap();
return (ocotp_regs[off / 4]);
}
static device_method_t ocotp_methods[] = {
DEVMETHOD(device_probe, ocotp_probe),
DEVMETHOD(device_attach, ocotp_attach),
DEVMETHOD(device_detach, ocotp_detach),
DEVMETHOD_END
};
static driver_t ocotp_driver = {
"ocotp",
ocotp_methods,
sizeof(struct ocotp_softc)
};
EARLY_DRIVER_MODULE(ocotp, simplebus, ocotp_driver, 0, 0,
BUS_PASS_CPU + BUS_PASS_ORDER_FIRST);