2016-08-09 01:58:33 +00:00
|
|
|
/* mbed Microcontroller Library
|
|
|
|
* Copyright (c) 2015-2016 Nuvoton
|
|
|
|
*
|
|
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
|
|
* you may not use this file except in compliance with the License.
|
|
|
|
* You may obtain a copy of the License at
|
|
|
|
*
|
|
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
|
|
*
|
|
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
|
|
* See the License for the specific language governing permissions and
|
|
|
|
* limitations under the License.
|
|
|
|
*/
|
2018-01-24 02:07:55 +00:00
|
|
|
|
2016-08-09 01:58:33 +00:00
|
|
|
#include "us_ticker_api.h"
|
|
|
|
#include "sleep_api.h"
|
|
|
|
#include "mbed_assert.h"
|
|
|
|
#include "nu_modutil.h"
|
|
|
|
#include "nu_miscutil.h"
|
|
|
|
|
2018-01-24 02:07:55 +00:00
|
|
|
/* Micro seconds per second */
|
|
|
|
#define NU_US_PER_SEC 1000000
|
|
|
|
/* Timer clock per us_ticker tick */
|
|
|
|
#define NU_TMRCLK_PER_TICK 1
|
|
|
|
/* Timer clock per second */
|
|
|
|
#define NU_TMRCLK_PER_SEC (1000 * 1000)
|
|
|
|
/* Timer max counter bit size */
|
|
|
|
#define NU_TMR_MAXCNT_BITSIZE 24
|
|
|
|
/* Timer max counter */
|
|
|
|
#define NU_TMR_MAXCNT ((1 << NU_TMR_MAXCNT_BITSIZE) - 1)
|
2016-08-09 01:58:33 +00:00
|
|
|
|
|
|
|
static void tmr0_vec(void);
|
2018-01-24 02:07:55 +00:00
|
|
|
|
2018-02-22 06:26:10 +00:00
|
|
|
static const struct nu_modinit_s timer0_modinit = {TIMER_0, TMR0_MODULE, CLK_CLKSEL1_TMR0SEL_PCLK0, 0, TMR0_RST, TMR0_IRQn, (void *) tmr0_vec};
|
|
|
|
|
|
|
|
#define TIMER_MODINIT timer0_modinit
|
2018-01-24 02:07:55 +00:00
|
|
|
|
2018-02-22 06:26:10 +00:00
|
|
|
static int ticker_inited = 0;
|
2016-08-09 01:58:33 +00:00
|
|
|
|
|
|
|
#define TMR_CMP_MIN 2
|
|
|
|
#define TMR_CMP_MAX 0xFFFFFFu
|
|
|
|
|
|
|
|
void us_ticker_init(void)
|
|
|
|
{
|
2018-01-24 02:07:55 +00:00
|
|
|
if (ticker_inited) {
|
2016-08-09 01:58:33 +00:00
|
|
|
return;
|
|
|
|
}
|
2018-01-24 02:07:55 +00:00
|
|
|
ticker_inited = 1;
|
|
|
|
|
2016-08-09 01:58:33 +00:00
|
|
|
// Reset IP
|
2018-02-22 06:26:10 +00:00
|
|
|
SYS_ResetModule(TIMER_MODINIT.rsetidx);
|
2018-01-24 02:07:55 +00:00
|
|
|
|
2016-08-09 01:58:33 +00:00
|
|
|
// Select IP clock source
|
2018-02-22 06:26:10 +00:00
|
|
|
CLK_SetModuleClock(TIMER_MODINIT.clkidx, TIMER_MODINIT.clksrc, TIMER_MODINIT.clkdiv);
|
|
|
|
|
2016-08-09 01:58:33 +00:00
|
|
|
// Enable IP clock
|
2018-02-22 06:26:10 +00:00
|
|
|
CLK_EnableModuleClock(TIMER_MODINIT.clkidx);
|
2016-08-09 01:58:33 +00:00
|
|
|
|
2018-03-26 01:42:53 +00:00
|
|
|
TIMER_T *timer_base = (TIMER_T *) NU_MODBASE(TIMER_MODINIT.modname);
|
|
|
|
|
2016-08-09 01:58:33 +00:00
|
|
|
// Timer for normal counter
|
2018-03-26 01:42:53 +00:00
|
|
|
uint32_t clk_timer = TIMER_GetModuleClock(timer_base);
|
2018-02-22 06:26:10 +00:00
|
|
|
uint32_t prescale_timer = clk_timer / NU_TMRCLK_PER_SEC - 1;
|
|
|
|
MBED_ASSERT((prescale_timer != (uint32_t) -1) && prescale_timer <= 127);
|
|
|
|
MBED_ASSERT((clk_timer % NU_TMRCLK_PER_SEC) == 0);
|
|
|
|
uint32_t cmp_timer = TMR_CMP_MAX;
|
|
|
|
MBED_ASSERT(cmp_timer >= TMR_CMP_MIN && cmp_timer <= TMR_CMP_MAX);
|
2016-08-09 01:58:33 +00:00
|
|
|
// NOTE: TIMER_CTL_CNTDATEN_Msk exists in NUC472, but not in M451. In M451, TIMER_CNT is updated continuously by default.
|
2018-03-26 01:42:53 +00:00
|
|
|
timer_base->CTL = TIMER_CONTINUOUS_MODE | prescale_timer/* | TIMER_CTL_CNTDATEN_Msk*/;
|
|
|
|
timer_base->CMP = cmp_timer;
|
2018-01-24 02:07:55 +00:00
|
|
|
|
2018-02-22 06:26:10 +00:00
|
|
|
NVIC_SetVector(TIMER_MODINIT.irq_n, (uint32_t) TIMER_MODINIT.var);
|
2018-01-24 02:07:55 +00:00
|
|
|
|
2018-02-22 06:26:10 +00:00
|
|
|
NVIC_EnableIRQ(TIMER_MODINIT.irq_n);
|
2018-01-24 02:07:55 +00:00
|
|
|
|
2018-03-26 01:42:53 +00:00
|
|
|
TIMER_EnableInt(timer_base);
|
|
|
|
|
|
|
|
TIMER_Start(timer_base);
|
|
|
|
/* Wait for timer to start counting and raise active flag */
|
|
|
|
while(! (timer_base->CTL & TIMER_CTL_ACTSTS_Msk));
|
2016-08-09 01:58:33 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
uint32_t us_ticker_read()
|
|
|
|
{
|
2018-01-24 02:07:55 +00:00
|
|
|
if (! ticker_inited) {
|
2016-08-09 01:58:33 +00:00
|
|
|
us_ticker_init();
|
|
|
|
}
|
2018-01-24 02:07:55 +00:00
|
|
|
|
2018-03-26 01:42:53 +00:00
|
|
|
TIMER_T *timer_base = (TIMER_T *) NU_MODBASE(TIMER_MODINIT.modname);
|
2018-01-24 02:07:55 +00:00
|
|
|
|
2018-02-22 06:26:10 +00:00
|
|
|
return (TIMER_GetCounter(timer_base) / NU_TMRCLK_PER_TICK);
|
2018-01-24 02:07:55 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
void us_ticker_set_interrupt(timestamp_t timestamp)
|
|
|
|
{
|
2018-02-22 06:26:10 +00:00
|
|
|
/* In continuous mode, counter will be reset to zero with the following sequence:
|
|
|
|
* 1. Stop counting
|
|
|
|
* 2. Configure new CMP value
|
|
|
|
* 3. Restart counting
|
2018-01-24 02:07:55 +00:00
|
|
|
*
|
2018-02-22 06:26:10 +00:00
|
|
|
* This behavior is not what we want. To fix it, we could configure new CMP value
|
|
|
|
* without stopping counting first.
|
2018-01-24 02:07:55 +00:00
|
|
|
*/
|
2018-03-26 01:42:53 +00:00
|
|
|
TIMER_T *timer_base = (TIMER_T *) NU_MODBASE(TIMER_MODINIT.modname);
|
2018-01-24 02:07:55 +00:00
|
|
|
|
2018-02-22 06:26:10 +00:00
|
|
|
/* NOTE: Because H/W timer requests min compare value, our implementation would have alarm delay of
|
|
|
|
* (TMR_CMP_MIN - interval_clk) clocks when interval_clk is between [1, TMR_CMP_MIN). */
|
|
|
|
uint32_t cmp_timer = timestamp * NU_TMRCLK_PER_TICK;
|
|
|
|
cmp_timer = NU_CLAMP(cmp_timer, TMR_CMP_MIN, TMR_CMP_MAX);
|
|
|
|
timer_base->CMP = cmp_timer;
|
2016-08-09 01:58:33 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
void us_ticker_disable_interrupt(void)
|
|
|
|
{
|
2018-02-22 06:26:10 +00:00
|
|
|
TIMER_DisableInt((TIMER_T *) NU_MODBASE(TIMER_MODINIT.modname));
|
2016-08-09 01:58:33 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
void us_ticker_clear_interrupt(void)
|
|
|
|
{
|
2018-02-22 06:26:10 +00:00
|
|
|
TIMER_ClearIntFlag((TIMER_T *) NU_MODBASE(TIMER_MODINIT.modname));
|
2016-08-09 01:58:33 +00:00
|
|
|
}
|
|
|
|
|
Ticker: add fire interrupt now function
fire_interrupt function should be used for events in the past. As we have now
64bit timestamp, we can figure out what is in the past, and ask a target to invoke
an interrupt immediately. The previous attemps in the target HAL tickers were not ideal, as it can wrap around easily (16 or 32 bit counters). This new
functionality should solve this problem.
set_interrupt for tickers in HAL code should not handle anything but the next match interrupt. If it was in the past is handled by the upper layer.
It is possible that we are setting next event to the close future, so once it is set it is already in the past. Therefore we add a check after set interrupt to verify it is in future.
If it is not, we fire interrupt immediately. This results in
two events - first one immediate, correct one. The second one might be scheduled in far future (almost entire ticker range),
that should be discarded.
The specification for the fire_interrupts are:
- should set pending bit for the ticker interrupt (as soon as possible),
the event we are scheduling is already in the past, and we do not want to skip
any events
- no arguments are provided, neither return value, not needed
- ticker should be initialized prior calling this function (no need to check if it is already initialized)
All our targets provide this new functionality, removing old misleading if (timestamp is in the past) checks.
2017-06-27 11:18:59 +00:00
|
|
|
void us_ticker_fire_interrupt(void)
|
|
|
|
{
|
2018-01-24 02:07:55 +00:00
|
|
|
// NOTE: This event was in the past. Set the interrupt as pending, but don't process it here.
|
|
|
|
// This prevents a recursive loop under heavy load which can lead to a stack overflow.
|
2018-02-22 06:26:10 +00:00
|
|
|
NVIC_SetPendingIRQ(TIMER_MODINIT.irq_n);
|
2016-08-09 01:58:33 +00:00
|
|
|
}
|
2018-01-24 02:07:55 +00:00
|
|
|
|
|
|
|
const ticker_info_t* us_ticker_get_info()
|
|
|
|
{
|
|
|
|
static const ticker_info_t info = {
|
|
|
|
NU_TMRCLK_PER_SEC / NU_TMRCLK_PER_TICK,
|
|
|
|
NU_TMR_MAXCNT_BITSIZE
|
|
|
|
};
|
|
|
|
return &info;
|
|
|
|
}
|
2018-02-22 06:26:10 +00:00
|
|
|
|
|
|
|
static void tmr0_vec(void)
|
|
|
|
{
|
|
|
|
TIMER_ClearIntFlag((TIMER_T *) NU_MODBASE(TIMER_MODINIT.modname));
|
|
|
|
|
|
|
|
// NOTE: us_ticker_set_interrupt() may get called in us_ticker_irq_handler();
|
|
|
|
us_ticker_irq_handler();
|
|
|
|
}
|