third_party/nxp/JN5189/system_JN5189.c

/*
** ###################################################################
**     Processors:          JN5189HN
**                          JN5189THN
**
**     Compilers:           Keil ARM C/C++ Compiler
**                          GNU C Compiler
**                          IAR ANSI C/C++ Compiler for ARM
**                          MCUXpresso Compiler
**
**     Reference manual:    JN5189 User manual Rev0.1 27 July 2018
**     Version:             rev. 1.0, 2018-07-31
**     Build:               b180731
**
**     Abstract:
**         Provides a system configuration function and a global variable that
**         contains the system frequency. It configures the device and initializes
**         the oscillator (PLL) that is part of the microcontroller device.
**
**     Copyright 2016 Freescale Semiconductor, Inc.
**     Copyright 2016-2018 NXP
**
**     SPDX-License-Identifier: BSD-3-Clause
**
**     http:                 www.nxp.com
**     mail:                 support@nxp.com
**
**     Revisions:
**     - rev. 1.0 (2018-07-31)
**         Initial version.
**
** ###################################################################
*/

/*!
 * @file JN5189
 * @version 1.0
 * @date 2018-07-31
 * @brief Device specific configuration file for JN5189 (implementation file)
 *
 * Provides a system configuration function and a global variable that contains
 * the system frequency. It configures the device and initializes the oscillator
 * (PLL) that is part of the microcontroller device.
 */

#include <stdint.h>
#include "fsl_device_registers.h"
#include "rom_api.h"

/**
 * Clock source selections for the Main Clock
 */
typedef enum _main_clock_src
{
    kCLOCK_MainFro12M 		= 0,
    kCLOCK_MainOsc32k 		= 1,
    kCLOCK_MainXtal32M		= 2,
    kCLOCK_MainFro32M		= 3,
    kCLOCK_MainFro48M		= 4,
    kCLOCK_MainExtClk		= 5,
    kCLOCK_MainFro1M		= 6,
} main_clock_src_t;


/**
 * Clock source selections for CLKOUT
 */
typedef enum _clkout_clock_src
{
    kCLOCK_ClkoutMainClk = 0,
    kCLOCK_ClkoutXtal32k = 1,
    kCLOCK_ClkoutFro32k	 = 2,
    kCLOCK_ClkoutXtal32M = 3,
    kCLOCK_ClkoutDcDcTest= 4,
    kCLOCK_ClkoutFro48M  = 5,
    kCLOCK_ClkoutFro1M   = 6,
    kCLOCK_ClkoutNoClock = 7
} clkout_clock_src_t;

typedef enum
{
    FRO12M_ENA  = (1 << 0),
    FRO32M_ENA  = (1 << 1),
    FRO48M_ENA  = (1 << 2),
    FRO64M_ENA  = (1 << 3),
    FRO96M_ENA  = (1 << 4)
} Fro_ClkSel_t;

#define OSC32K_FREQ        32768UL
#define FRO32K_FREQ        32768UL
#define OSC32M_FREQ        32000000UL
#define XTAL32M_FREQ       32000000UL
#define FRO64M_FREQ        64000000UL
#define FRO1M_FREQ         1000000UL
#define FRO12M_FREQ        12000000UL
#define FRO32M_FREQ        32000000UL
#define FRO48M_FREQ        48000000UL

static const uint32_t g_Ext_Clk_Freq = 0U;

extern unsigned int __Vectors;
extern WEAK void SystemInit(void);
extern WEAK void WarmMain(void);

static uint32_t CLOCK_GetXtal32kFreq(void)
{
    uint32_t freq = 0;

    if (((PMC->PDRUNCFG & PMC_PDRUNCFG_ENA_XTAL32K_MASK)
                >> PMC_PDRUNCFG_ENA_XTAL32K_SHIFT) != 0)
    {
        freq = OSC32K_FREQ;
    }

    return freq;
}

static uint32_t CLOCK_GetXtal32MFreq(void)
{
    return XTAL32M_FREQ;
}

static uint32_t CLOCK_GetFro32kFreq(void)
{
    uint32_t freq = 0;

    if (((PMC->PDRUNCFG & PMC_PDRUNCFG_ENA_FRO32K_MASK)
                >> PMC_PDRUNCFG_ENA_FRO32K_SHIFT) != 0)
    {
        freq = FRO32K_FREQ;
    }

    return freq;
}

static uint32_t CLOCK_GetFro1MFreq(void)
{
    return FRO1M_FREQ;
}

static uint32_t CLOCK_GetFro12MFreq(void)
{
    uint32_t freq = 0;

    if (((PMC->FRO192M & PMC_FRO192M_DIVSEL_MASK) >>
            PMC_FRO192M_DIVSEL_SHIFT) & FRO12M_ENA)
    {
        freq = FRO12M_FREQ;
    }

    return freq;
}

static uint32_t CLOCK_GetFro32MFreq(void)
{
    uint32_t freq = 0;

    if (((PMC->FRO192M & PMC_FRO192M_DIVSEL_MASK) >>
            PMC_FRO192M_DIVSEL_SHIFT) & FRO32M_ENA)
    {
        freq = FRO32M_FREQ;
    }

    return freq;
}

static uint32_t CLOCK_GetFro48MFreq(void)
{
    uint32_t freq = 0;

    if (((PMC->FRO192M & PMC_FRO192M_DIVSEL_MASK) >>
            PMC_FRO192M_DIVSEL_SHIFT) & FRO48M_ENA)
    {
        freq = FRO48M_FREQ;
    }

    return freq;
}

static uint32_t CLOCK_GetOsc32kFreq(void)
{
    uint32_t freq = 0;
    if ((SYSCON->OSC32CLKSEL & SYSCON_OSC32CLKSEL_SEL32KHZ_MASK) != 0)
    {
        freq = CLOCK_GetXtal32kFreq();
    }
    else
    {
        freq = CLOCK_GetFro32kFreq();
    }
    return freq;
}

/* Return main clock rate */
static uint32_t CLOCK_GetMainClockRate(void)
{
    uint32_t freq = 0;

    switch ((main_clock_src_t)((SYSCON->MAINCLKSEL & SYSCON_MAINCLKSEL_SEL_MASK)
                    >> SYSCON_MAINCLKSEL_SEL_SHIFT))
    {
    case kCLOCK_MainFro12M:
        freq = CLOCK_GetFro12MFreq();
        break;

    case kCLOCK_MainOsc32k:
        freq = CLOCK_GetOsc32kFreq();
        break;

    case kCLOCK_MainXtal32M:
        freq = CLOCK_GetXtal32MFreq();
        break;

    case kCLOCK_MainFro32M:
        freq = CLOCK_GetFro32MFreq();
        break;

    case kCLOCK_MainFro48M:
        freq = CLOCK_GetFro48MFreq();
        break;

    case kCLOCK_MainExtClk:
        freq = g_Ext_Clk_Freq;
        break;

    case kCLOCK_MainFro1M:
        freq = CLOCK_GetFro1MFreq();
        break;
    }

    return freq;
}



/* ----------------------------------------------------------------------------
   -- Core clock
   ---------------------------------------------------------------------------- */

uint32_t SystemCoreClock = DEFAULT_SYSTEM_CLOCK;

/* ----------------------------------------------------------------------------
   -- SystemInit()
   ---------------------------------------------------------------------------- */

void SystemInit (void) {
    uint32_t trim;
    /* Initialise SystemCoreClock value */
    SystemCoreClockUpdate();

    /* Initialise NVIC priority grouping value */
    NVIC_SetPriorityGrouping(4);

    /* Apply FRO1M trim value */
    trim = *(uint32_t*)(0x9FCD0U);

    if(trim & 0x1U)
    {
        PMC->FRO1M = (PMC->FRO1M & ~PMC_FRO1M_FREQSEL_MASK) | ((trim>>1) & PMC_FRO1M_FREQSEL_MASK);
    }
}

/* ----------------------------------------------------------------------------
   -- SystemCoreClockUpdate()
   ---------------------------------------------------------------------------- */

void SystemCoreClockUpdate (void) {
    SystemCoreClock = (CLOCK_GetMainClockRate() / ((SYSCON->AHBCLKDIV & SYSCON_AHBCLKDIV_DIV_MASK) + 1U));
}