1e28bee8eSPaolo Bonzini /*
2e28bee8eSPaolo Bonzini * IMX31 Clock Control Module
3e28bee8eSPaolo Bonzini *
4e28bee8eSPaolo Bonzini * Copyright (C) 2012 NICTA
5282e74c8SJean-Christophe Dubois * Updated by Jean-Christophe Dubois <jcd@tribudubois.net>
6e28bee8eSPaolo Bonzini *
7e28bee8eSPaolo Bonzini * This work is licensed under the terms of the GNU GPL, version 2 or later.
8e28bee8eSPaolo Bonzini * See the COPYING file in the top-level directory.
9e28bee8eSPaolo Bonzini *
10cb54d868SJean-Christophe Dubois * This is an abstract base class used to get a common interface to
11cb54d868SJean-Christophe Dubois * retrieve the CCM frequencies from the various i.MX SOC.
12e28bee8eSPaolo Bonzini */
13e28bee8eSPaolo Bonzini
148ef94f0bSPeter Maydell #include "qemu/osdep.h"
15282e74c8SJean-Christophe Dubois #include "hw/misc/imx_ccm.h"
160b8fa32fSMarkus Armbruster #include "qemu/module.h"
17e28bee8eSPaolo Bonzini
184a6aa0afSJean-Christophe Dubois #ifndef DEBUG_IMX_CCM
194a6aa0afSJean-Christophe Dubois #define DEBUG_IMX_CCM 0
20e28bee8eSPaolo Bonzini #endif
21e28bee8eSPaolo Bonzini
224a6aa0afSJean-Christophe Dubois #define DPRINTF(fmt, args...) \
234a6aa0afSJean-Christophe Dubois do { \
244a6aa0afSJean-Christophe Dubois if (DEBUG_IMX_CCM) { \
254a6aa0afSJean-Christophe Dubois fprintf(stderr, "[%s]%s: " fmt , TYPE_IMX_CCM, \
264a6aa0afSJean-Christophe Dubois __func__, ##args); \
274a6aa0afSJean-Christophe Dubois } \
284a6aa0afSJean-Christophe Dubois } while (0)
294a6aa0afSJean-Christophe Dubois
30e28bee8eSPaolo Bonzini
imx_ccm_get_clock_frequency(IMXCCMState * dev,IMXClk clock)31cb54d868SJean-Christophe Dubois uint32_t imx_ccm_get_clock_frequency(IMXCCMState *dev, IMXClk clock)
32e28bee8eSPaolo Bonzini {
33cb54d868SJean-Christophe Dubois uint32_t freq = 0;
34fed163c9SEduardo Habkost IMXCCMClass *klass = IMX_CCM_GET_CLASS(dev);
35e28bee8eSPaolo Bonzini
36cb54d868SJean-Christophe Dubois if (klass->get_clock_frequency) {
37cb54d868SJean-Christophe Dubois freq = klass->get_clock_frequency(dev, clock);
38e28bee8eSPaolo Bonzini }
39cb54d868SJean-Christophe Dubois
40*a88ae037SAlex Chen DPRINTF("(clock = %d) = %u\n", clock, freq);
41cb54d868SJean-Christophe Dubois
42cb54d868SJean-Christophe Dubois return freq;
43e28bee8eSPaolo Bonzini }
44e28bee8eSPaolo Bonzini
45e28bee8eSPaolo Bonzini /*
46e28bee8eSPaolo Bonzini * Calculate PLL output frequency
47e28bee8eSPaolo Bonzini */
imx_ccm_calc_pll(uint32_t pllreg,uint32_t base_freq)48cb54d868SJean-Christophe Dubois uint32_t imx_ccm_calc_pll(uint32_t pllreg, uint32_t base_freq)
49e28bee8eSPaolo Bonzini {
50cb54d868SJean-Christophe Dubois int32_t freq;
51e28bee8eSPaolo Bonzini int32_t mfn = MFN(pllreg); /* Numerator */
52e28bee8eSPaolo Bonzini uint32_t mfi = MFI(pllreg); /* Integer part */
53e28bee8eSPaolo Bonzini uint32_t mfd = 1 + MFD(pllreg); /* Denominator */
54e28bee8eSPaolo Bonzini uint32_t pd = 1 + PD(pllreg); /* Pre-divider */
55e28bee8eSPaolo Bonzini
56e28bee8eSPaolo Bonzini if (mfi < 5) {
57e28bee8eSPaolo Bonzini mfi = 5;
58e28bee8eSPaolo Bonzini }
59cb54d868SJean-Christophe Dubois
60e28bee8eSPaolo Bonzini /* mfn is 10-bit signed twos-complement */
61e28bee8eSPaolo Bonzini mfn <<= 32 - 10;
62e28bee8eSPaolo Bonzini mfn >>= 32 - 10;
63e28bee8eSPaolo Bonzini
64cb54d868SJean-Christophe Dubois freq = ((2 * (base_freq >> 10) * (mfi * mfd + mfn)) /
65e28bee8eSPaolo Bonzini (mfd * pd)) << 10;
66e28bee8eSPaolo Bonzini
67*a88ae037SAlex Chen DPRINTF("(pllreg = 0x%08x, base_freq = %u) = %d\n", pllreg, base_freq,
68cb54d868SJean-Christophe Dubois freq);
69e28bee8eSPaolo Bonzini
70cb54d868SJean-Christophe Dubois return freq;
71e28bee8eSPaolo Bonzini }
72e28bee8eSPaolo Bonzini
73e28bee8eSPaolo Bonzini static const TypeInfo imx_ccm_info = {
74bcb34c7aSAndreas Färber .name = TYPE_IMX_CCM,
75e28bee8eSPaolo Bonzini .parent = TYPE_SYS_BUS_DEVICE,
76e28bee8eSPaolo Bonzini .instance_size = sizeof(IMXCCMState),
77cb54d868SJean-Christophe Dubois .class_size = sizeof(IMXCCMClass),
78cb54d868SJean-Christophe Dubois .abstract = true,
79e28bee8eSPaolo Bonzini };
80e28bee8eSPaolo Bonzini
imx_ccm_register_types(void)81e28bee8eSPaolo Bonzini static void imx_ccm_register_types(void)
82e28bee8eSPaolo Bonzini {
83e28bee8eSPaolo Bonzini type_register_static(&imx_ccm_info);
84e28bee8eSPaolo Bonzini }
85e28bee8eSPaolo Bonzini
86e28bee8eSPaolo Bonzini type_init(imx_ccm_register_types)
87