/* ChibiOS/RT - Copyright (C) 2006,2007,2008,2009,2010, 2011,2012 Giovanni Di Sirio. This file is part of ChibiOS/RT. ChibiOS/RT is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License as published by the Free Software Foundation; either version 3 of the License, or (at your option) any later version. ChibiOS/RT is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. You should have received a copy of the GNU General Public License along with this program. If not, see . */ /** * @file SPC560BCxx/hal_lld.c * @brief SPC560B/Cxx HAL subsystem low level driver source. * * @addtogroup HAL * @{ */ #include "ch.h" #include "hal.h" /*===========================================================================*/ /* Driver exported variables. */ /*===========================================================================*/ /*===========================================================================*/ /* Driver local variables. */ /*===========================================================================*/ /*===========================================================================*/ /* Driver local functions. */ /*===========================================================================*/ /*===========================================================================*/ /* Driver interrupt handlers. */ /*===========================================================================*/ /** * @brief PIT channel 3 interrupt handler. * * @isr */ CH_IRQ_HANDLER(vector127) { CH_IRQ_PROLOGUE(); chSysLockFromIsr(); chSysTimerHandlerI(); chSysUnlockFromIsr(); /* Resets the PIT channel 3 IRQ flag.*/ PIT.CH[3].TFLG.R = 1; CH_IRQ_EPILOGUE(); } /*===========================================================================*/ /* Driver exported functions. */ /*===========================================================================*/ /** * @brief Low level HAL driver initialization. * * @notapi */ void hal_lld_init(void) { extern void _vectors(void); uint32_t reg; /* The system is switched to the RUN0 mode, the default for normal operations.*/ if (halSPC560PSetRunMode(SPC5_RUNMODE_RUN0) == CH_FAILED) chSysHalt(); /* INTC initialization, software vector mode, 4 bytes vectors, starting at priority 0.*/ INTC.MCR.R = 0; INTC.CPR.R = 0; INTC.IACKR.R = (uint32_t)_vectors; /* PIT channel 3 initialization for Kernel ticks, the PIT is configured to run in DRUN,RUN0...RUN3 and HALT0 modes, the clock is gated in other modes.*/ INTC.PSR[127].R = SPC5_PIT3_IRQ_PRIORITY; halSPC560PSetPeripheralClockMode(92, SPC5_ME_PCTL_RUN(2) | SPC5_ME_PCTL_LP(2)); reg = halSPC560PGetSystemClock() / CH_FREQUENCY - 1; PIT.PITMCR.R = 1; /* PIT clock enabled, stop while debugging. */ PIT.CH[3].LDVAL.R = reg; PIT.CH[3].CVAL.R = reg; PIT.CH[3].TFLG.R = 1; /* Interrupt flag cleared. */ PIT.CH[3].TCTRL.R = 3; /* Timer active, interrupt enabled. */ } /** * @brief SPC560Pxx clocks and PLL initialization. * @note All the involved constants come from the file @p board.h and * @p hal_lld.h * @note This function must be invoked only after the system reset. * * @special */ void spc560p_clock_init(void) { /* Waiting for IRC stabilization before attempting anything else.*/ while (!ME.GS.B.S_RC) ; #if !SPC5_NO_INIT #if defined(SPC5_OSC_BYPASS) /* If the board is equipped with an oscillator instead of a xtal then the bypass must be activated.*/ CGM.OSC_CTL.B.OSCBYP = TRUE; #endif /* SPC5_ENABLE_XOSC */ /* Initialization of the FMPLLs settings.*/ CGM.FMPLL[0].CR.R = SPC5_FMPLL0_ODF | ((SPC5_FMPLL0_IDF_VALUE - 1) << 26) | (SPC5_FMPLL0_NDIV_VALUE << 16); CGM.FMPLL[0].MR.R = 0; /* TODO: Add a setting. */ CGM.FMPLL[1].CR.R = SPC5_FMPLL1_ODF | (SPC5_FMPLL1_IDF_VALUE << 26) | (SPC5_FMPLL1_NDIV_VALUE << 16); CGM.FMPLL[1].MR.R = 0; /* TODO: Add a setting. */ /* Run modes initialization.*/ ME.MER.R = SPC5_ME_ME_BITS; /* Enabled run modes. */ ME.TEST.R = SPC5_ME_TEST_MC_BITS; /* TEST run mode. */ ME.SAFE.R = SPC5_ME_SAFE_MC_BITS; /* SAFE run mode. */ ME.DRUN.R = SPC5_ME_DRUN_MC_BITS; /* DRUN run mode. */ ME.RUN[0].R = SPC5_ME_RUN0_MC_BITS; /* RUN0 run mode. */ ME.RUN[1].R = SPC5_ME_RUN1_MC_BITS; /* RUN1 run mode. */ ME.RUN[2].R = SPC5_ME_RUN2_MC_BITS; /* RUN2 run mode. */ ME.RUN[3].R = SPC5_ME_RUN3_MC_BITS; /* RUN0 run mode. */ ME.HALT0.R = SPC5_ME_HALT0_MC_BITS; /* HALT0 run mode. */ ME.STOP0.R = SPC5_ME_STOP0_MC_BITS; /* STOP0 run mode. */ /* Peripherals run and low power modes initialization.*/ ME.RUNPC[0].R = SPC5_ME_RUN_PC0_BITS; ME.RUNPC[1].R = SPC5_ME_RUN_PC1_BITS; ME.RUNPC[2].R = SPC5_ME_RUN_PC2_BITS; ME.RUNPC[3].R = SPC5_ME_RUN_PC3_BITS; ME.RUNPC[4].R = SPC5_ME_RUN_PC4_BITS; ME.RUNPC[5].R = SPC5_ME_RUN_PC5_BITS; ME.RUNPC[6].R = SPC5_ME_RUN_PC6_BITS; ME.RUNPC[7].R = SPC5_ME_RUN_PC7_BITS; ME.LPPC[0].R = SPC5_ME_LP_PC0_BITS; ME.LPPC[1].R = SPC5_ME_LP_PC1_BITS; ME.LPPC[2].R = SPC5_ME_LP_PC2_BITS; ME.LPPC[3].R = SPC5_ME_LP_PC3_BITS; ME.LPPC[4].R = SPC5_ME_LP_PC4_BITS; ME.LPPC[5].R = SPC5_ME_LP_PC5_BITS; ME.LPPC[6].R = SPC5_ME_LP_PC6_BITS; ME.LPPC[7].R = SPC5_ME_LP_PC7_BITS; /* Switches again to DRUN mode (current mode) in order to update the settings.*/ if (halSPC560PSetRunMode(SPC5_RUNMODE_DRUN) == CH_FAILED) chSysHalt(); /* CFLASH settings calculated for a maximum clock of 64MHz.*/ CFLASH.PFCR0.B.BK0_APC = 2; CFLASH.PFCR0.B.BK0_RWSC = 2; CFLASH.PFCR1.B.BK1_APC = 2; CFLASH.PFCR1.B.BK1_RWSC = 2; #endif /* !SPC5_NO_INIT */ } /** * @brief Switches the system to the specified run mode. * * @param[in] mode one of the possible run modes * * @return The operation status. * @retval CH_SUCCESS if the switch operation has been completed. * @retval CH_FAILED if the switch operation failed. */ bool_t halSPC560PSetRunMode(spc560prunmode_t mode) { /* Starts a transition process.*/ ME.MCTL.R = SPC5_ME_MCTL_MODE(mode) | SPC5_ME_MCTL_KEY; ME.MCTL.R = SPC5_ME_MCTL_MODE(mode) | SPC5_ME_MCTL_KEY_INV; /* Waits the transition process to start.*/ while (!ME.GS.B.S_MTRANS) ; /* Waits the transition process to end.*/ while (ME.GS.B.S_MTRANS) ; /* Verifies that the mode has been effectively switched.*/ if (ME.GS.B.S_CURRENTMODE != mode) return CH_FAILED; return CH_SUCCESS; } /** * @brief Changes the clock mode of a peripheral. * * @param[in] n index of the @p PCTL register * @param[in] pctl new value for the @p PCTL register * * @notapi */ void halSPC560PSetPeripheralClockMode(uint32_t n, uint32_t pctl) { uint32_t mode; ME.PCTL[n].R = pctl; mode = ME.MCTL.B.TARGET_MODE; ME.MCTL.R = SPC5_ME_MCTL_MODE(mode) | SPC5_ME_MCTL_KEY; ME.MCTL.R = SPC5_ME_MCTL_MODE(mode) | SPC5_ME_MCTL_KEY_INV; } #if !SPC5_NO_INIT || defined(__DOXYGEN__) /** * @brief Returns the system clock under the current run mode. * * @return The system clock in Hertz. */ uint32_t halSPC560PGetSystemClock(void) { uint32_t sysclk; sysclk = ME.GS.B.S_SYSCLK; switch (sysclk) { case SPC5_ME_GS_SYSCLK_IRC: return SPC5_IRC_CLK; case SPC5_ME_GS_SYSCLK_XOSC: return SPC5_XOSC_CLK; case SPC5_ME_GS_SYSCLK_FMPLL0: return SPC5_FMPLL0_CLK; case SPC5_ME_GS_SYSCLK_FMPLL1: return SPC5_FMPLL1_CLK; default: return 0; } } #endif /* !SPC5_NO_INIT */ /** @} */