280 lines
8.4 KiB
C
280 lines
8.4 KiB
C
|
/*
|
||
|
* 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 "qemu/module.h"
|
||
|
|
||
|
#include "hw/misc/imx7_ccm.h"
|
||
|
#include "migration/vmstate.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)
|