git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@5126 35acf78f-673a-0410-8e92-d51de3d6d3f4
gdisirio
parent
5151c131d8
commit
20d47035b0
|
|
@ -0,0 +1,247 @@
|
|||
/*
|
||||
* Licensed under ST Liberty SW License Agreement V2, (the "License");
|
||||
* You may not use this file except in compliance with the License.
|
||||
* You may obtain a copy of the License at:
|
||||
*
|
||||
* http://www.st.com/software_license_agreement_liberty_v2
|
||||
*
|
||||
* Unless required by applicable law or agreed to in writing, software
|
||||
* distributed under the License is distributed on an "AS IS" BASIS,
|
||||
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||
* See the License for the specific language governing permissions and
|
||||
* limitations under the License.
|
||||
*/
|
||||
|
||||
/**
|
||||
* @file SPC56ELxx/hal_lld.c
|
||||
* @brief SPC56ELxx 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(vector59) {
|
||||
|
||||
CH_IRQ_PROLOGUE();
|
||||
|
||||
chSysLockFromIsr();
|
||||
chSysTimerHandlerI();
|
||||
chSysUnlockFromIsr();
|
||||
|
||||
/* Resets the PIT channel 3 IRQ flag.*/
|
||||
PIT.CH[0].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 (halSPCSetRunMode(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 0 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[59].R = SPC5_PIT0_IRQ_PRIORITY;
|
||||
halSPCSetPeripheralClockMode(92,
|
||||
SPC5_ME_PCTL_RUN(2) | SPC5_ME_PCTL_LP(2));
|
||||
reg = halSPCGetSystemClock() / CH_FREQUENCY - 1;
|
||||
PIT.PITMCR.R = 1; /* PIT clock enabled, stop while debugging. */
|
||||
PIT.CH[0].LDVAL.R = reg;
|
||||
PIT.CH[0].CVAL.R = reg;
|
||||
PIT.CH[0].TFLG.R = 1; /* Interrupt flag cleared. */
|
||||
PIT.CH[0].TCTRL.R = 3; /* Timer active, interrupt enabled. */
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief SPC56ELxx 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 spc_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_OSC_BYPASS */
|
||||
|
||||
/* 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 (halSPCSetRunMode(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 halSPCSetRunMode(spc5_runmode_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 halSPCSetPeripheralClockMode(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 halSPCGetSystemClock(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 */
|
||||
|
||||
/** @} */
|
||||
|
|
@ -28,8 +28,8 @@
|
|||
#ifndef _HAL_LLD_H_
|
||||
#define _HAL_LLD_H_
|
||||
|
||||
#include "xpc560p.h"
|
||||
#include "spc560p_registry.h"
|
||||
#include "xpc56el.h"
|
||||
#include "spc56el_registry.h"
|
||||
|
||||
/*===========================================================================*/
|
||||
/* Driver constants. */
|
||||
|
|
|
|||
|
|
@ -0,0 +1,9 @@
|
|||
# List of all the SPC560Pxx platform files.
|
||||
PLATFORMSRC = ${CHIBIOS}/os/hal/platforms/SPC560Pxx/hal_lld.c \
|
||||
${CHIBIOS}/os/hal/platforms/SPC5xx/SIUL_v1/pal_lld.c \
|
||||
${CHIBIOS}/os/hal/platforms/SPC5xx/LINFlex_v1/serial_lld.c
|
||||
|
||||
# Required include directories
|
||||
PLATFORMINC = ${CHIBIOS}/os/hal/platforms/SPC560Pxx \
|
||||
${CHIBIOS}/os/hal/platforms/SPC5xx/SIUL_v1 \
|
||||
${CHIBIOS}/os/hal/platforms/SPC5xx/LINFlex_v1
|
||||
|
|
@ -0,0 +1,66 @@
|
|||
/*
|
||||
* Licensed under ST Liberty SW License Agreement V2, (the "License");
|
||||
* You may not use this file except in compliance with the License.
|
||||
* You may obtain a copy of the License at:
|
||||
*
|
||||
* http://www.st.com/software_license_agreement_liberty_v2
|
||||
*
|
||||
* Unless required by applicable law or agreed to in writing, software
|
||||
* distributed under the License is distributed on an "AS IS" BASIS,
|
||||
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||
* See the License for the specific language governing permissions and
|
||||
* limitations under the License.
|
||||
*/
|
||||
|
||||
/**
|
||||
* @file SPC56ELxx/spc560p_registry.h
|
||||
* @brief SPC56ELxx capabilities registry.
|
||||
*
|
||||
* @addtogroup HAL
|
||||
* @{
|
||||
*/
|
||||
|
||||
#ifndef _SPC560P_REGISTRY_H_
|
||||
#define _SPC560P_REGISTRY_H_
|
||||
|
||||
/*===========================================================================*/
|
||||
/* Platform capabilities. */
|
||||
/*===========================================================================*/
|
||||
|
||||
/**
|
||||
* @name SPC56ELxx capabilities
|
||||
* @{
|
||||
*/
|
||||
/* LINFlex attributes.*/
|
||||
#define SPC5_HAS_LINFLEX0 TRUE
|
||||
#define SPC5_LINFLEX0_PCTL 48
|
||||
#define SPC5_LINFLEX0_RXI_HANDLER vector79
|
||||
#define SPC5_LINFLEX0_TXI_HANDLER vector80
|
||||
#define SPC5_LINFLEX0_ERR_HANDLER vector81
|
||||
#define SPC5_LINFLEX0_RXI_NUMBER 79
|
||||
#define SPC5_LINFLEX0_TXI_NUMBER 80
|
||||
#define SPC5_LINFLEX0_ERR_NUMBER 81
|
||||
|
||||
#define SPC5_HAS_LINFLEX1 TRUE
|
||||
#define SPC5_LINFLEX1_PCTL 49
|
||||
#define SPC5_LINFLEX1_RXI_HANDLER vector99
|
||||
#define SPC5_LINFLEX1_TXI_HANDLER vector100
|
||||
#define SPC5_LINFLEX1_ERR_HANDLER vector101
|
||||
#define SPC5_LINFLEX1_RXI_NUMBER 99
|
||||
#define SPC5_LINFLEX1_TXI_NUMBER 100
|
||||
#define SPC5_LINFLEX1_ERR_NUMBER 101
|
||||
|
||||
#define SPC5_HAS_LINFLEX2 FALSE
|
||||
|
||||
#define SPC5_HAS_LINFLEX3 FALSE
|
||||
|
||||
/* SIUL attributes.*/
|
||||
#define SPC5_HAS_SIUL TRUE
|
||||
#define SPC5_SIUL_NUM_PORTS 8
|
||||
#define SPC5_SIUL_NUM_PCRS 108
|
||||
#define SPC5_SIUL_NUM_PADSELS 36
|
||||
/** @} */
|
||||
|
||||
#endif /* _SPC560P_REGISTRY_H_ */
|
||||
|
||||
/** @} */
|
||||
|
|
@ -0,0 +1,25 @@
|
|||
/*
|
||||
* Licensed under ST Liberty SW License Agreement V2, (the "License");
|
||||
* You may not use this file except in compliance with the License.
|
||||
* You may obtain a copy of the License at:
|
||||
*
|
||||
* http://www.st.com/software_license_agreement_liberty_v2
|
||||
*
|
||||
* Unless required by applicable law or agreed to in writing, software
|
||||
* distributed under the License is distributed on an "AS IS" BASIS,
|
||||
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||
* See the License for the specific language governing permissions and
|
||||
* limitations under the License.
|
||||
*/
|
||||
|
||||
/**
|
||||
* @file SPC56ELxx/typedefs.h
|
||||
* @brief Dummy typedefs file.
|
||||
*/
|
||||
|
||||
#ifndef _TYPEDEFS_H_
|
||||
#define _TYPEDEFS_H_
|
||||
|
||||
#include "chtypes.h"
|
||||
|
||||
#endif /* _TYPEDEFS_H_ */
|
||||
Loading…
Reference in New Issue