void SYS_CLK_Initialize( const SYS_CLK_INIT const * clkInit )
{
SYS_DEVCON_SystemUnlock ( );
PLIB_OSC_FRCDivisorSelect( OSC_ID_0, OSC_FRC_DIV_2);
/* Enable Peripheral Bus 1 */
PLIB_OSC_PBClockDivisorSet (OSC_ID_0, 0, 1 );
/* Disable REFCLKO1*/
PLIB_OSC_ReferenceOscDisable ( OSC_ID_0, 0 );
/* Disable REFCLK1_OE*/
PLIB_OSC_ReferenceOutputDisable ( OSC_ID_0, 0 );
/* Disable REFCLKO2*/
PLIB_OSC_ReferenceOscDisable ( OSC_ID_0, 1 );
/* Disable REFCLK2_OE*/
PLIB_OSC_ReferenceOutputDisable ( OSC_ID_0, 1 );
/* Disable REFCLKO3*/
PLIB_OSC_ReferenceOscDisable ( OSC_ID_0, 2 );
/* Disable REFCLK3_OE*/
PLIB_OSC_ReferenceOutputDisable ( OSC_ID_0, 2 );
/* Disable REFCLKO4*/
PLIB_OSC_ReferenceOscDisable ( OSC_ID_0, 3 );
/* Disable REFCLK4_OE*/
PLIB_OSC_ReferenceOutputDisable ( OSC_ID_0, 3 );
SYS_DEVCON_SystemLock ( );
}
bool _SYS_CLK_PeripheralFrequencySet ( CLK_BUSES_PERIPHERAL peripheralBus,
uint32_t peripheralClockHz,
uint32_t *clockClosest )
{
uint8_t index = 0;
uint16_t divisorMatch = 0, divisor = 0;
unsigned long tempFrequency, prevFrequency = 0;
/* All MX devices have a single peripheral bus at the moment */
if (peripheralBus != CLK_BUS_PERIPHERAL_1)
{
*clockClosest = 0;
return false;
}
for ( index=0; index<4; index++ )
{
divisor = 0x01 << index;
/* Here the code is too specific to PIC32MX. The code may not be so easily
usable for other controllers. But seems like this is the best way to avoid
RAM usage for lookup tables */
tempFrequency = ( clkObject.systemClock / divisor );
if ( ( abs( peripheralClockHz - tempFrequency ) ) <
( abs ( peripheralClockHz - prevFrequency ) ) )
{
prevFrequency = tempFrequency;
divisorMatch = divisor;
}
}
if ( true == SYS_CLK_FrequencyErrorCheck ( peripheralClockHz, prevFrequency ) )
{
/* Unlock before you switch */
SYS_DEVCON_SystemUnlock ( );
PLIB_OSC_PBClockDivisorSet ( OSC_ID_0, peripheralBus, divisorMatch );
SYS_DEVCON_SystemLock ( );
clkObject.peripheralClockStatus[peripheralBus]
= SYS_CLK_OPERATION_COMPLETE;
}
else
{
/* Requested frequency is not achievable. Update the error code and closest
possible frequency */
clkObject.peripheralClosestClock[peripheralBus] = prevFrequency;
clkObject.peripheralClockStatus[peripheralBus]
= SYS_CLK_OPERATION_FAIL_NOT_ACHIEVABLE;
return false;
}
*clockClosest = prevFrequency;
return true;
}
void SYS_CLK_Initialize( const SYS_CLK_INIT const * clkInit )
{
SYS_DEVCON_SystemUnlock ( );
PLIB_OSC_FRCDivisorSelect( OSC_ID_0, OSC_FRC_DIV_1);
/* Enable Peripheral Bus 1 */
PLIB_OSC_PBClockDivisorSet (OSC_ID_0, 0, 2 );
PLIB_OSC_PBOutputClockEnable (OSC_ID_0, 0 );
/* Enable Peripheral Bus 2 */
PLIB_OSC_PBClockDivisorSet (OSC_ID_0, 1, 2 );
PLIB_OSC_PBOutputClockEnable (OSC_ID_0, 1 );
/* Enable Peripheral Bus 3 */
PLIB_OSC_PBClockDivisorSet (OSC_ID_0, 2, 2 );
PLIB_OSC_PBOutputClockEnable (OSC_ID_0, 2 );
/* Enable Peripheral Bus 4 */
PLIB_OSC_PBClockDivisorSet (OSC_ID_0, 3, 2 );
PLIB_OSC_PBOutputClockEnable (OSC_ID_0, 3 );
/* Enable Peripheral Bus 5 */
PLIB_OSC_PBClockDivisorSet (OSC_ID_0, 4, 2 );
PLIB_OSC_PBOutputClockEnable (OSC_ID_0, 4 );
/* Enable Peripheral Bus 7 */
PLIB_OSC_PBClockDivisorSet (OSC_ID_0, 6, 1 );
PLIB_OSC_PBOutputClockEnable (OSC_ID_0, 6 );
/* Enable Peripheral Bus 8 */
PLIB_OSC_PBClockDivisorSet (OSC_ID_0, 7, 2 );
PLIB_OSC_PBOutputClockEnable (OSC_ID_0, 7 );
/* Disable REFCLKO1*/
PLIB_OSC_ReferenceOscDisable ( OSC_ID_0, OSC_REFERENCE_1 );
/* Disable REFCLK1_OE*/
PLIB_OSC_ReferenceOutputDisable ( OSC_ID_0, OSC_REFERENCE_1 );
/* Disable REFCLKO2*/
PLIB_OSC_ReferenceOscDisable ( OSC_ID_0, OSC_REFERENCE_2 );
/* Disable REFCLK2_OE*/
PLIB_OSC_ReferenceOutputDisable ( OSC_ID_0, OSC_REFERENCE_2 );
/* Disable REFCLKO3*/
PLIB_OSC_ReferenceOscDisable ( OSC_ID_0, OSC_REFERENCE_3 );
/* Disable REFCLK3_OE*/
PLIB_OSC_ReferenceOutputDisable ( OSC_ID_0, OSC_REFERENCE_3 );
/* Disable REFCLKO4*/
PLIB_OSC_ReferenceOscDisable ( OSC_ID_0, OSC_REFERENCE_4 );
/* Disable REFCLK4_OE*/
PLIB_OSC_ReferenceOutputDisable ( OSC_ID_0, OSC_REFERENCE_4 );
SYS_DEVCON_SystemLock ( );
}
