SAMA5D23 boards: When running out of SDRAM, need to query the PMC to determine operating frequency

This commit is contained in:
Gregory Nutt 2014-03-29 17:51:06 -06:00
parent ff594d859e
commit c20f9c71b1
4 changed files with 409 additions and 253 deletions

View File

@ -56,6 +56,11 @@
* Pre-processor Definitions
****************************************************************************/
#undef NEED_PLLSETUP
#if defined(CONFIG_SAMA5_BOOT_ISRAM) || defined(CONFIG_SAMA5_BOOT_CS0FLASH)
# define NEED_PLLSETUP 1
#endif
/****************************************************************************
* Private Types
****************************************************************************/
@ -80,6 +85,7 @@
*
****************************************************************************/
#if defined(NEED_PLLSETUP)
static void sam_pmcwait(uint32_t bit)
{
/* There is no timeout on this wait. Why not? Because the symptoms there
@ -90,15 +96,17 @@ static void sam_pmcwait(uint32_t bit)
while ((getreg32(SAM_PMC_SR) & bit) == 0);
}
#endif
/****************************************************************************
* Name: sam_enablemosc
*
* Description:
* Enable the main osciallator
* Enable the main oscillator
*
****************************************************************************/
#if defined(NEED_PLLSETUP)
static inline void sam_enablemosc(void)
{
uint32_t regval;
@ -141,6 +149,7 @@ static inline void sam_enablemosc(void)
sam_pmcwait(PMC_INT_MCKRDY);
}
}
#endif
/****************************************************************************
* Name: sam_selectmosc
@ -152,6 +161,7 @@ static inline void sam_enablemosc(void)
*
****************************************************************************/
#if defined(NEED_PLLSETUP)
static inline void sam_selectmosc(void)
{
uint32_t regval;
@ -167,6 +177,7 @@ static inline void sam_selectmosc(void)
sam_pmcwait(PMC_INT_MCKRDY);
}
#endif
/****************************************************************************
* Name: sam_pllasetup
@ -178,6 +189,7 @@ static inline void sam_selectmosc(void)
*
****************************************************************************/
#if defined(NEED_PLLSETUP)
static inline void sam_pllasetup(void)
{
uint32_t regval;
@ -197,6 +209,7 @@ static inline void sam_pllasetup(void)
sam_pmcwait(PMC_INT_LOCKA);
}
#endif
/****************************************************************************
* Name: sam_plladivider
@ -206,6 +219,7 @@ static inline void sam_pllasetup(void)
*
****************************************************************************/
#if defined(NEED_PLLSETUP)
static inline void sam_plladivider(void)
{
uint32_t regval;
@ -246,6 +260,7 @@ static inline void sam_plladivider(void)
sam_pmcwait(PMC_INT_MCKRDY);
}
#endif
/****************************************************************************
* Name: sam_mckprescaler
@ -255,6 +270,7 @@ static inline void sam_plladivider(void)
*
****************************************************************************/
#if defined(NEED_PLLSETUP)
static inline void sam_mckprescaler(void)
{
uint32_t regval;
@ -270,6 +286,7 @@ static inline void sam_mckprescaler(void)
sam_pmcwait(PMC_INT_MCKRDY);
}
#endif
/****************************************************************************
* Name: sam_mckdivider
@ -280,6 +297,7 @@ static inline void sam_mckprescaler(void)
*
****************************************************************************/
#if defined(NEED_PLLSETUP)
static inline void sam_mckdivider(void)
{
uint32_t regval;
@ -295,6 +313,7 @@ static inline void sam_mckdivider(void)
sam_pmcwait(PMC_INT_MCKRDY);
}
#endif
/****************************************************************************
* Name: sam_selectplla
@ -304,6 +323,7 @@ static inline void sam_mckdivider(void)
*
****************************************************************************/
#if defined(NEED_PLLSETUP)
static inline void sam_selectplla(void)
{
uint32_t regval;
@ -319,6 +339,7 @@ static inline void sam_selectplla(void)
sam_pmcwait(PMC_INT_MCKRDY);
}
#endif
/****************************************************************************
* Name: sam_usbclockconfig
@ -569,8 +590,8 @@ void sam_clockconfig(void)
#ifdef CONFIG_SAMA5_BOOT_CS0FLASH
if (config)
#endif /* CONFIG_SAMA5_BOOT_CS0FLASH */
#if defined(CONFIG_SAMA5_BOOT_ISRAM) || defined(CONFIG_SAMA5_BOOT_CS0FLASH)
{
#if defined(NEED_PLLSETUP)
/* Enable main oscillator (if it has not already been selected) */
sam_enablemosc();
@ -601,10 +622,10 @@ void sam_clockconfig(void)
/* Finally, elect the PLLA output as the input clock for PCK and MCK. */
sam_selectplla();
#endif /* NEED_PLLSETUP */
/* Setup USB clocking */
sam_usbclockconfig();
}
#endif /* CONFIG_SAMA5_BOOT_ISRAM || CONFIG_SAMA5_BOOT_CS0FLASH */
}

View File

@ -50,6 +50,11 @@
#include "up_arch.h"
#include "chip.h"
#ifdef CONFIG_ARCH_HAVE_SDIO
# include "chip/sam_hsmci.h"
#endif
#include "chip/sam_pmc.h"
#include "sam_pmc.h"
@ -120,11 +125,11 @@ uint32_t sam_pllack_frequency(uint32_t mainclk)
*/
mula = (regval & PMC_CKGR_PLLAR_MUL_MASK) >> PMC_CKGR_PLLAR_MUL_SHIFT;
if (mula > 1)
if (mula > 0)
{
pllack *= (mula + 1);
pllack *= (mula + 1);
}
else if (diva < 1)
else
{
return 0;
}
@ -132,6 +137,43 @@ uint32_t sam_pllack_frequency(uint32_t mainclk)
return pllack;
}
/****************************************************************************
* Name: sam_plladiv2_frequency
*
* Description:
* The PLLACK input to most clocking may or may not be divided by two.
* This function will return the possibly divided PLLACK clock input
* frequency.
*
* Assumptions:
* See sam_pllack_frequency.
*
****************************************************************************/
uint32_t sam_plladiv2_frequency(uint32_t mainclk)
{
uint32_t regval;
uint32_t pllack;
/* Get the PLLA output clock */
pllack = sam_pllack_frequency(mainclk);
if (pllack == 0)
{
return 0;
}
/* Check if the PLLACK output is divided by 2 */
regval = getreg32(SAM_PMC_MCKR);
if ((regval & PMC_MCKR_PLLADIV2) != 0)
{
pllack >>= 1;
}
return pllack;
}
/****************************************************************************
* Name: sam_pck_frequency
*
@ -165,18 +207,11 @@ uint32_t sam_pck_frequency(uint32_t mainclk)
case PMC_MCKR_CSS_PLLA: /* PLLA Clock */
/* Use the PLLA output clock */
pck = sam_pllack_frequency(mainclk);
pck = sam_plladiv2_frequency(mainclk);
if (pck == 0)
{
return 0;
}
/* Check if the PLLACK output is divided by 2 */
if ((regval & PMC_MCKR_PLLADIV2) != 0)
{
pck >>= 1;
}
break;
case PMC_MCKR_CSS_SLOW: /* Slow Clock */
@ -225,14 +260,80 @@ uint32_t sam_mck_frequency(uint32_t mainclk)
return 0;
}
/* MDIV = n: Master Clock is Prescaler Output Clock divided by (n + 1) */
/* MDIV = n: Master Clock is Prescaler Output Clock divided by encoded value */
regval = getreg32(SAM_PMC_MCKR);
mdiv = (regval & PMC_MCKR_MDIV_MASK) >> PMC_MCKR_MDIV_SHIFT;
if (mdiv > 0)
switch (regval & PMC_MCKR_MDIV_MASK)
{
mck /= (mdiv + 1);
case PMC_MCKR_MDIV_PCKDIV1:
return mck;
case PMC_MCKR_MDIV_PCKDIV2:
mdiv = 2;
break;
case PMC_MCKR_MDIV_PCKDIV3:
mdiv = 3;
break;
case PMC_MCKR_MDIV_PCKDIV4:
mdiv = 4;
break;
default:
return 0;
}
return mck;
return mck / mdiv;
}
/************************************************************************************
* Name: sam_hsmci_clkdiv
*
* Description:
* Multimedia Card Interface clock (MCCK or MCI_CK) is Master Clock (MCK)
* divided by (2*(CLKDIV) + CLOCKODD + 2).
*
* CLKFULLDIV = 2*CLKDIV + CLOCKODD;
* MCI_SPEED = MCK / (CLKFULLDIV + 2)
* CLKFULLDIV = MCK / MCI_SPEED - 2
*
* CLKDIV = CLKFULLDIV >> 1
* CLOCKODD = CLKFULLDIV & 1
*
* Where CLKDIV has a range of 0-255.
*
* TODO: This belongs elsewhere
*
************************************************************************************/
#ifdef CONFIG_ARCH_HAVE_SDIO
uint32_t sam_hsmci_clkdiv(uint32_t target)
{
uint32_t clkfulldiv;
uint32_t ret;
clkfulldiv = BOARD_MCK_FREQUENCY / target;
if (clkfulldiv > 2)
{
clkfulldiv -= 2;
}
else
{
clkfulldiv = 0;
}
if (clkfulldiv > 511)
{
clkfulldiv = 511;
}
ret = (clkfulldiv >> 1) << HSMCI_MR_CLKDIV_SHIFT;
if ((clkfulldiv & 1) != 0)
{
ret |= HSMCI_MR_CLKODD;
}
return ret;
}
#endif

View File

@ -76,6 +76,21 @@ extern "C"
uint32_t sam_pllack_frequency(uint32_t mainclk);
/****************************************************************************
* Name: sam_plladiv2_frequency
*
* Description:
* The PLLACK input to most clocking may or may not be divided by two.
* This function will return the possibly divided PLLACK clock input
* frequency.
*
* Assumptions:
* See sam_pllack_frequency.
*
****************************************************************************/
uint32_t sam_plladiv2_frequency(uint32_t mainclk);
/****************************************************************************
* Name: sam_pck_frequency
*
@ -106,6 +121,30 @@ uint32_t sam_pck_frequency(uint32_t mainclk);
uint32_t sam_mck_frequency(uint32_t mainclk);
/************************************************************************************
* Name: sam_hsmci_clkdiv
*
* Description:
* Multimedia Card Interface clock (MCCK or MCI_CK) is Master Clock (MCK)
* divided by (2*(CLKDIV) + CLOCKODD + 2).
*
* CLKFULLDIV = 2*CLKDIV + CLOCKODD;
* MCI_SPEED = MCK / (CLKFULLDIV + 2)
* CLKFULLDIV = MCK / MCI_SPEED - 2
*
* CLKDIV = CLKFULLDIV >> 1
* CLOCKODD = CLKFULLDIV & 1
*
* Where CLKDIV has a range of 0-255.
*
* TODO: This belongs elsewhere
*
************************************************************************************/
#ifdef CONFIG_ARCH_HAVE_SDIO
uint32_t sam_hsmci_clkdiv(uint32_t target);
#endif
#undef EXTERN
#if defined(__cplusplus)
}

View File

@ -70,14 +70,6 @@
#define PIT_PIV ((PIT_CLOCK + (CLK_TCK >> 1)) / CLK_TCK)
/* The size of the reload field is 20 bits. Verify that the reload value
* will fit in the reload register.
*/
#if PIT_PIV > PIT_MR_PIV_MASK
# error PIT_PIV exceeds the maximum value
#endif
/****************************************************************************
* Private Types
****************************************************************************/
@ -149,7 +141,10 @@ void up_timerinit(void)
* interrupts from the PIT.
*/
regval = PIT_PIV | PIT_MR_PITEN | PIT_MR_PITIEN;
regval = PIT_PIV;
DEBUGASSERT(regval <= PIT_MR_PIV_MASK);
regval |= (PIT_MR_PITEN | PIT_MR_PITIEN);
putreg32(regval, SAM_PIT_MR);
/* And enable the timer interrupt */