First version
[3rdparty/ote_partner/tlk.git] / arch / arm / arm-m / systick.c
1 /*
2  * Copyright (c) 2012 Travis Geiselbrecht
3  *
4  * Permission is hereby granted, free of charge, to any person obtaining
5  * a copy of this software and associated documentation files
6  * (the "Software"), to deal in the Software without restriction,
7  * including without limitation the rights to use, copy, modify, merge,
8  * publish, distribute, sublicense, and/or sell copies of the Software,
9  * and to permit persons to whom the Software is furnished to do so,
10  * subject to the following conditions:
11  *
12  * The above copyright notice and this permission notice shall be
13  * included in all copies or substantial portions of the Software.
14  *
15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
16  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
17  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
18  * IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
19  * CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
20  * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
21  * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
22  */
23 #include <sys/types.h>
24 #include <string.h>
25 #include <stdlib.h>
26 #include <debug.h>
27 #include <kernel/thread.h>
28 #include <arch/arm.h>
29 #include <arch/arm/cm3.h>
30
31 #define LOCAL_TRACE 0
32
33 void cm3_systick_init(void)
34 {
35         NVIC_SetPriority(SysTick_IRQn, cm3_medium_priority());
36 }
37
38 void cm3_systick_set_periodic(uint32_t systick_clk_freq, lk_time_t period)
39 {
40         LTRACEF("clk_freq %u, period %u\n", systick_clk_freq, (uint)period);
41
42         uint32_t ticks = systick_clk_freq / (1000 / period);
43         LTRACEF("ticks %d\n", ticks);
44
45         SysTick->LOAD = (ticks & SysTick_LOAD_RELOAD_Msk) - 1;
46         SysTick->VAL = 0;
47         SysTick->CTRL = SysTick_CTRL_CLKSOURCE_Msk | SysTick_CTRL_TICKINT_Msk | SysTick_CTRL_ENABLE_Msk;
48 }
49
50 void cm3_systick_cancel_periodic(void)
51 {
52         SysTick->CTRL &= ~SysTick_CTRL_ENABLE_Msk;
53 }
54