189 lines
7.2 KiB
C
189 lines
7.2 KiB
C
/* ----------------------------------------------------------------------------
|
|
* ATMEL Microcontroller Software Support
|
|
* ----------------------------------------------------------------------------
|
|
* Copyright (c) 2008, Atmel Corporation
|
|
*
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions are met:
|
|
*
|
|
* - Redistributions of source code must retain the above copyright notice,
|
|
* this list of conditions and the disclaimer below.
|
|
*
|
|
* Atmel's name may not be used to endorse or promote products derived from
|
|
* this software without specific prior written permission.
|
|
*
|
|
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
* ----------------------------------------------------------------------------
|
|
*/
|
|
|
|
//------------------------------------------------------------------------------
|
|
// Headers
|
|
//------------------------------------------------------------------------------
|
|
|
|
#include "pmc.h"
|
|
#include <board.h>
|
|
#include <utility/assert.h>
|
|
#include <utility/trace.h>
|
|
|
|
#ifdef CP15_PRESENT
|
|
#include <cp15/cp15.h>
|
|
#endif
|
|
|
|
#define MASK_STATUS 0x3FFFFFFC
|
|
|
|
//------------------------------------------------------------------------------
|
|
// Global functions
|
|
//------------------------------------------------------------------------------
|
|
|
|
#if defined(at91sam7l64) || defined(at91sam7l128)
|
|
//------------------------------------------------------------------------------
|
|
/// Sets the fast wake-up inputs that can get the device out of Wait mode.
|
|
/// \param inputs Fast wake-up inputs to enable.
|
|
//------------------------------------------------------------------------------
|
|
void PMC_SetFastWakeUpInputs(unsigned int inputs)
|
|
{
|
|
SANITY_CHECK((inputs & ~0xFF) == 0);
|
|
AT91C_BASE_PMC->PMC_FSMR = inputs;
|
|
}
|
|
|
|
#if !defined(__ICCARM__)
|
|
__attribute__ ((section (".ramfunc"))) // GCC
|
|
#endif
|
|
//------------------------------------------------------------------------------
|
|
/// Disables the main oscillator, making the device enter Wait mode.
|
|
//------------------------------------------------------------------------------
|
|
void PMC_DisableMainOscillatorForWaitMode(void)
|
|
{
|
|
AT91C_BASE_PMC->PMC_MOR = 0x37 << 16;
|
|
while ((AT91C_BASE_PMC->PMC_MOR & AT91C_PMC_MAINSELS) != AT91C_PMC_MAINSELS);
|
|
}
|
|
|
|
#endif
|
|
|
|
#if defined(at91sam7l)
|
|
//------------------------------------------------------------------------------
|
|
/// Disables the main oscillator when NOT running on it.
|
|
//------------------------------------------------------------------------------
|
|
void PMC_DisableMainOscillator(void)
|
|
{
|
|
AT91C_BASE_PMC->PMC_MOR = 0x37 << 16;
|
|
while ((AT91C_BASE_PMC->PMC_SR & AT91C_PMC_MAINSELS) == AT91C_PMC_MAINSELS);
|
|
}
|
|
#endif
|
|
|
|
//------------------------------------------------------------------------------
|
|
/// Disables the processor clock
|
|
//------------------------------------------------------------------------------
|
|
void PMC_DisableProcessorClock(void)
|
|
{
|
|
AT91C_BASE_PMC->PMC_SCDR = AT91C_PMC_PCK;
|
|
while ((AT91C_BASE_PMC->PMC_SCSR & AT91C_PMC_PCK) != AT91C_PMC_PCK);
|
|
}
|
|
|
|
//------------------------------------------------------------------------------
|
|
/// Enables the clock of a peripheral. The peripheral ID (AT91C_ID_xxx) is used
|
|
/// to identify which peripheral is targetted.
|
|
/// Note that the ID must NOT be shifted (i.e. 1 << AT91C_ID_xxx).
|
|
/// \param id Peripheral ID (AT91C_ID_xxx).
|
|
//------------------------------------------------------------------------------
|
|
void PMC_EnablePeripheral(unsigned int id)
|
|
{
|
|
SANITY_CHECK(id < 32);
|
|
|
|
if ((AT91C_BASE_PMC->PMC_PCSR & (1 << id)) == (1 << id)) {
|
|
|
|
TRACE_INFO("PMC_EnablePeripheral: clock of peripheral"
|
|
" %u is already enabled\n\r",
|
|
id);
|
|
}
|
|
else {
|
|
|
|
AT91C_BASE_PMC->PMC_PCER = 1 << id;
|
|
}
|
|
}
|
|
|
|
//------------------------------------------------------------------------------
|
|
/// Disables the clock of a peripheral. The peripheral ID (AT91C_ID_xxx) is used
|
|
/// to identify which peripheral is targetted.
|
|
/// Note that the ID must NOT be shifted (i.e. 1 << AT91C_ID_xxx).
|
|
/// \param id Peripheral ID (AT91C_ID_xxx).
|
|
//------------------------------------------------------------------------------
|
|
void PMC_DisablePeripheral(unsigned int id)
|
|
{
|
|
SANITY_CHECK(id < 32);
|
|
|
|
if ((AT91C_BASE_PMC->PMC_PCSR & (1 << id)) != (1 << id)) {
|
|
|
|
TRACE_INFO("PMC_DisablePeripheral: clock of peripheral"
|
|
" %u is not enabled\n\r",
|
|
id);
|
|
}
|
|
else {
|
|
|
|
AT91C_BASE_PMC->PMC_PCDR = 1 << id;
|
|
}
|
|
}
|
|
|
|
//------------------------------------------------------------------------------
|
|
/// Enable all the periph clock via PMC
|
|
/// (Becareful of the last 2 bits, it is not periph clock)
|
|
//------------------------------------------------------------------------------
|
|
void PMC_EnableAllPeripherals(void)
|
|
{
|
|
AT91C_BASE_PMC->PMC_PCER = MASK_STATUS;
|
|
while( (AT91C_BASE_PMC->PMC_PCSR & MASK_STATUS) != MASK_STATUS);
|
|
TRACE_INFO("Enable all periph clocks\n\r");
|
|
}
|
|
|
|
//------------------------------------------------------------------------------
|
|
/// Disable all the periph clock via PMC
|
|
/// (Becareful of the last 2 bits, it is not periph clock)
|
|
//------------------------------------------------------------------------------
|
|
void PMC_DisableAllPeripherals(void)
|
|
{
|
|
AT91C_BASE_PMC->PMC_PCDR = MASK_STATUS;
|
|
while((AT91C_BASE_PMC->PMC_PCSR & MASK_STATUS) != 0);
|
|
TRACE_INFO("Disable all periph clocks\n\r");
|
|
}
|
|
|
|
//-----------------------------------------------------------------------------
|
|
/// Get Periph Status
|
|
//-----------------------------------------------------------------------------
|
|
unsigned int PMC_IsAllPeriphEnabled(void)
|
|
{
|
|
return (AT91C_BASE_PMC->PMC_PCSR == MASK_STATUS);
|
|
}
|
|
|
|
//-----------------------------------------------------------------------------
|
|
/// Get Periph Status
|
|
//-----------------------------------------------------------------------------
|
|
unsigned int PMC_IsPeriphEnabled(unsigned int id)
|
|
{
|
|
return (AT91C_BASE_PMC->PMC_PCSR & (1 << id));
|
|
}
|
|
//------------------------------------------------------------------------------
|
|
/// Put the CPU in Idle Mode for lower consumption
|
|
//------------------------------------------------------------------------------
|
|
void PMC_CPUInIdleMode(void)
|
|
{
|
|
#ifndef CP15_PRESENT
|
|
PMC_DisableProcessorClock();
|
|
#else
|
|
AT91C_BASE_PMC->PMC_SCDR = AT91C_PMC_PCK;
|
|
CP15_WaitForInterrupt();
|
|
#endif
|
|
}
|
|
|
|
|