|  | /* | 
|  | * IMX31 Clock Control Module | 
|  | * | 
|  | * Copyright (C) 2012 NICTA | 
|  | * Updated by Jean-Christophe Dubois <jcd@tribudubois.net> | 
|  | * | 
|  | * This work is licensed under the terms of the GNU GPL, version 2 or later. | 
|  | * See the COPYING file in the top-level directory. | 
|  | * | 
|  | * To get the timer frequencies right, we need to emulate at least part of | 
|  | * the i.MX31 CCM. | 
|  | */ | 
|  |  | 
|  | #include "qemu/osdep.h" | 
|  | #include "hw/misc/imx31_ccm.h" | 
|  | #include "migration/vmstate.h" | 
|  | #include "qemu/log.h" | 
|  | #include "qemu/module.h" | 
|  |  | 
|  | #define CKIH_FREQ 26000000 /* 26MHz crystal input */ | 
|  |  | 
|  | #ifndef DEBUG_IMX31_CCM | 
|  | #define DEBUG_IMX31_CCM 0 | 
|  | #endif | 
|  |  | 
|  | #define DPRINTF(fmt, args...) \ | 
|  | do { \ | 
|  | if (DEBUG_IMX31_CCM) { \ | 
|  | fprintf(stderr, "[%s]%s: " fmt , TYPE_IMX31_CCM, \ | 
|  | __func__, ##args); \ | 
|  | } \ | 
|  | } while (0) | 
|  |  | 
|  | static const char *imx31_ccm_reg_name(uint32_t reg) | 
|  | { | 
|  | static char unknown[20]; | 
|  |  | 
|  | switch (reg) { | 
|  | case IMX31_CCM_CCMR_REG: | 
|  | return "CCMR"; | 
|  | case IMX31_CCM_PDR0_REG: | 
|  | return "PDR0"; | 
|  | case IMX31_CCM_PDR1_REG: | 
|  | return "PDR1"; | 
|  | case IMX31_CCM_RCSR_REG: | 
|  | return "RCSR"; | 
|  | case IMX31_CCM_MPCTL_REG: | 
|  | return "MPCTL"; | 
|  | case IMX31_CCM_UPCTL_REG: | 
|  | return "UPCTL"; | 
|  | case IMX31_CCM_SPCTL_REG: | 
|  | return "SPCTL"; | 
|  | case IMX31_CCM_COSR_REG: | 
|  | return "COSR"; | 
|  | case IMX31_CCM_CGR0_REG: | 
|  | return "CGR0"; | 
|  | case IMX31_CCM_CGR1_REG: | 
|  | return "CGR1"; | 
|  | case IMX31_CCM_CGR2_REG: | 
|  | return "CGR2"; | 
|  | case IMX31_CCM_WIMR_REG: | 
|  | return "WIMR"; | 
|  | case IMX31_CCM_LDC_REG: | 
|  | return "LDC"; | 
|  | case IMX31_CCM_DCVR0_REG: | 
|  | return "DCVR0"; | 
|  | case IMX31_CCM_DCVR1_REG: | 
|  | return "DCVR1"; | 
|  | case IMX31_CCM_DCVR2_REG: | 
|  | return "DCVR2"; | 
|  | case IMX31_CCM_DCVR3_REG: | 
|  | return "DCVR3"; | 
|  | case IMX31_CCM_LTR0_REG: | 
|  | return "LTR0"; | 
|  | case IMX31_CCM_LTR1_REG: | 
|  | return "LTR1"; | 
|  | case IMX31_CCM_LTR2_REG: | 
|  | return "LTR2"; | 
|  | case IMX31_CCM_LTR3_REG: | 
|  | return "LTR3"; | 
|  | case IMX31_CCM_LTBR0_REG: | 
|  | return "LTBR0"; | 
|  | case IMX31_CCM_LTBR1_REG: | 
|  | return "LTBR1"; | 
|  | case IMX31_CCM_PMCR0_REG: | 
|  | return "PMCR0"; | 
|  | case IMX31_CCM_PMCR1_REG: | 
|  | return "PMCR1"; | 
|  | case IMX31_CCM_PDR2_REG: | 
|  | return "PDR2"; | 
|  | default: | 
|  | snprintf(unknown, sizeof(unknown), "[%u ?]", reg); | 
|  | return unknown; | 
|  | } | 
|  | } | 
|  |  | 
|  | static const VMStateDescription vmstate_imx31_ccm = { | 
|  | .name = TYPE_IMX31_CCM, | 
|  | .version_id = 2, | 
|  | .minimum_version_id = 2, | 
|  | .fields = (const VMStateField[]) { | 
|  | VMSTATE_UINT32_ARRAY(reg, IMX31CCMState, IMX31_CCM_MAX_REG), | 
|  | VMSTATE_END_OF_LIST() | 
|  | }, | 
|  | }; | 
|  |  | 
|  | static uint32_t imx31_ccm_get_pll_ref_clk(IMXCCMState *dev) | 
|  | { | 
|  | uint32_t freq = 0; | 
|  | IMX31CCMState *s = IMX31_CCM(dev); | 
|  |  | 
|  | if ((s->reg[IMX31_CCM_CCMR_REG] & CCMR_PRCS) == 2) { | 
|  | if (s->reg[IMX31_CCM_CCMR_REG] & CCMR_FPME) { | 
|  | freq = CKIL_FREQ; | 
|  | if (s->reg[IMX31_CCM_CCMR_REG] & CCMR_FPMF) { | 
|  | freq *= 1024; | 
|  | } | 
|  | } | 
|  | } else { | 
|  | freq = CKIH_FREQ; | 
|  | } | 
|  |  | 
|  | DPRINTF("freq = %u\n", freq); | 
|  |  | 
|  | return freq; | 
|  | } | 
|  |  | 
|  | static uint32_t imx31_ccm_get_mpll_clk(IMXCCMState *dev) | 
|  | { | 
|  | uint32_t freq; | 
|  | IMX31CCMState *s = IMX31_CCM(dev); | 
|  |  | 
|  | freq = imx_ccm_calc_pll(s->reg[IMX31_CCM_MPCTL_REG], | 
|  | imx31_ccm_get_pll_ref_clk(dev)); | 
|  |  | 
|  | DPRINTF("freq = %u\n", freq); | 
|  |  | 
|  | return freq; | 
|  | } | 
|  |  | 
|  | static uint32_t imx31_ccm_get_mcu_main_clk(IMXCCMState *dev) | 
|  | { | 
|  | uint32_t freq; | 
|  | IMX31CCMState *s = IMX31_CCM(dev); | 
|  |  | 
|  | if ((s->reg[IMX31_CCM_CCMR_REG] & CCMR_MDS) || | 
|  | !(s->reg[IMX31_CCM_CCMR_REG] & CCMR_MPE)) { | 
|  | freq = imx31_ccm_get_pll_ref_clk(dev); | 
|  | } else { | 
|  | freq = imx31_ccm_get_mpll_clk(dev); | 
|  | } | 
|  |  | 
|  | DPRINTF("freq = %u\n", freq); | 
|  |  | 
|  | return freq; | 
|  | } | 
|  |  | 
|  | static uint32_t imx31_ccm_get_hclk_clk(IMXCCMState *dev) | 
|  | { | 
|  | uint32_t freq; | 
|  | IMX31CCMState *s = IMX31_CCM(dev); | 
|  |  | 
|  | freq = imx31_ccm_get_mcu_main_clk(dev) | 
|  | / (1 + EXTRACT(s->reg[IMX31_CCM_PDR0_REG], MAX)); | 
|  |  | 
|  | DPRINTF("freq = %u\n", freq); | 
|  |  | 
|  | return freq; | 
|  | } | 
|  |  | 
|  | static uint32_t imx31_ccm_get_ipg_clk(IMXCCMState *dev) | 
|  | { | 
|  | uint32_t freq; | 
|  | IMX31CCMState *s = IMX31_CCM(dev); | 
|  |  | 
|  | freq = imx31_ccm_get_hclk_clk(dev) | 
|  | / (1 + EXTRACT(s->reg[IMX31_CCM_PDR0_REG], IPG)); | 
|  |  | 
|  | DPRINTF("freq = %u\n", freq); | 
|  |  | 
|  | return freq; | 
|  | } | 
|  |  | 
|  | static uint32_t imx31_ccm_get_clock_frequency(IMXCCMState *dev, IMXClk clock) | 
|  | { | 
|  | uint32_t freq = 0; | 
|  |  | 
|  | switch (clock) { | 
|  | case CLK_NONE: | 
|  | break; | 
|  | case CLK_IPG: | 
|  | case CLK_IPG_HIGH: | 
|  | freq = imx31_ccm_get_ipg_clk(dev); | 
|  | break; | 
|  | case CLK_32k: | 
|  | freq = CKIL_FREQ; | 
|  | break; | 
|  | default: | 
|  | qemu_log_mask(LOG_GUEST_ERROR, "[%s]%s: unsupported clock %d\n", | 
|  | TYPE_IMX31_CCM, __func__, clock); | 
|  | break; | 
|  | } | 
|  |  | 
|  | DPRINTF("Clock = %d) = %u\n", clock, freq); | 
|  |  | 
|  | return freq; | 
|  | } | 
|  |  | 
|  | static void imx31_ccm_reset(DeviceState *dev) | 
|  | { | 
|  | IMX31CCMState *s = IMX31_CCM(dev); | 
|  |  | 
|  | DPRINTF("()\n"); | 
|  |  | 
|  | memset(s->reg, 0, sizeof(uint32_t) * IMX31_CCM_MAX_REG); | 
|  |  | 
|  | s->reg[IMX31_CCM_CCMR_REG]   = 0x074b0b7d; | 
|  | s->reg[IMX31_CCM_PDR0_REG]   = 0xff870b48; | 
|  | s->reg[IMX31_CCM_PDR1_REG]   = 0x49fcfe7f; | 
|  | s->reg[IMX31_CCM_RCSR_REG]   = 0x007f0000; | 
|  | s->reg[IMX31_CCM_MPCTL_REG]  = 0x04001800; | 
|  | s->reg[IMX31_CCM_UPCTL_REG]  = 0x04051c03; | 
|  | s->reg[IMX31_CCM_SPCTL_REG]  = 0x04043001; | 
|  | s->reg[IMX31_CCM_COSR_REG]   = 0x00000280; | 
|  | s->reg[IMX31_CCM_CGR0_REG]   = 0xffffffff; | 
|  | s->reg[IMX31_CCM_CGR1_REG]   = 0xffffffff; | 
|  | s->reg[IMX31_CCM_CGR2_REG]   = 0xffffffff; | 
|  | s->reg[IMX31_CCM_WIMR_REG]   = 0xffffffff; | 
|  | s->reg[IMX31_CCM_LTR1_REG]   = 0x00004040; | 
|  | s->reg[IMX31_CCM_PMCR0_REG]  = 0x80209828; | 
|  | s->reg[IMX31_CCM_PMCR1_REG]  = 0x00aa0000; | 
|  | s->reg[IMX31_CCM_PDR2_REG]   = 0x00000285; | 
|  | } | 
|  |  | 
|  | static uint64_t imx31_ccm_read(void *opaque, hwaddr offset, unsigned size) | 
|  | { | 
|  | uint32_t value = 0; | 
|  | IMX31CCMState *s = (IMX31CCMState *)opaque; | 
|  |  | 
|  | if ((offset >> 2) < IMX31_CCM_MAX_REG) { | 
|  | value = s->reg[offset >> 2]; | 
|  | } else { | 
|  | qemu_log_mask(LOG_GUEST_ERROR, "[%s]%s: Bad register at offset 0x%" | 
|  | HWADDR_PRIx "\n", TYPE_IMX31_CCM, __func__, offset); | 
|  | } | 
|  |  | 
|  | DPRINTF("reg[%s] => 0x%" PRIx32 "\n", imx31_ccm_reg_name(offset >> 2), | 
|  | value); | 
|  |  | 
|  | return (uint64_t)value; | 
|  | } | 
|  |  | 
|  | static void imx31_ccm_write(void *opaque, hwaddr offset, uint64_t value, | 
|  | unsigned size) | 
|  | { | 
|  | IMX31CCMState *s = (IMX31CCMState *)opaque; | 
|  |  | 
|  | DPRINTF("reg[%s] <= 0x%" PRIx32 "\n", imx31_ccm_reg_name(offset >> 2), | 
|  | (uint32_t)value); | 
|  |  | 
|  | switch (offset >> 2) { | 
|  | case IMX31_CCM_CCMR_REG: | 
|  | s->reg[IMX31_CCM_CCMR_REG] = CCMR_FPMF | (value & 0x3b6fdfff); | 
|  | break; | 
|  | case IMX31_CCM_PDR0_REG: | 
|  | s->reg[IMX31_CCM_PDR0_REG] = value & 0xff9f3fff; | 
|  | break; | 
|  | case IMX31_CCM_PDR1_REG: | 
|  | s->reg[IMX31_CCM_PDR1_REG] = value; | 
|  | break; | 
|  | case IMX31_CCM_MPCTL_REG: | 
|  | s->reg[IMX31_CCM_MPCTL_REG] = value & 0xbfff3fff; | 
|  | break; | 
|  | case IMX31_CCM_SPCTL_REG: | 
|  | s->reg[IMX31_CCM_SPCTL_REG] = value & 0xbfff3fff; | 
|  | break; | 
|  | case IMX31_CCM_CGR0_REG: | 
|  | s->reg[IMX31_CCM_CGR0_REG] = value; | 
|  | break; | 
|  | case IMX31_CCM_CGR1_REG: | 
|  | s->reg[IMX31_CCM_CGR1_REG] = value; | 
|  | break; | 
|  | case IMX31_CCM_CGR2_REG: | 
|  | s->reg[IMX31_CCM_CGR2_REG] = value; | 
|  | break; | 
|  | default: | 
|  | qemu_log_mask(LOG_GUEST_ERROR, "[%s]%s: Bad register at offset 0x%" | 
|  | HWADDR_PRIx "\n", TYPE_IMX31_CCM, __func__, offset); | 
|  | break; | 
|  | } | 
|  | } | 
|  |  | 
|  | static const struct MemoryRegionOps imx31_ccm_ops = { | 
|  | .read = imx31_ccm_read, | 
|  | .write = imx31_ccm_write, | 
|  | .endianness = DEVICE_NATIVE_ENDIAN, | 
|  | .valid = { | 
|  | /* | 
|  | * Our device would not work correctly if the guest was doing | 
|  | * unaligned access. This might not be a limitation on the real | 
|  | * device but in practice there is no reason for a guest to access | 
|  | * this device unaligned. | 
|  | */ | 
|  | .min_access_size = 4, | 
|  | .max_access_size = 4, | 
|  | .unaligned = false, | 
|  | }, | 
|  |  | 
|  | }; | 
|  |  | 
|  | static void imx31_ccm_init(Object *obj) | 
|  | { | 
|  | DeviceState *dev = DEVICE(obj); | 
|  | SysBusDevice *sd = SYS_BUS_DEVICE(obj); | 
|  | IMX31CCMState *s = IMX31_CCM(obj); | 
|  |  | 
|  | memory_region_init_io(&s->iomem, OBJECT(dev), &imx31_ccm_ops, s, | 
|  | TYPE_IMX31_CCM, 0x1000); | 
|  | sysbus_init_mmio(sd, &s->iomem); | 
|  | } | 
|  |  | 
|  | static void imx31_ccm_class_init(ObjectClass *klass, void *data) | 
|  | { | 
|  | DeviceClass *dc  = DEVICE_CLASS(klass); | 
|  | IMXCCMClass *ccm = IMX_CCM_CLASS(klass); | 
|  |  | 
|  | device_class_set_legacy_reset(dc, imx31_ccm_reset); | 
|  | dc->vmsd  = &vmstate_imx31_ccm; | 
|  | dc->desc  = "i.MX31 Clock Control Module"; | 
|  |  | 
|  | ccm->get_clock_frequency = imx31_ccm_get_clock_frequency; | 
|  | } | 
|  |  | 
|  | static const TypeInfo imx31_ccm_info = { | 
|  | .name          = TYPE_IMX31_CCM, | 
|  | .parent        = TYPE_IMX_CCM, | 
|  | .instance_size = sizeof(IMX31CCMState), | 
|  | .instance_init = imx31_ccm_init, | 
|  | .class_init    = imx31_ccm_class_init, | 
|  | }; | 
|  |  | 
|  | static void imx31_ccm_register_types(void) | 
|  | { | 
|  | type_register_static(&imx31_ccm_info); | 
|  | } | 
|  |  | 
|  | type_init(imx31_ccm_register_types) |