#include <sys/types.h>
#include <uvm/uvm_extern.h>
#include <dev/fdt/fdt_platform.h>
#include <dev/fdt/fdtvar.h>
#include <arch/evbarm/fdt/platform.h>
#include <arm/cpufunc.h>
#include <arm/fdt/arm_fdtvar.h>
#include <arm/imx/imx23_clkctrlreg.h>
#include <arm/imx/imx23_digctlreg.h>
#include <arm/imx/imx23var.h>
#include <evbarm/dev/plcomreg.h>
#include "opt_console.h"
#define REG_RD(reg) *(volatile uint32_t *)(reg)
#define REG_WR(reg, val) \
do { \
*(volatile uint32_t *)((reg)) = val; \
} while (0)
void imx23_platform_early_putchar(char);
static const struct pmap_devmap *imx23_platform_devmap(void);
void
imx23_platform_early_putchar(char c)
{
#ifdef CONSADDR
#define CONSADDR_VA ((CONSADDR - APBH_BASE) + KERNEL_IO_VBASE)
volatile uint32_t *uartaddr = cpu_earlydevice_va_p()
? (volatile uint32_t *)CONSADDR_VA
: (volatile uint32_t *)CONSADDR;
while ((le32toh(uartaddr[PL01XCOM_FR / 4]) & PL01X_FR_TXFF) != 0)
continue;
uartaddr[PL01XCOM_DR / 4] = htole32(c);
dsb(sy);
while ((le32toh(uartaddr[PL01XCOM_FR / 4]) & PL01X_FR_TXFE) == 0)
continue;
#endif
}
static const struct pmap_devmap *
imx23_platform_devmap(void) {
static const struct pmap_devmap devmap[] = {
DEVMAP_ENTRY(
APBH_BASE,
APBH_BASE,
APBH_SIZE + APBX_SIZE
),
DEVMAP_ENTRY_END
};
return devmap;
}
static void
imx23_platform_init_attach_args(struct fdt_attach_args *faa)
{
faa->faa_bst = &imx23_bus_space;
faa->faa_dmat = &imx23_bus_dma_tag;
}
static void
imx23_platform_device_register(device_t self, void *aux)
{
}
static void
imx23_platform_reset(void)
{
REG_WR(HW_CLKCTRL_BASE + HW_CLKCTRL_RESET, HW_CLKCTRL_RESET_CHIP);
}
static void
imx23_platform_delay(unsigned int us)
{
uint32_t start;
uint32_t now;
uint32_t elapsed;
uint32_t total;
uint32_t last;
total = 0;
last = 0;
start = REG_RD(HW_DIGCTL_BASE + HW_DIGCTL_MICROSECONDS);
do {
now = REG_RD(HW_DIGCTL_BASE + HW_DIGCTL_MICROSECONDS);
if (start <= now)
elapsed = now - start;
else
elapsed = (UINT32_MAX - start) + 1 + now;
total += elapsed - last;
last = elapsed;
} while (total < us);
}
static u_int
imx23_platform_uart_freq(void)
{
return 24000000;
}
static const struct fdt_platform imx23_platform = {
.fp_devmap = imx23_platform_devmap,
.fp_bootstrap = arm_fdt_cpu_bootstrap,
.fp_init_attach_args = imx23_platform_init_attach_args,
.fp_device_register = imx23_platform_device_register,
.fp_reset = imx23_platform_reset,
.fp_delay = imx23_platform_delay,
.fp_uart_freq = imx23_platform_uart_freq,
};
FDT_PLATFORM(imx23, "fsl,imx23", &imx23_platform);