f-stack/freebsd/arm/allwinner/a10_sramc.c

153 lines
3.9 KiB
C

/*-
* Copyright (c) 2013 Ganbold Tsagaankhuu <ganbold@freebsd.org>
* 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.
*
* $FreeBSD$
*/
#include <sys/cdefs.h>
__FBSDID("$FreeBSD$");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/bus.h>
#include <sys/kernel.h>
#include <sys/module.h>
#include <sys/malloc.h>
#include <sys/rman.h>
#include <sys/timeet.h>
#include <sys/timetc.h>
#include <sys/watchdog.h>
#include <machine/bus.h>
#include <machine/cpu.h>
#include <machine/frame.h>
#include <machine/intr.h>
#include <dev/fdt/fdt_common.h>
#include <dev/ofw/openfirm.h>
#include <dev/ofw/ofw_bus.h>
#include <dev/ofw/ofw_bus_subr.h>
#include "a10_sramc.h"
#define SRAM_CTL1_CFG 0x04
#define CTL1_CFG_SRAMD_MAP_USB0 (1 << 0)
struct a10_sramc_softc {
struct resource *res;
bus_space_tag_t bst;
bus_space_handle_t bsh;
};
static struct a10_sramc_softc *a10_sramc_sc;
#define sramc_read_4(sc, reg) \
bus_space_read_4((sc)->bst, (sc)->bsh, (reg))
#define sramc_write_4(sc, reg, val) \
bus_space_write_4((sc)->bst, (sc)->bsh, (reg), (val))
static int
a10_sramc_probe(device_t dev)
{
if (ofw_bus_is_compatible(dev, "allwinner,sun4i-a10-sram-controller")) {
device_set_desc(dev, "Allwinner sramc module");
return (BUS_PROBE_DEFAULT);
}
return (ENXIO);
}
static int
a10_sramc_attach(device_t dev)
{
struct a10_sramc_softc *sc = device_get_softc(dev);
int rid = 0;
sc->res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid, RF_ACTIVE);
if (!sc->res) {
device_printf(dev, "could not allocate resource\n");
return (ENXIO);
}
sc->bst = rman_get_bustag(sc->res);
sc->bsh = rman_get_bushandle(sc->res);
a10_sramc_sc = sc;
return (0);
}
static device_method_t a10_sramc_methods[] = {
DEVMETHOD(device_probe, a10_sramc_probe),
DEVMETHOD(device_attach, a10_sramc_attach),
{ 0, 0 }
};
static driver_t a10_sramc_driver = {
"a10_sramc",
a10_sramc_methods,
sizeof(struct a10_sramc_softc),
};
static devclass_t a10_sramc_devclass;
EARLY_DRIVER_MODULE(a10_sramc, simplebus, a10_sramc_driver, a10_sramc_devclass,
0, 0, BUS_PASS_RESOURCE + BUS_PASS_ORDER_EARLY);
int
a10_map_to_emac(void)
{
struct a10_sramc_softc *sc = a10_sramc_sc;
uint32_t reg_value;
if (sc == NULL)
return (ENXIO);
/* Map SRAM to EMAC, set bit 2 and 4. */
reg_value = sramc_read_4(sc, SRAM_CTL1_CFG);
reg_value |= 0x5 << 2;
sramc_write_4(sc, SRAM_CTL1_CFG, reg_value);
return (0);
}
int
a10_map_to_otg(void)
{
struct a10_sramc_softc *sc = a10_sramc_sc;
uint32_t reg_value;
if (sc == NULL)
return (ENXIO);
/* Map SRAM to OTG */
reg_value = sramc_read_4(sc, SRAM_CTL1_CFG);
reg_value |= CTL1_CFG_SRAMD_MAP_USB0;
sramc_write_4(sc, SRAM_CTL1_CFG, reg_value);
return (0);
}