bsp_trace.c

Go to the documentation of this file.
00001 /**************************************************************************/
00018 #include <stdbool.h>
00019 #include "em_device.h"
00020 #include "em_gpio.h"
00021 #include "em_cmu.h"
00022 #include "bsp_trace.h"
00023 #include "bsp.h"
00024 
00025 #if defined( BSP_ETM_TRACE ) && defined( ETM_PRESENT )
00026 /**************************************************************************/
00030 void BSP_TraceEtmSetup(void)
00031 {
00032   /* Enable peripheral clocks */
00033   CMU->HFCORECLKEN0 |= CMU_HFCORECLKEN0_LE;
00034   CMU->HFPERCLKEN0  |= CMU_HFPERCLKEN0_GPIO;
00035   CMU->OSCENCMD      = CMU_OSCENCMD_AUXHFRCOEN;
00036 
00037   /* Wait until AUXHFRCO clock is ready */
00038   while (!(CMU->STATUS & CMU_STATUS_AUXHFRCORDY)) ;
00039 
00040   /* Enable Port D, pins 3,4,5,6 for ETM Trace Data output */
00041   GPIO->P[3].MODEL = (GPIO->P[3].MODEL & ~_GPIO_P_MODEL_MODE3_MASK) | GPIO_P_MODEL_MODE3_PUSHPULL;
00042   GPIO->P[3].MODEL = (GPIO->P[3].MODEL & ~_GPIO_P_MODEL_MODE4_MASK) | GPIO_P_MODEL_MODE4_PUSHPULL;
00043   GPIO->P[3].MODEL = (GPIO->P[3].MODEL & ~_GPIO_P_MODEL_MODE5_MASK) | GPIO_P_MODEL_MODE5_PUSHPULL;
00044   GPIO->P[3].MODEL = (GPIO->P[3].MODEL & ~_GPIO_P_MODEL_MODE6_MASK) | GPIO_P_MODEL_MODE6_PUSHPULL;
00045 
00046   /* Enable Port D, pin 7 for DBG_TCLK */
00047   GPIO->P[3].MODEL = (GPIO->P[3].MODEL & ~_GPIO_P_MODEL_MODE7_MASK) | GPIO_P_MODEL_MODE7_PUSHPULL;
00048 
00049   /* Configure trace output for alternate location */
00050   GPIO->ROUTE = GPIO->ROUTE | GPIO_ROUTE_TCLKPEN | GPIO_ROUTE_TD0PEN | GPIO_ROUTE_TD1PEN
00051                 | GPIO_ROUTE_TD2PEN | GPIO_ROUTE_TD3PEN
00052                 | GPIO_ROUTE_ETMLOCATION_LOC0;
00053 }
00054 #endif
00055 
00056 #if defined( _GPIO_ROUTE_SWOPEN_MASK ) || defined( _GPIO_ROUTEPEN_SWVPEN_MASK )
00057 /**************************************************************************/
00063 void BSP_TraceSwoSetup(void)
00064 {
00065   /* Enable GPIO clock */
00066 #if defined( _CMU_HFPERCLKEN0_GPIO_MASK )
00067   CMU->HFPERCLKEN0 |= CMU_HFPERCLKEN0_GPIO;
00068 #elif defined( _CMU_HFBUSCLKEN0_GPIO_MASK )
00069   CMU->HFBUSCLKEN0 |= CMU_HFBUSCLKEN0_GPIO;
00070 #endif
00071 
00072   /* Enable Serial wire output pin */
00073 #if defined( _GPIO_ROUTE_SWOPEN_MASK )
00074   GPIO->ROUTE |= GPIO_ROUTE_SWOPEN;
00075 #elif defined( _GPIO_ROUTEPEN_SWVPEN_MASK )
00076   GPIO->ROUTEPEN |= GPIO_ROUTEPEN_SWVPEN;
00077 #endif
00078 
00079   /* Set correct location */
00080 #if defined( _GPIO_ROUTE_SWOPEN_MASK )
00081   GPIO->ROUTE = (GPIO->ROUTE & ~(_GPIO_ROUTE_SWLOCATION_MASK)) | BSP_TRACE_SWO_LOCATION;
00082 #elif defined( _GPIO_ROUTEPEN_SWVPEN_MASK )
00083   GPIO->ROUTELOC0 = (GPIO->ROUTELOC0 & ~(_GPIO_ROUTELOC0_SWVLOC_MASK)) | BSP_TRACE_SWO_LOCATION;
00084 #endif
00085 
00086   /* Enable output on correct pin. */
00087   TRACE_ENABLE_PINS();
00088 
00089   /* Enable debug clock AUXHFRCO */
00090   CMU->OSCENCMD = CMU_OSCENCMD_AUXHFRCOEN;
00091 
00092   /* Wait until clock is ready */
00093   while (!(CMU->STATUS & CMU_STATUS_AUXHFRCORDY)) ;
00094 
00095   /* Enable trace in core debug */
00096   CoreDebug->DHCSR |= CoreDebug_DHCSR_C_DEBUGEN_Msk;
00097   CoreDebug->DEMCR |= CoreDebug_DEMCR_TRCENA_Msk;
00098 
00099   /* Enable PC and IRQ sampling output */
00100   DWT->CTRL = 0x400113FF;
00101 
00102   /* Set TPIU prescaler to 16. */
00103   TPI->ACPR = 15;
00104 
00105   /* Set protocol to NRZ */
00106   TPI->SPPR = 2;
00107 
00108   /* Disable continuous formatting */
00109   TPI->FFCR = 0x100;
00110 
00111   /* Unlock ITM and output data */
00112   ITM->LAR = 0xC5ACCE55;
00113   ITM->TCR = 0x10009;
00114 
00115   /* ITM Channel 0 is used for UART output */
00116   ITM->TER |= (1UL << 0);
00117 }
00118 #endif
00119 
00120 
00121 #if defined( _GPIO_ROUTE_SWOPEN_MASK ) || defined( _GPIO_ROUTEPEN_SWVPEN_MASK )
00122 /**************************************************************************/
00128 bool BSP_TraceProfilerSetup(void)
00129 {
00130   volatile uint32_t *userData = (uint32_t *) USER_PAGE;
00131 
00132   /* Check magic "trace" word in user page */
00133   if (*userData == 0x00000000UL)
00134   {
00135     return false;
00136   }
00137   else
00138   {
00139     BSP_TraceSwoSetup();
00140     return true;
00141   }
00142 }
00143 #endif