mirror of https://github.com/ARMmbed/mbed-os.git
63 lines
1.3 KiB
C++
63 lines
1.3 KiB
C++
/*
|
|
* Copyright (c) 2016 ARM Limited, All Rights Reserved
|
|
*/
|
|
|
|
// Include before mbed.h to properly get UINT*_C()
|
|
#include "ns_types.h"
|
|
|
|
#include "mbed.h"
|
|
#include "platform/arm_hal_timer.h"
|
|
#include "platform/arm_hal_interrupt.h"
|
|
#include <mbed_assert.h>
|
|
|
|
static Timer timer;
|
|
static Timeout timeout;
|
|
static EventQueue *equeue;
|
|
static uint32_t due;
|
|
static void (*arm_hal_callback)(void);
|
|
|
|
// Called once at boot
|
|
void platform_timer_enable(void)
|
|
{
|
|
equeue = mbed_highprio_event_queue();
|
|
MBED_ASSERT(equeue != NULL);
|
|
}
|
|
|
|
// Actually cancels a timer, not the opposite of enable
|
|
void platform_timer_disable(void)
|
|
{
|
|
timeout.detach();
|
|
}
|
|
|
|
// Not called while running, fortunately
|
|
void platform_timer_set_cb(void (*new_fp)(void))
|
|
{
|
|
arm_hal_callback = new_fp;
|
|
}
|
|
|
|
static void timer_callback(void)
|
|
{
|
|
due = 0;
|
|
equeue->call(arm_hal_callback);
|
|
}
|
|
|
|
// This is called from inside platform_enter_critical - IRQs can't happen
|
|
void platform_timer_start(uint16_t slots)
|
|
{
|
|
timer.reset();
|
|
due = slots * UINT32_C(50);
|
|
timeout.attach_us(timer_callback, due);
|
|
}
|
|
|
|
// This is called from inside platform_enter_critical - IRQs can't happen
|
|
uint16_t platform_timer_get_remaining_slots(void)
|
|
{
|
|
uint32_t elapsed = timer.read_us();
|
|
if (elapsed < due) {
|
|
return (uint16_t) ((due - elapsed) / 50);
|
|
} else {
|
|
return 0;
|
|
}
|
|
}
|
|
|