hw/misc/imx31_ccm.c - qemu - Git at Google

 /*
  * 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 "hw/misc/imx31_ccm.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 char const *imx31_ccm_reg_name(uint32_t reg)
 {
     switch (reg) {
     case 0:
         return "CCMR";
     case 1:
         return "PDR0";
     case 2:
         return "PDR1";
     case 3:
         return "RCSR";
     case 4:
         return "MPCTL";
     case 5:
         return "UPCTL";
     case 6:
         return "SPCTL";
     case 7:
         return "COSR";
     case 8:
         return "CGR0";
     case 9:
         return "CGR1";
     case 10:
         return "CGR2";
     case 11:
         return "WIMR";
     case 12:
         return "LDC";
     case 13:
         return "DCVR0";
     case 14:
         return "DCVR1";
     case 15:
         return "DCVR2";
     case 16:
         return "DCVR3";
     case 17:
         return "LTR0";
     case 18:
         return "LTR1";
     case 19:
         return "LTR2";
     case 20:
         return "LTR3";
     case 21:
         return "LTBR0";
     case 22:
         return "LTBR1";
     case 23:
         return "PMCR0";
     case 24:
         return "PMCR1";
     case 25:
         return "PDR2";
     default:
         return "???";
     }
 }

 static const VMStateDescription vmstate_imx31_ccm = {
     .name = TYPE_IMX31_CCM,
     .version_id = 1,
     .minimum_version_id = 1,
     .fields = (VMStateField[]) {
         VMSTATE_UINT32(ccmr, IMX31CCMState),
         VMSTATE_UINT32(pdr0, IMX31CCMState),
         VMSTATE_UINT32(pdr1, IMX31CCMState),
         VMSTATE_UINT32(mpctl, IMX31CCMState),
         VMSTATE_UINT32(spctl, IMX31CCMState),
         VMSTATE_UINT32_ARRAY(cgr, IMX31CCMState, 3),
         VMSTATE_UINT32(pmcr0, IMX31CCMState),
         VMSTATE_UINT32(pmcr1, IMX31CCMState),
         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->ccmr & CCMR_PRCS) == 2) {
         if (s->ccmr & CCMR_FPME) {
             freq = CKIL_FREQ;
             if (s->ccmr & CCMR_FPMF) {
                 freq *= 1024;
             }
         }
     } else {
         freq = CKIH_FREQ;
     }

     DPRINTF("freq = %d\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->mpctl, imx31_ccm_get_pll_ref_clk(dev));

     DPRINTF("freq = %d\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->ccmr & CCMR_MDS) || !(s->ccmr & CCMR_MPE)) {
         freq = imx31_ccm_get_pll_ref_clk(dev);
     } else {
         freq = imx31_ccm_get_mpll_clk(dev);
     }

     DPRINTF("freq = %d\n", freq);

     return freq;
 }

 static uint32_t imx31_ccm_get_mcu_clk(IMXCCMState *dev)
 {
     uint32_t freq;
     IMX31CCMState *s = IMX31_CCM(dev);

     freq = imx31_ccm_get_mcu_main_clk(dev) / (1 + EXTRACT(s->pdr0, MCU));

     DPRINTF("freq = %d\n", freq);

     return freq;
 }

 static uint32_t imx31_ccm_get_hsp_clk(IMXCCMState *dev)
 {
     uint32_t freq;
     IMX31CCMState *s = IMX31_CCM(dev);

     freq = imx31_ccm_get_mcu_main_clk(dev) / (1 + EXTRACT(s->pdr0, HSP));

     DPRINTF("freq = %d\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->pdr0, MAX));

     DPRINTF("freq = %d\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->pdr0, IPG));

     DPRINTF("freq = %d\n", freq);

     return freq;
 }

 static uint32_t imx31_ccm_get_clock_frequency(IMXCCMState *dev, IMXClk clock)
 {
     uint32_t freq = 0;

     switch (clock) {
     case NOCLK:
         break;
     case CLK_MCU:
         freq = imx31_ccm_get_mcu_clk(dev);
         break;
     case CLK_HSP:
         freq = imx31_ccm_get_hsp_clk(dev);
         break;
     case CLK_IPG:
         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) = %d\n", clock, freq);

     return freq;
 }

 static void imx31_ccm_reset(DeviceState *dev)
 {
     IMX31CCMState *s = IMX31_CCM(dev);

     DPRINTF("()\n");

     s->ccmr   = 0x074b0b7d;
     s->pdr0   = 0xff870b48;
     s->pdr1   = 0x49fcfe7f;
     s->mpctl  = 0x04001800;
     s->cgr[0] = s->cgr[1] = s->cgr[2] = 0xffffffff;
     s->spctl  = 0x04043001;
     s->pmcr0  = 0x80209828;
     s->pmcr1  = 0x00aa0000;
 }

 static uint64_t imx31_ccm_read(void *opaque, hwaddr offset, unsigned size)
 {
     uint32 value = 0;
     IMX31CCMState *s = (IMX31CCMState *)opaque;

     switch (offset >> 2) {
     case 0: /* CCMR */
         value = s->ccmr;
         break;
     case 1:
         value = s->pdr0;
         break;
     case 2:
         value = s->pdr1;
         break;
     case 4:
         value = s->mpctl;
         break;
     case 6:
         value = s->spctl;
         break;
     case 8:
         value = s->cgr[0];
         break;
     case 9:
         value = s->cgr[1];
         break;
     case 10:
         value = s->cgr[2];
         break;
     case 18: /* LTR1 */
         value = 0x00004040;
         break;
     case 23:
         value = s->pmcr0;
         break;
     default:
         qemu_log_mask(LOG_GUEST_ERROR, "[%s]%s: Bad register at offset 0x%"
                       HWADDR_PRIx "\n", TYPE_IMX31_CCM, __func__, offset);
         break;
     }

     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 0:
         s->ccmr = CCMR_FPMF | (value & 0x3b6fdfff);
         break;
     case 1:
         s->pdr0 = value & 0xff9f3fff;
         break;
     case 2:
         s->pdr1 = value;
         break;
     case 4:
         s->mpctl = value & 0xbfff3fff;
         break;
     case 6:
         s->spctl = value & 0xbfff3fff;
         break;
     case 8:
         s->cgr[0] = value;
         break;
     case 9:
         s->cgr[1] = value;
         break;
     case 10:
         s->cgr[2] = 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);

     dc->reset = 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)
	/*
	* 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 "hw/misc/imx31_ccm.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 char const *imx31_ccm_reg_name(uint32_t reg)
	{
	switch (reg) {
	case 0:
	return "CCMR";
	case 1:
	return "PDR0";
	case 2:
	return "PDR1";
	case 3:
	return "RCSR";
	case 4:
	return "MPCTL";
	case 5:
	return "UPCTL";
	case 6:
	return "SPCTL";
	case 7:
	return "COSR";
	case 8:
	return "CGR0";
	case 9:
	return "CGR1";
	case 10:
	return "CGR2";
	case 11:
	return "WIMR";
	case 12:
	return "LDC";
	case 13:
	return "DCVR0";
	case 14:
	return "DCVR1";
	case 15:
	return "DCVR2";
	case 16:
	return "DCVR3";
	case 17:
	return "LTR0";
	case 18:
	return "LTR1";
	case 19:
	return "LTR2";
	case 20:
	return "LTR3";
	case 21:
	return "LTBR0";
	case 22:
	return "LTBR1";
	case 23:
	return "PMCR0";
	case 24:
	return "PMCR1";
	case 25:
	return "PDR2";
	default:
	return "???";
	}
	}

	static const VMStateDescription vmstate_imx31_ccm = {
	.name = TYPE_IMX31_CCM,
	.version_id = 1,
	.minimum_version_id = 1,
	.fields = (VMStateField[]) {
	VMSTATE_UINT32(ccmr, IMX31CCMState),
	VMSTATE_UINT32(pdr0, IMX31CCMState),
	VMSTATE_UINT32(pdr1, IMX31CCMState),
	VMSTATE_UINT32(mpctl, IMX31CCMState),
	VMSTATE_UINT32(spctl, IMX31CCMState),
	VMSTATE_UINT32_ARRAY(cgr, IMX31CCMState, 3),
	VMSTATE_UINT32(pmcr0, IMX31CCMState),
	VMSTATE_UINT32(pmcr1, IMX31CCMState),
	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->ccmr & CCMR_PRCS) == 2) {
	if (s->ccmr & CCMR_FPME) {
	freq = CKIL_FREQ;
	if (s->ccmr & CCMR_FPMF) {
	freq *= 1024;
	}
	}
	} else {
	freq = CKIH_FREQ;
	}

	DPRINTF("freq = %d\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->mpctl, imx31_ccm_get_pll_ref_clk(dev));

	DPRINTF("freq = %d\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->ccmr & CCMR_MDS) \|\| !(s->ccmr & CCMR_MPE)) {
	freq = imx31_ccm_get_pll_ref_clk(dev);
	} else {
	freq = imx31_ccm_get_mpll_clk(dev);
	}

	DPRINTF("freq = %d\n", freq);

	return freq;
	}

	static uint32_t imx31_ccm_get_mcu_clk(IMXCCMState *dev)
	{
	uint32_t freq;
	IMX31CCMState *s = IMX31_CCM(dev);

	freq = imx31_ccm_get_mcu_main_clk(dev) / (1 + EXTRACT(s->pdr0, MCU));

	DPRINTF("freq = %d\n", freq);

	return freq;
	}

	static uint32_t imx31_ccm_get_hsp_clk(IMXCCMState *dev)
	{
	uint32_t freq;
	IMX31CCMState *s = IMX31_CCM(dev);

	freq = imx31_ccm_get_mcu_main_clk(dev) / (1 + EXTRACT(s->pdr0, HSP));

	DPRINTF("freq = %d\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->pdr0, MAX));

	DPRINTF("freq = %d\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->pdr0, IPG));

	DPRINTF("freq = %d\n", freq);

	return freq;
	}

	static uint32_t imx31_ccm_get_clock_frequency(IMXCCMState *dev, IMXClk clock)
	{
	uint32_t freq = 0;

	switch (clock) {
	case NOCLK:
	break;
	case CLK_MCU:
	freq = imx31_ccm_get_mcu_clk(dev);
	break;
	case CLK_HSP:
	freq = imx31_ccm_get_hsp_clk(dev);
	break;
	case CLK_IPG:
	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) = %d\n", clock, freq);

	return freq;
	}

	static void imx31_ccm_reset(DeviceState *dev)
	{
	IMX31CCMState *s = IMX31_CCM(dev);

	DPRINTF("()\n");

	s->ccmr = 0x074b0b7d;
	s->pdr0 = 0xff870b48;
	s->pdr1 = 0x49fcfe7f;
	s->mpctl = 0x04001800;
	s->cgr[0] = s->cgr[1] = s->cgr[2] = 0xffffffff;
	s->spctl = 0x04043001;
	s->pmcr0 = 0x80209828;
	s->pmcr1 = 0x00aa0000;
	}

	static uint64_t imx31_ccm_read(void *opaque, hwaddr offset, unsigned size)
	{
	uint32 value = 0;
	IMX31CCMState s = (IMX31CCMState )opaque;

	switch (offset >> 2) {
	case 0: /* CCMR */
	value = s->ccmr;
	break;
	case 1:
	value = s->pdr0;
	break;
	case 2:
	value = s->pdr1;
	break;
	case 4:
	value = s->mpctl;
	break;
	case 6:
	value = s->spctl;
	break;
	case 8:
	value = s->cgr[0];
	break;
	case 9:
	value = s->cgr[1];
	break;
	case 10:
	value = s->cgr[2];
	break;
	case 18: /* LTR1 */
	value = 0x00004040;
	break;
	case 23:
	value = s->pmcr0;
	break;
	default:
	qemu_log_mask(LOG_GUEST_ERROR, "[%s]%s: Bad register at offset 0x%"
	HWADDR_PRIx "\n", TYPE_IMX31_CCM, __func__, offset);
	break;
	}

	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 0:
	s->ccmr = CCMR_FPMF \| (value & 0x3b6fdfff);
	break;
	case 1:
	s->pdr0 = value & 0xff9f3fff;
	break;
	case 2:
	s->pdr1 = value;
	break;
	case 4:
	s->mpctl = value & 0xbfff3fff;
	break;
	case 6:
	s->spctl = value & 0xbfff3fff;
	break;
	case 8:
	s->cgr[0] = value;
	break;
	case 9:
	s->cgr[1] = value;
	break;
	case 10:
	s->cgr[2] = 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);

	dc->reset = 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)