|
@@ -0,0 +1,277 @@
|
|
|
|
+/*
|
|
|
|
+ * Copyright (c) 2018, Impinj, Inc.
|
|
|
|
+ *
|
|
|
|
+ * i.MX7 CCM, PMU and ANALOG IP blocks emulation code
|
|
|
|
+ *
|
|
|
|
+ * Author: Andrey Smirnov <andrew.smirnov@gmail.com>
|
|
|
|
+ *
|
|
|
|
+ * This work is licensed under the terms of the GNU GPL, version 2 or later.
|
|
|
|
+ * See the COPYING file in the top-level directory.
|
|
|
|
+ */
|
|
|
|
+
|
|
|
|
+#include "qemu/osdep.h"
|
|
|
|
+#include "qemu/log.h"
|
|
|
|
+
|
|
|
|
+#include "hw/misc/imx7_ccm.h"
|
|
|
|
+
|
|
|
|
+static void imx7_analog_reset(DeviceState *dev)
|
|
|
|
+{
|
|
|
|
+ IMX7AnalogState *s = IMX7_ANALOG(dev);
|
|
|
|
+
|
|
|
|
+ memset(s->pmu, 0, sizeof(s->pmu));
|
|
|
|
+ memset(s->analog, 0, sizeof(s->analog));
|
|
|
|
+
|
|
|
|
+ s->analog[ANALOG_PLL_ARM] = 0x00002042;
|
|
|
|
+ s->analog[ANALOG_PLL_DDR] = 0x0060302c;
|
|
|
|
+ s->analog[ANALOG_PLL_DDR_SS] = 0x00000000;
|
|
|
|
+ s->analog[ANALOG_PLL_DDR_NUM] = 0x06aaac4d;
|
|
|
|
+ s->analog[ANALOG_PLL_DDR_DENOM] = 0x100003ec;
|
|
|
|
+ s->analog[ANALOG_PLL_480] = 0x00002000;
|
|
|
|
+ s->analog[ANALOG_PLL_480A] = 0x52605a56;
|
|
|
|
+ s->analog[ANALOG_PLL_480B] = 0x52525216;
|
|
|
|
+ s->analog[ANALOG_PLL_ENET] = 0x00001fc0;
|
|
|
|
+ s->analog[ANALOG_PLL_AUDIO] = 0x0001301b;
|
|
|
|
+ s->analog[ANALOG_PLL_AUDIO_SS] = 0x00000000;
|
|
|
|
+ s->analog[ANALOG_PLL_AUDIO_NUM] = 0x05f5e100;
|
|
|
|
+ s->analog[ANALOG_PLL_AUDIO_DENOM] = 0x2964619c;
|
|
|
|
+ s->analog[ANALOG_PLL_VIDEO] = 0x0008201b;
|
|
|
|
+ s->analog[ANALOG_PLL_VIDEO_SS] = 0x00000000;
|
|
|
|
+ s->analog[ANALOG_PLL_VIDEO_NUM] = 0x0000f699;
|
|
|
|
+ s->analog[ANALOG_PLL_VIDEO_DENOM] = 0x000f4240;
|
|
|
|
+ s->analog[ANALOG_PLL_MISC0] = 0x00000000;
|
|
|
|
+
|
|
|
|
+ /* all PLLs need to be locked */
|
|
|
|
+ s->analog[ANALOG_PLL_ARM] |= ANALOG_PLL_LOCK;
|
|
|
|
+ s->analog[ANALOG_PLL_DDR] |= ANALOG_PLL_LOCK;
|
|
|
|
+ s->analog[ANALOG_PLL_480] |= ANALOG_PLL_LOCK;
|
|
|
|
+ s->analog[ANALOG_PLL_480A] |= ANALOG_PLL_LOCK;
|
|
|
|
+ s->analog[ANALOG_PLL_480B] |= ANALOG_PLL_LOCK;
|
|
|
|
+ s->analog[ANALOG_PLL_ENET] |= ANALOG_PLL_LOCK;
|
|
|
|
+ s->analog[ANALOG_PLL_AUDIO] |= ANALOG_PLL_LOCK;
|
|
|
|
+ s->analog[ANALOG_PLL_VIDEO] |= ANALOG_PLL_LOCK;
|
|
|
|
+ s->analog[ANALOG_PLL_MISC0] |= ANALOG_PLL_LOCK;
|
|
|
|
+
|
|
|
|
+ /*
|
|
|
|
+ * Since I couldn't find any info about this in the reference
|
|
|
|
+ * manual the value of this register is based strictly on matching
|
|
|
|
+ * what Linux kernel expects it to be.
|
|
|
|
+ */
|
|
|
|
+ s->analog[ANALOG_DIGPROG] = 0x720000;
|
|
|
|
+ /*
|
|
|
|
+ * Set revision to be 1.0 (Arbitrary choice, no particular
|
|
|
|
+ * reason).
|
|
|
|
+ */
|
|
|
|
+ s->analog[ANALOG_DIGPROG] |= 0x000010;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void imx7_ccm_reset(DeviceState *dev)
|
|
|
|
+{
|
|
|
|
+ IMX7CCMState *s = IMX7_CCM(dev);
|
|
|
|
+
|
|
|
|
+ memset(s->ccm, 0, sizeof(s->ccm));
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+#define CCM_INDEX(offset) (((offset) & ~(hwaddr)0xF) / sizeof(uint32_t))
|
|
|
|
+#define CCM_BITOP(offset) ((offset) & (hwaddr)0xF)
|
|
|
|
+
|
|
|
|
+enum {
|
|
|
|
+ CCM_BITOP_NONE = 0x00,
|
|
|
|
+ CCM_BITOP_SET = 0x04,
|
|
|
|
+ CCM_BITOP_CLR = 0x08,
|
|
|
|
+ CCM_BITOP_TOG = 0x0C,
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static uint64_t imx7_set_clr_tog_read(void *opaque, hwaddr offset,
|
|
|
|
+ unsigned size)
|
|
|
|
+{
|
|
|
|
+ const uint32_t *mmio = opaque;
|
|
|
|
+
|
|
|
|
+ return mmio[CCM_INDEX(offset)];
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void imx7_set_clr_tog_write(void *opaque, hwaddr offset,
|
|
|
|
+ uint64_t value, unsigned size)
|
|
|
|
+{
|
|
|
|
+ const uint8_t bitop = CCM_BITOP(offset);
|
|
|
|
+ const uint32_t index = CCM_INDEX(offset);
|
|
|
|
+ uint32_t *mmio = opaque;
|
|
|
|
+
|
|
|
|
+ switch (bitop) {
|
|
|
|
+ case CCM_BITOP_NONE:
|
|
|
|
+ mmio[index] = value;
|
|
|
|
+ break;
|
|
|
|
+ case CCM_BITOP_SET:
|
|
|
|
+ mmio[index] |= value;
|
|
|
|
+ break;
|
|
|
|
+ case CCM_BITOP_CLR:
|
|
|
|
+ mmio[index] &= ~value;
|
|
|
|
+ break;
|
|
|
|
+ case CCM_BITOP_TOG:
|
|
|
|
+ mmio[index] ^= value;
|
|
|
|
+ break;
|
|
|
|
+ };
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static const struct MemoryRegionOps imx7_set_clr_tog_ops = {
|
|
|
|
+ .read = imx7_set_clr_tog_read,
|
|
|
|
+ .write = imx7_set_clr_tog_write,
|
|
|
|
+ .endianness = DEVICE_NATIVE_ENDIAN,
|
|
|
|
+ .impl = {
|
|
|
|
+ /*
|
|
|
|
+ * 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 const struct MemoryRegionOps imx7_digprog_ops = {
|
|
|
|
+ .read = imx7_set_clr_tog_read,
|
|
|
|
+ .endianness = DEVICE_NATIVE_ENDIAN,
|
|
|
|
+ .impl = {
|
|
|
|
+ .min_access_size = 4,
|
|
|
|
+ .max_access_size = 4,
|
|
|
|
+ .unaligned = false,
|
|
|
|
+ },
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static void imx7_ccm_init(Object *obj)
|
|
|
|
+{
|
|
|
|
+ SysBusDevice *sd = SYS_BUS_DEVICE(obj);
|
|
|
|
+ IMX7CCMState *s = IMX7_CCM(obj);
|
|
|
|
+
|
|
|
|
+ memory_region_init_io(&s->iomem,
|
|
|
|
+ obj,
|
|
|
|
+ &imx7_set_clr_tog_ops,
|
|
|
|
+ s->ccm,
|
|
|
|
+ TYPE_IMX7_CCM ".ccm",
|
|
|
|
+ sizeof(s->ccm));
|
|
|
|
+
|
|
|
|
+ sysbus_init_mmio(sd, &s->iomem);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void imx7_analog_init(Object *obj)
|
|
|
|
+{
|
|
|
|
+ SysBusDevice *sd = SYS_BUS_DEVICE(obj);
|
|
|
|
+ IMX7AnalogState *s = IMX7_ANALOG(obj);
|
|
|
|
+
|
|
|
|
+ memory_region_init(&s->mmio.container, obj, TYPE_IMX7_ANALOG,
|
|
|
|
+ 0x10000);
|
|
|
|
+
|
|
|
|
+ memory_region_init_io(&s->mmio.analog,
|
|
|
|
+ obj,
|
|
|
|
+ &imx7_set_clr_tog_ops,
|
|
|
|
+ s->analog,
|
|
|
|
+ TYPE_IMX7_ANALOG,
|
|
|
|
+ sizeof(s->analog));
|
|
|
|
+
|
|
|
|
+ memory_region_add_subregion(&s->mmio.container,
|
|
|
|
+ 0x60, &s->mmio.analog);
|
|
|
|
+
|
|
|
|
+ memory_region_init_io(&s->mmio.pmu,
|
|
|
|
+ obj,
|
|
|
|
+ &imx7_set_clr_tog_ops,
|
|
|
|
+ s->pmu,
|
|
|
|
+ TYPE_IMX7_ANALOG ".pmu",
|
|
|
|
+ sizeof(s->pmu));
|
|
|
|
+
|
|
|
|
+ memory_region_add_subregion(&s->mmio.container,
|
|
|
|
+ 0x200, &s->mmio.pmu);
|
|
|
|
+
|
|
|
|
+ memory_region_init_io(&s->mmio.digprog,
|
|
|
|
+ obj,
|
|
|
|
+ &imx7_digprog_ops,
|
|
|
|
+ &s->analog[ANALOG_DIGPROG],
|
|
|
|
+ TYPE_IMX7_ANALOG ".digprog",
|
|
|
|
+ sizeof(uint32_t));
|
|
|
|
+
|
|
|
|
+ memory_region_add_subregion_overlap(&s->mmio.container,
|
|
|
|
+ 0x800, &s->mmio.digprog, 10);
|
|
|
|
+
|
|
|
|
+
|
|
|
|
+ sysbus_init_mmio(sd, &s->mmio.container);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static const VMStateDescription vmstate_imx7_ccm = {
|
|
|
|
+ .name = TYPE_IMX7_CCM,
|
|
|
|
+ .version_id = 1,
|
|
|
|
+ .minimum_version_id = 1,
|
|
|
|
+ .fields = (VMStateField[]) {
|
|
|
|
+ VMSTATE_UINT32_ARRAY(ccm, IMX7CCMState, CCM_MAX),
|
|
|
|
+ VMSTATE_END_OF_LIST()
|
|
|
|
+ },
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static uint32_t imx7_ccm_get_clock_frequency(IMXCCMState *dev, IMXClk clock)
|
|
|
|
+{
|
|
|
|
+ /*
|
|
|
|
+ * This function is "consumed" by GPT emulation code, however on
|
|
|
|
+ * i.MX7 each GPT block can have their own clock root. This means
|
|
|
|
+ * that this functions needs somehow to know requester's identity
|
|
|
|
+ * and the way to pass it: be it via additional IMXClk constants
|
|
|
|
+ * or by adding another argument to this method needs to be
|
|
|
|
+ * figured out
|
|
|
|
+ */
|
|
|
|
+ qemu_log_mask(LOG_GUEST_ERROR, "[%s]%s: Not implemented\n",
|
|
|
|
+ TYPE_IMX7_CCM, __func__);
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void imx7_ccm_class_init(ObjectClass *klass, void *data)
|
|
|
|
+{
|
|
|
|
+ DeviceClass *dc = DEVICE_CLASS(klass);
|
|
|
|
+ IMXCCMClass *ccm = IMX_CCM_CLASS(klass);
|
|
|
|
+
|
|
|
|
+ dc->reset = imx7_ccm_reset;
|
|
|
|
+ dc->vmsd = &vmstate_imx7_ccm;
|
|
|
|
+ dc->desc = "i.MX7 Clock Control Module";
|
|
|
|
+
|
|
|
|
+ ccm->get_clock_frequency = imx7_ccm_get_clock_frequency;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static const TypeInfo imx7_ccm_info = {
|
|
|
|
+ .name = TYPE_IMX7_CCM,
|
|
|
|
+ .parent = TYPE_IMX_CCM,
|
|
|
|
+ .instance_size = sizeof(IMX7CCMState),
|
|
|
|
+ .instance_init = imx7_ccm_init,
|
|
|
|
+ .class_init = imx7_ccm_class_init,
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static const VMStateDescription vmstate_imx7_analog = {
|
|
|
|
+ .name = TYPE_IMX7_ANALOG,
|
|
|
|
+ .version_id = 1,
|
|
|
|
+ .minimum_version_id = 1,
|
|
|
|
+ .fields = (VMStateField[]) {
|
|
|
|
+ VMSTATE_UINT32_ARRAY(analog, IMX7AnalogState, ANALOG_MAX),
|
|
|
|
+ VMSTATE_UINT32_ARRAY(pmu, IMX7AnalogState, PMU_MAX),
|
|
|
|
+ VMSTATE_END_OF_LIST()
|
|
|
|
+ },
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static void imx7_analog_class_init(ObjectClass *klass, void *data)
|
|
|
|
+{
|
|
|
|
+ DeviceClass *dc = DEVICE_CLASS(klass);
|
|
|
|
+
|
|
|
|
+ dc->reset = imx7_analog_reset;
|
|
|
|
+ dc->vmsd = &vmstate_imx7_analog;
|
|
|
|
+ dc->desc = "i.MX7 Analog Module";
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static const TypeInfo imx7_analog_info = {
|
|
|
|
+ .name = TYPE_IMX7_ANALOG,
|
|
|
|
+ .parent = TYPE_SYS_BUS_DEVICE,
|
|
|
|
+ .instance_size = sizeof(IMX7AnalogState),
|
|
|
|
+ .instance_init = imx7_analog_init,
|
|
|
|
+ .class_init = imx7_analog_class_init,
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static void imx7_ccm_register_type(void)
|
|
|
|
+{
|
|
|
|
+ type_register_static(&imx7_ccm_info);
|
|
|
|
+ type_register_static(&imx7_analog_info);
|
|
|
|
+}
|
|
|
|
+type_init(imx7_ccm_register_type)
|