#include <sys/param.h>
#include <sys/types.h>
#include <sys/bus.h>
#include <sys/cdefs.h>
#include <sys/device.h>
#include <sys/errno.h>
#include <dev/fdt/fdtvar.h>
#include <arm/imx/imx23_clkctrlreg.h>
#include <arm/imx/imx23var.h>
struct imx23_clkctrl_softc {
device_t sc_dev;
bus_space_tag_t sc_iot;
bus_space_handle_t sc_hdl;
};
static int imx23_clkctrl_match(device_t, cfdata_t, void *);
static void imx23_clkctrl_attach(device_t, device_t, void *);
CFATTACH_DECL_NEW(imx23clkctrl, sizeof(struct imx23_clkctrl_softc),
imx23_clkctrl_match, imx23_clkctrl_attach, NULL, NULL);
#define CLKCTRL_RD(sc, reg) \
bus_space_read_4(sc->sc_iot, sc->sc_hdl, (reg))
#define CLKCTRL_WR(sc, reg, val) \
bus_space_write_4(sc->sc_iot, sc->sc_hdl, (reg), (val))
#define CLKCTRL_SOFT_RST_LOOP 455
static const struct device_compatible_entry compat_data[] = {
{ .compat = "fsl,imx23-clkctrl" },
{ .compat = "fsl,clkctrl" },
DEVICE_COMPAT_EOL
};
static int
imx23_clkctrl_match(device_t parent, cfdata_t match, void *aux)
{
struct fdt_attach_args * const faa = aux;
return of_compatible_match(faa->faa_phandle, compat_data);
}
static void
imx23_clkctrl_attach(device_t parent, device_t self, void *aux)
{
struct imx23_clkctrl_softc * const sc = device_private(self);
struct fdt_attach_args * const faa = aux;
const int phandle = faa->faa_phandle;
sc->sc_dev = self;
sc->sc_iot = faa->faa_bst;
bus_addr_t addr;
bus_size_t size;
if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) {
aprint_error(": couldn't get register address\n");
return;
}
if (bus_space_map(faa->faa_bst, addr, size, 0, &sc->sc_hdl)) {
aprint_error(": couldn't map registers\n");
return;
}
CLKCTRL_WR(sc, HW_CLKCTRL_PLLCTRL0_SET,
HW_CLKCTRL_PLLCTRL0_EN_USB_CLKS);
CLKCTRL_WR(sc, HW_CLKCTRL_XTAL_CLR, HW_CLKCTRL_XTAL_FILT_CLK24M_GATE);
aprint_normal("\n");
}