Rizky Ardi Maulana / mbed-os
Committer:
calmantara186
Date:
Thu Feb 22 14:05:19 2018 +0000
Revision:
1:2b6e8130a0ac
Parent:
0:f269e3021894
mbed os

Who changed what in which revision?

UserRevisionLine numberNew contents of line
elessair 0:f269e3021894 1 /*
elessair 0:f269e3021894 2 * Copyright (c) 2016 ARM Limited, All Rights Reserved
elessair 0:f269e3021894 3 */
elessair 0:f269e3021894 4
elessair 0:f269e3021894 5 // Include before mbed.h to properly get UINT*_C()
elessair 0:f269e3021894 6 #include "ns_types.h"
elessair 0:f269e3021894 7
elessair 0:f269e3021894 8 #include "cmsis_os.h"
elessair 0:f269e3021894 9 #include "mbed.h"
elessair 0:f269e3021894 10
elessair 0:f269e3021894 11 #include "platform/arm_hal_timer.h"
elessair 0:f269e3021894 12 #include "platform/arm_hal_interrupt.h"
elessair 0:f269e3021894 13
elessair 0:f269e3021894 14 static osThreadId timer_thread_id;
elessair 0:f269e3021894 15
elessair 0:f269e3021894 16 static Timer timer;
elessair 0:f269e3021894 17 static Timeout timeout;
elessair 0:f269e3021894 18 static uint32_t due;
elessair 0:f269e3021894 19 static void (*arm_hal_callback)(void);
elessair 0:f269e3021894 20
elessair 0:f269e3021894 21 static void timer_thread(const void *)
elessair 0:f269e3021894 22 {
elessair 0:f269e3021894 23 for (;;) {
elessair 0:f269e3021894 24 osSignalWait(1, osWaitForever);
elessair 0:f269e3021894 25 // !!! We don't do our own enter/exit critical - we rely on callback
elessair 0:f269e3021894 26 // doing it (ns_timer_interrupt_handler does)
elessair 0:f269e3021894 27 //platform_enter_critical();
elessair 0:f269e3021894 28 arm_hal_callback();
elessair 0:f269e3021894 29 //platform_exit_critical();
elessair 0:f269e3021894 30 }
elessair 0:f269e3021894 31 }
elessair 0:f269e3021894 32
elessair 0:f269e3021894 33 // Called once at boot
elessair 0:f269e3021894 34 void platform_timer_enable(void)
elessair 0:f269e3021894 35 {
elessair 0:f269e3021894 36 static osThreadDef(timer_thread, osPriorityRealtime, /*1,*/ 2*1024);
elessair 0:f269e3021894 37 timer_thread_id = osThreadCreate(osThread(timer_thread), NULL);
elessair 0:f269e3021894 38 timer.start();
elessair 0:f269e3021894 39 }
elessair 0:f269e3021894 40
elessair 0:f269e3021894 41 // Actually cancels a timer, not the opposite of enable
elessair 0:f269e3021894 42 void platform_timer_disable(void)
elessair 0:f269e3021894 43 {
elessair 0:f269e3021894 44 timeout.detach();
elessair 0:f269e3021894 45 }
elessair 0:f269e3021894 46
elessair 0:f269e3021894 47 // Not called while running, fortunately
elessair 0:f269e3021894 48 void platform_timer_set_cb(void (*new_fp)(void))
elessair 0:f269e3021894 49 {
elessair 0:f269e3021894 50 arm_hal_callback = new_fp;
elessair 0:f269e3021894 51 }
elessair 0:f269e3021894 52
elessair 0:f269e3021894 53 static void timer_callback(void)
elessair 0:f269e3021894 54 {
elessair 0:f269e3021894 55 due = 0;
elessair 0:f269e3021894 56 osSignalSet(timer_thread_id, 1);
elessair 0:f269e3021894 57 //callback();
elessair 0:f269e3021894 58 }
elessair 0:f269e3021894 59
elessair 0:f269e3021894 60 // This is called from inside platform_enter_critical - IRQs can't happen
elessair 0:f269e3021894 61 void platform_timer_start(uint16_t slots)
elessair 0:f269e3021894 62 {
elessair 0:f269e3021894 63 timer.reset();
elessair 0:f269e3021894 64 due = slots * UINT32_C(50);
elessair 0:f269e3021894 65 timeout.attach_us(timer_callback, due);
elessair 0:f269e3021894 66 }
elessair 0:f269e3021894 67
elessair 0:f269e3021894 68 // This is called from inside platform_enter_critical - IRQs can't happen
elessair 0:f269e3021894 69 uint16_t platform_timer_get_remaining_slots(void)
elessair 0:f269e3021894 70 {
elessair 0:f269e3021894 71 uint32_t elapsed = timer.read_us();
elessair 0:f269e3021894 72 if (elapsed < due) {
elessair 0:f269e3021894 73 return (uint16_t) ((due - elapsed) / 50);
elessair 0:f269e3021894 74 } else {
elessair 0:f269e3021894 75 return 0;
elessair 0:f269e3021894 76 }
elessair 0:f269e3021894 77 }
elessair 0:f269e3021894 78