]> begriffs open source - cmsis-freertos/blob - Demo/CORTEX_SmartFusion2_M2S050_SoftConsole/RTOSDemo/RunTimeStatsTimer.c
Initial commit
[cmsis-freertos] / Demo / CORTEX_SmartFusion2_M2S050_SoftConsole / RTOSDemo / RunTimeStatsTimer.c
1 /*
2     FreeRTOS V9.0.0 - Copyright (C) 2016 Real Time Engineers Ltd.
3     All rights reserved
4
5     VISIT http://www.FreeRTOS.org TO ENSURE YOU ARE USING THE LATEST VERSION.
6
7     This file is part of the FreeRTOS distribution.
8
9     FreeRTOS is free software; you can redistribute it and/or modify it under
10     the terms of the GNU General Public License (version 2) as published by the
11     Free Software Foundation >>>> AND MODIFIED BY <<<< the FreeRTOS exception.
12
13     ***************************************************************************
14     >>!   NOTE: The modification to the GPL is included to allow you to     !<<
15     >>!   distribute a combined work that includes FreeRTOS without being   !<<
16     >>!   obliged to provide the source code for proprietary components     !<<
17     >>!   outside of the FreeRTOS kernel.                                   !<<
18     ***************************************************************************
19
20     FreeRTOS is distributed in the hope that it will be useful, but WITHOUT ANY
21     WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
22     FOR A PARTICULAR PURPOSE.  Full license text is available on the following
23     link: http://www.freertos.org/a00114.html
24
25     ***************************************************************************
26      *                                                                       *
27      *    FreeRTOS provides completely free yet professionally developed,    *
28      *    robust, strictly quality controlled, supported, and cross          *
29      *    platform software that is more than just the market leader, it     *
30      *    is the industry's de facto standard.                               *
31      *                                                                       *
32      *    Help yourself get started quickly while simultaneously helping     *
33      *    to support the FreeRTOS project by purchasing a FreeRTOS           *
34      *    tutorial book, reference manual, or both:                          *
35      *    http://www.FreeRTOS.org/Documentation                              *
36      *                                                                       *
37     ***************************************************************************
38
39     http://www.FreeRTOS.org/FAQHelp.html - Having a problem?  Start by reading
40     the FAQ page "My application does not run, what could be wrong?".  Have you
41     defined configASSERT()?
42
43     http://www.FreeRTOS.org/support - In return for receiving this top quality
44     embedded software for free we request you assist our global community by
45     participating in the support forum.
46
47     http://www.FreeRTOS.org/training - Investing in training allows your team to
48     be as productive as possible as early as possible.  Now you can receive
49     FreeRTOS training directly from Richard Barry, CEO of Real Time Engineers
50     Ltd, and the world's leading authority on the world's leading RTOS.
51
52     http://www.FreeRTOS.org/plus - A selection of FreeRTOS ecosystem products,
53     including FreeRTOS+Trace - an indispensable productivity tool, a DOS
54     compatible FAT file system, and our tiny thread aware UDP/IP stack.
55
56     http://www.FreeRTOS.org/labs - Where new FreeRTOS products go to incubate.
57     Come and try FreeRTOS+TCP, our new open source TCP/IP stack for FreeRTOS.
58
59     http://www.OpenRTOS.com - Real Time Engineers ltd. license FreeRTOS to High
60     Integrity Systems ltd. to sell under the OpenRTOS brand.  Low cost OpenRTOS
61     licenses offer ticketed support, indemnification and commercial middleware.
62
63     http://www.SafeRTOS.com - High Integrity Systems also provide a safety
64     engineered and independently SIL3 certified version for use in safety and
65     mission critical applications that require provable dependability.
66
67     1 tab == 4 spaces!
68 */
69
70 /* FreeRTOS includes. */
71 #include "FreeRTOS.h"
72
73 /* Utility functions to implement run time stats on Cortex-M CPUs.  The collected
74 run time data can be viewed through the CLI interface.  See the following URL for
75 more information on run time stats:
76 http://www.freertos.org/rtos-run-time-stats.html */
77
78 /* Addresses of registers in the Cortex-M debug hardware. */
79 #define rtsDWT_CYCCNT                   ( *( ( volatile unsigned long * ) 0xE0001004 ) )
80 #define rtsDWT_CONTROL                  ( *( ( volatile unsigned long * ) 0xE0001000 ) )
81 #define rtsSCB_DEMCR                    ( *( ( volatile unsigned long * ) 0xE000EDFC ) )
82 #define rtsTRCENA_BIT                   ( 0x01000000UL )
83 #define rtsCOUNTER_ENABLE_BIT   ( 0x01UL )
84
85 /* Simple shift divide for scaling to avoid an overflow occurring too soon.  The
86 number of bits to shift depends on the clock speed. */
87 #define runtimeSLOWER_CLOCK_SPEEDS      ( 70000000UL )
88 #define runtimeSHIFT_13                         13
89 #define runtimeOVERFLOW_BIT_13          ( 1UL << ( 32UL - runtimeSHIFT_13 ) )
90 #define runtimeSHIFT_14                         14
91 #define runtimeOVERFLOW_BIT_14          ( 1UL << ( 32UL - runtimeSHIFT_14 ) )
92
93 /*-----------------------------------------------------------*/
94
95 void vConfigureTimerForRunTimeStats( void )
96 {
97         /* Enable TRCENA. */
98         rtsSCB_DEMCR = rtsSCB_DEMCR | rtsTRCENA_BIT;
99
100         /* Reset counter. */
101         rtsDWT_CYCCNT = 0;
102
103         /* Enable counter. */
104         rtsDWT_CONTROL = rtsDWT_CONTROL | rtsCOUNTER_ENABLE_BIT;
105 }
106 /*-----------------------------------------------------------*/
107
108 uint32_t ulGetRunTimeCounterValue( void )
109 {
110 static unsigned long ulLastCounterValue = 0UL, ulOverflows = 0;
111 unsigned long ulValueNow;
112
113         ulValueNow = rtsDWT_CYCCNT;
114
115         /* Has the value overflowed since it was last read. */
116         if( ulValueNow < ulLastCounterValue )
117         {
118                 ulOverflows++;
119         }
120         ulLastCounterValue = ulValueNow;
121
122         /* Cannot use configCPU_CLOCK_HZ directly as it may itself not be a constant
123         but instead map to a variable that holds the clock speed. */
124
125         /* There is no prescale on the counter, so simulate in software. */
126         if( configCPU_CLOCK_HZ < runtimeSLOWER_CLOCK_SPEEDS )
127         {
128                 ulValueNow >>= runtimeSHIFT_13;
129                 ulValueNow += ( runtimeOVERFLOW_BIT_13 * ulOverflows );
130         }
131         else
132         {
133                 ulValueNow >>= runtimeSHIFT_14;
134                 ulValueNow += ( runtimeOVERFLOW_BIT_14 * ulOverflows );
135         }
136
137         return ulValueNow;
138 }
139 /*-----------------------------------------------------------*/
140