#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_usbphyreg.h>
#include <arm/imx/imx23var.h>
struct imx23_usbphy_softc {
device_t sc_dev;
bus_space_tag_t sc_iot;
bus_space_handle_t sc_hdl;
};
static int imx23_usbphy_match(device_t, cfdata_t, void *);
static void imx23_usbphy_attach(device_t, device_t, void *);
static void imx23_usbphy_reset(struct imx23_usbphy_softc *);
static void imx23_usbphy_init(struct imx23_usbphy_softc *);
CFATTACH_DECL_NEW(imx23usbphy, sizeof(struct imx23_usbphy_softc),
imx23_usbphy_match, imx23_usbphy_attach, NULL, NULL);
#define PHY_RD(sc, reg) \
bus_space_read_4(sc->sc_iot, sc->sc_hdl, (reg))
#define PHY_WR(sc, reg, val) \
bus_space_write_4(sc->sc_iot, sc->sc_hdl, (reg), (val))
#define USBPHY_SOFT_RST_LOOP 455
static const struct device_compatible_entry compat_data[] = {
{ .compat = "fsl,imx23-usbphy" },
DEVICE_COMPAT_EOL
};
static int
imx23_usbphy_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_usbphy_attach(device_t parent, device_t self, void *aux)
{
struct imx23_usbphy_softc * const sc = device_private(self);
struct fdt_attach_args * const faa = aux;
const int phandle = faa->faa_phandle;
uint32_t phy_version;
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;
}
imx23_usbphy_reset(sc);
imx23_usbphy_init(sc);
phy_version = PHY_RD(sc, HW_USBPHY_VERSION);
aprint_normal(": USB PHY v%" __PRIuBIT ".%" __PRIuBIT "\n",
__SHIFTOUT(phy_version, HW_USBPHY_VERSION_MAJOR),
__SHIFTOUT(phy_version, HW_USBPHY_VERSION_MINOR));
}
static void
imx23_usbphy_reset(struct imx23_usbphy_softc *sc)
{
unsigned int loop;
PHY_WR(sc, HW_USBPHY_CTRL_CLR, HW_USBPHY_CTRL_SFTRST);
loop = 0;
while ((PHY_RD(sc, HW_USBPHY_CTRL) & HW_USBPHY_CTRL_SFTRST) ||
(loop < USBPHY_SOFT_RST_LOOP))
loop++;
PHY_WR(sc, HW_USBPHY_CTRL_CLR, HW_USBPHY_CTRL_CLKGATE);
PHY_WR(sc, HW_USBPHY_CTRL_SET, HW_USBPHY_CTRL_SFTRST);
while (!(PHY_RD(sc, HW_USBPHY_CTRL) & HW_USBPHY_CTRL_CLKGATE))
continue;
PHY_WR(sc, HW_USBPHY_CTRL_CLR, HW_USBPHY_CTRL_SFTRST);
loop = 0;
while ((PHY_RD(sc, HW_USBPHY_CTRL) & HW_USBPHY_CTRL_SFTRST) ||
(loop < USBPHY_SOFT_RST_LOOP))
loop++;
PHY_WR(sc, HW_USBPHY_CTRL_CLR, HW_USBPHY_CTRL_CLKGATE);
while (PHY_RD(sc, HW_USBPHY_CTRL) & HW_USBPHY_CTRL_CLKGATE)
continue;
}
static void
imx23_usbphy_init(struct imx23_usbphy_softc *sc)
{
PHY_WR(sc, HW_USBPHY_PWD_CLR,
HW_USBPHY_PWD_RXPWDRX |
HW_USBPHY_PWD_RXPWDDIFF |
HW_USBPHY_PWD_RXPWD1PT1 |
HW_USBPHY_PWD_RXPWDENV |
HW_USBPHY_PWD_TXPWDV2I |
HW_USBPHY_PWD_TXPWDIBIAS |
HW_USBPHY_PWD_TXPWDFS
);
PHY_WR(sc, HW_USBPHY_IP_SET,
HW_USBPHY_IP_PLL_POWER);
delay(10);
PHY_WR(sc, HW_USBPHY_IP_SET, HW_USBPHY_IP_PLL_LOCKED);
PHY_WR(sc, HW_USBPHY_IP_SET, HW_USBPHY_IP_EN_USB_CLKS);
}