661 lines
18 KiB
C
661 lines
18 KiB
C
|
/******************************************************************************
|
||
|
The MIT License(MIT)
|
||
|
|
||
|
Embedded Template Library.
|
||
|
https://github.com/ETLCPP/etl
|
||
|
https://www.etlcpp.com
|
||
|
|
||
|
Copyright(c) 2022 John Wellbelove
|
||
|
|
||
|
Permission is hereby granted, free of charge, to any person obtaining a copy
|
||
|
of this software and associated documentation files(the "Software"), to deal
|
||
|
in the Software without restriction, including without limitation the rights
|
||
|
to use, copy, modify, merge, publish, distribute, sublicense, and / or sell
|
||
|
copies of the Software, and to permit persons to whom the Software is
|
||
|
furnished to do so, subject to the following conditions :
|
||
|
|
||
|
The above copyright notice and this permission notice shall be included in all
|
||
|
copies or substantial portions of the Software.
|
||
|
|
||
|
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
||
|
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
||
|
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.IN NO EVENT SHALL THE
|
||
|
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
||
|
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
||
|
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
||
|
SOFTWARE.
|
||
|
******************************************************************************/
|
||
|
|
||
|
#ifndef ETL_MESSAGE_TIMER_INTERRUPT_INCLUDED
|
||
|
#define ETL_MESSAGE_TIMER_INTERRUPT_INCLUDED
|
||
|
|
||
|
#include "platform.h"
|
||
|
#include "nullptr.h"
|
||
|
#include "message_types.h"
|
||
|
#include "message.h"
|
||
|
#include "message_router.h"
|
||
|
#include "message_bus.h"
|
||
|
#include "static_assert.h"
|
||
|
#include "timer.h"
|
||
|
#include "delegate.h"
|
||
|
#include "algorithm.h"
|
||
|
|
||
|
#include <stdint.h>
|
||
|
|
||
|
namespace etl
|
||
|
{
|
||
|
//***************************************************************************
|
||
|
/// Interface for message timer
|
||
|
//***************************************************************************
|
||
|
template <typename TInterruptGuard>
|
||
|
class imessage_timer_interrupt
|
||
|
{
|
||
|
public:
|
||
|
|
||
|
typedef etl::delegate<void(void)> callback_type;
|
||
|
|
||
|
public:
|
||
|
|
||
|
//*******************************************
|
||
|
/// Register a timer.
|
||
|
//*******************************************
|
||
|
etl::timer::id::type register_timer(const etl::imessage& message_,
|
||
|
etl::imessage_router& router_,
|
||
|
uint32_t period_,
|
||
|
bool repeating_,
|
||
|
etl::message_router_id_t destination_router_id_ = etl::imessage_router::ALL_MESSAGE_ROUTERS)
|
||
|
{
|
||
|
etl::timer::id::type id = etl::timer::id::NO_TIMER;
|
||
|
|
||
|
bool is_space = (number_of_registered_timers < MAX_TIMERS);
|
||
|
|
||
|
if (is_space)
|
||
|
{
|
||
|
// There's no point adding null message routers.
|
||
|
if (!router_.is_null_router())
|
||
|
{
|
||
|
// Search for the free space.
|
||
|
for (uint_least8_t i = 0U; i < MAX_TIMERS; ++i)
|
||
|
{
|
||
|
timer_data& timer = timer_array[i];
|
||
|
|
||
|
if (timer.id == etl::timer::id::NO_TIMER)
|
||
|
{
|
||
|
TInterruptGuard guard;
|
||
|
(void)guard; // Silence 'unused variable warnings.
|
||
|
|
||
|
// Create in-place.
|
||
|
new (&timer) timer_data(i, message_, router_, period_, repeating_, destination_router_id_);
|
||
|
++number_of_registered_timers;
|
||
|
id = i;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return id;
|
||
|
}
|
||
|
|
||
|
//*******************************************
|
||
|
/// Unregister a timer.
|
||
|
//*******************************************
|
||
|
bool unregister_timer(etl::timer::id::type id_)
|
||
|
{
|
||
|
bool result = false;
|
||
|
|
||
|
if (id_ != etl::timer::id::NO_TIMER)
|
||
|
{
|
||
|
timer_data& timer = timer_array[id_];
|
||
|
|
||
|
if (timer.id != etl::timer::id::NO_TIMER)
|
||
|
{
|
||
|
if (timer.is_active())
|
||
|
{
|
||
|
TInterruptGuard guard;
|
||
|
(void)guard; // Silence 'unused variable warnings.
|
||
|
|
||
|
active_list.remove(timer.id, true);
|
||
|
}
|
||
|
|
||
|
// Reset in-place.
|
||
|
new (&timer) timer_data();
|
||
|
--number_of_registered_timers;
|
||
|
|
||
|
result = true;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return result;
|
||
|
}
|
||
|
|
||
|
//*******************************************
|
||
|
/// Enable/disable the timer.
|
||
|
//*******************************************
|
||
|
void enable(bool state_)
|
||
|
{
|
||
|
enabled = state_;
|
||
|
}
|
||
|
|
||
|
//*******************************************
|
||
|
/// Get the enable/disable state.
|
||
|
//*******************************************
|
||
|
bool is_running() const
|
||
|
{
|
||
|
return enabled;
|
||
|
}
|
||
|
|
||
|
//*******************************************
|
||
|
/// Clears the timer of data.
|
||
|
//*******************************************
|
||
|
void clear()
|
||
|
{
|
||
|
{
|
||
|
TInterruptGuard guard;
|
||
|
(void)guard; // Silence 'unused variable warnings.
|
||
|
|
||
|
active_list.clear();
|
||
|
}
|
||
|
|
||
|
for (int i = 0; i < MAX_TIMERS; ++i)
|
||
|
{
|
||
|
new (&timer_array[i]) timer_data();
|
||
|
}
|
||
|
|
||
|
number_of_registered_timers = 0U;
|
||
|
}
|
||
|
|
||
|
//*******************************************
|
||
|
// Called by the timer service to indicate the
|
||
|
// amount of time that has elapsed since the last successful call to 'tick'.
|
||
|
// Returns true if the tick was processed,
|
||
|
// false if not.
|
||
|
//*******************************************
|
||
|
bool tick(uint32_t count)
|
||
|
{
|
||
|
if (enabled)
|
||
|
{
|
||
|
// We have something to do?
|
||
|
bool has_active = !active_list.empty();
|
||
|
|
||
|
if (has_active)
|
||
|
{
|
||
|
while (has_active && (count >= active_list.front().delta))
|
||
|
{
|
||
|
timer_data& timer = active_list.front();
|
||
|
|
||
|
count -= timer.delta;
|
||
|
|
||
|
active_list.remove(timer.id, true);
|
||
|
|
||
|
if (timer.p_router != ETL_NULLPTR)
|
||
|
{
|
||
|
timer.p_router->receive(timer.destination_router_id, *(timer.p_message));
|
||
|
}
|
||
|
|
||
|
if (timer.repeating)
|
||
|
{
|
||
|
// Reinsert the timer.
|
||
|
timer.delta = timer.period;
|
||
|
active_list.insert(timer.id);
|
||
|
}
|
||
|
|
||
|
has_active = !active_list.empty();
|
||
|
}
|
||
|
|
||
|
if (has_active)
|
||
|
{
|
||
|
// Subtract any remainder from the next due timeout.
|
||
|
active_list.front().delta -= count;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return true;
|
||
|
}
|
||
|
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
//*******************************************
|
||
|
/// Starts a timer.
|
||
|
//*******************************************
|
||
|
bool start(etl::timer::id::type id_, bool immediate_ = false)
|
||
|
{
|
||
|
bool result = false;
|
||
|
|
||
|
// Valid timer id?
|
||
|
if (id_ != etl::timer::id::NO_TIMER)
|
||
|
{
|
||
|
timer_data& timer = timer_array[id_];
|
||
|
|
||
|
// Registered timer?
|
||
|
if (timer.id != etl::timer::id::NO_TIMER)
|
||
|
{
|
||
|
// Has a valid period.
|
||
|
if (timer.period != etl::timer::state::Inactive)
|
||
|
{
|
||
|
TInterruptGuard guard;
|
||
|
(void)guard; // Silence 'unused variable warnings.
|
||
|
|
||
|
if (timer.is_active())
|
||
|
{
|
||
|
active_list.remove(timer.id, false);
|
||
|
}
|
||
|
|
||
|
timer.delta = immediate_ ? 0 : timer.period;
|
||
|
active_list.insert(timer.id);
|
||
|
|
||
|
result = true;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return result;
|
||
|
}
|
||
|
|
||
|
//*******************************************
|
||
|
/// Stops a timer.
|
||
|
//*******************************************
|
||
|
bool stop(etl::timer::id::type id_)
|
||
|
{
|
||
|
bool result = false;
|
||
|
|
||
|
// Valid timer id?
|
||
|
if (id_ != etl::timer::id::NO_TIMER)
|
||
|
{
|
||
|
timer_data& timer = timer_array[id_];
|
||
|
|
||
|
// Registered timer?
|
||
|
if (timer.id != etl::timer::id::NO_TIMER)
|
||
|
{
|
||
|
if (timer.is_active())
|
||
|
{
|
||
|
TInterruptGuard guard;
|
||
|
(void)guard; // Silence 'unused variable warnings.
|
||
|
|
||
|
active_list.remove(timer.id, false);
|
||
|
}
|
||
|
|
||
|
result = true;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return result;
|
||
|
}
|
||
|
|
||
|
//*******************************************
|
||
|
/// Sets a timer's period.
|
||
|
//*******************************************
|
||
|
bool set_period(etl::timer::id::type id_, uint32_t period_)
|
||
|
{
|
||
|
if (stop(id_))
|
||
|
{
|
||
|
timer_array[id_].period = period_;
|
||
|
return true;
|
||
|
}
|
||
|
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
//*******************************************
|
||
|
/// Sets a timer's mode.
|
||
|
//*******************************************
|
||
|
bool set_mode(etl::timer::id::type id_, bool repeating_)
|
||
|
{
|
||
|
if (stop(id_))
|
||
|
{
|
||
|
timer_array[id_].repeating = repeating_;
|
||
|
return true;
|
||
|
}
|
||
|
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
//*******************************************
|
||
|
/// Check if there is an active timer.
|
||
|
//*******************************************
|
||
|
bool has_active_timer() const
|
||
|
{
|
||
|
TInterruptGuard guard;
|
||
|
(void)guard; // Silence 'unused variable warnings.
|
||
|
return !active_list.empty();
|
||
|
}
|
||
|
|
||
|
//*******************************************
|
||
|
/// Get the time to the next timer event.
|
||
|
/// Returns etl::timer::interval::No_Active_Interval if there is no active timer.
|
||
|
//*******************************************
|
||
|
uint32_t time_to_next() const
|
||
|
{
|
||
|
uint32_t delta = static_cast<uint32_t>(etl::timer::interval::No_Active_Interval);
|
||
|
|
||
|
TInterruptGuard guard;
|
||
|
(void)guard; // Silence 'unused variable warnings.
|
||
|
|
||
|
if (!active_list.empty())
|
||
|
{
|
||
|
delta = active_list.front().delta;
|
||
|
}
|
||
|
|
||
|
return delta;
|
||
|
}
|
||
|
|
||
|
protected:
|
||
|
|
||
|
//*************************************************************************
|
||
|
/// The configuration of a timer.
|
||
|
struct timer_data
|
||
|
{
|
||
|
//*******************************************
|
||
|
timer_data()
|
||
|
: p_message(ETL_NULLPTR)
|
||
|
, p_router(ETL_NULLPTR)
|
||
|
, period(0)
|
||
|
, delta(etl::timer::state::Inactive)
|
||
|
, destination_router_id(etl::imessage_bus::ALL_MESSAGE_ROUTERS)
|
||
|
, id(etl::timer::id::NO_TIMER)
|
||
|
, previous(etl::timer::id::NO_TIMER)
|
||
|
, next(etl::timer::id::NO_TIMER)
|
||
|
, repeating(true)
|
||
|
{
|
||
|
}
|
||
|
|
||
|
//*******************************************
|
||
|
timer_data(etl::timer::id::type id_,
|
||
|
const etl::imessage& message_,
|
||
|
etl::imessage_router& irouter_,
|
||
|
uint32_t period_,
|
||
|
bool repeating_,
|
||
|
etl::message_router_id_t destination_router_id_ = etl::imessage_bus::ALL_MESSAGE_ROUTERS)
|
||
|
: p_message(&message_)
|
||
|
, p_router(&irouter_)
|
||
|
, period(period_)
|
||
|
, delta(etl::timer::state::Inactive)
|
||
|
, destination_router_id(destination_router_id_)
|
||
|
, id(id_)
|
||
|
, previous(etl::timer::id::NO_TIMER)
|
||
|
, next(etl::timer::id::NO_TIMER)
|
||
|
, repeating(repeating_)
|
||
|
{
|
||
|
}
|
||
|
|
||
|
//*******************************************
|
||
|
/// Returns true if the timer is active.
|
||
|
//*******************************************
|
||
|
bool is_active() const
|
||
|
{
|
||
|
return delta != etl::timer::state::Inactive;
|
||
|
}
|
||
|
|
||
|
//*******************************************
|
||
|
/// Sets the timer to the inactive state.
|
||
|
//*******************************************
|
||
|
void set_inactive()
|
||
|
{
|
||
|
delta = etl::timer::state::Inactive;
|
||
|
}
|
||
|
|
||
|
const etl::imessage* p_message;
|
||
|
etl::imessage_router* p_router;
|
||
|
uint32_t period;
|
||
|
uint32_t delta;
|
||
|
etl::message_router_id_t destination_router_id;
|
||
|
etl::timer::id::type id;
|
||
|
uint_least8_t previous;
|
||
|
uint_least8_t next;
|
||
|
bool repeating;
|
||
|
|
||
|
private:
|
||
|
|
||
|
// Disabled.
|
||
|
timer_data(const timer_data& other);
|
||
|
timer_data& operator =(const timer_data& other);
|
||
|
};
|
||
|
|
||
|
//*******************************************
|
||
|
/// Constructor.
|
||
|
//*******************************************
|
||
|
imessage_timer_interrupt(timer_data* const timer_array_, const uint_least8_t MAX_TIMERS_)
|
||
|
: timer_array(timer_array_)
|
||
|
, active_list(timer_array_)
|
||
|
, enabled(false)
|
||
|
, number_of_registered_timers(0U)
|
||
|
, MAX_TIMERS(MAX_TIMERS_)
|
||
|
{
|
||
|
}
|
||
|
|
||
|
//*******************************************
|
||
|
/// Destructor.
|
||
|
//*******************************************
|
||
|
~imessage_timer_interrupt()
|
||
|
{
|
||
|
}
|
||
|
|
||
|
private:
|
||
|
|
||
|
//*************************************************************************
|
||
|
/// A specialised intrusive linked list for timer data.
|
||
|
//*************************************************************************
|
||
|
class timer_list
|
||
|
{
|
||
|
public:
|
||
|
|
||
|
//*******************************
|
||
|
timer_list(timer_data* ptimers_)
|
||
|
: head(etl::timer::id::NO_TIMER)
|
||
|
, tail(etl::timer::id::NO_TIMER)
|
||
|
, current(etl::timer::id::NO_TIMER)
|
||
|
, ptimers(ptimers_)
|
||
|
{
|
||
|
}
|
||
|
|
||
|
//*******************************
|
||
|
bool empty() const
|
||
|
{
|
||
|
return head == etl::timer::id::NO_TIMER;
|
||
|
}
|
||
|
|
||
|
//*******************************
|
||
|
// Inserts the timer at the correct delta position
|
||
|
//*******************************
|
||
|
void insert(etl::timer::id::type id_)
|
||
|
{
|
||
|
timer_data& timer = ptimers[id_];
|
||
|
|
||
|
if (head == etl::timer::id::NO_TIMER)
|
||
|
{
|
||
|
// No entries yet.
|
||
|
head = id_;
|
||
|
tail = id_;
|
||
|
timer.previous = etl::timer::id::NO_TIMER;
|
||
|
timer.next = etl::timer::id::NO_TIMER;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
// We already have entries.
|
||
|
etl::timer::id::type test_id = begin();
|
||
|
|
||
|
while (test_id != etl::timer::id::NO_TIMER)
|
||
|
{
|
||
|
timer_data& test = ptimers[test_id];
|
||
|
|
||
|
// Find the correct place to insert.
|
||
|
if (timer.delta <= test.delta)
|
||
|
{
|
||
|
if (test.id == head)
|
||
|
{
|
||
|
head = timer.id;
|
||
|
}
|
||
|
|
||
|
// Insert before test.
|
||
|
timer.previous = test.previous;
|
||
|
test.previous = timer.id;
|
||
|
timer.next = test.id;
|
||
|
|
||
|
// Adjust the next delta to compensate.
|
||
|
test.delta -= timer.delta;
|
||
|
|
||
|
if (timer.previous != etl::timer::id::NO_TIMER)
|
||
|
{
|
||
|
ptimers[timer.previous].next = timer.id;
|
||
|
}
|
||
|
break;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
timer.delta -= test.delta;
|
||
|
}
|
||
|
|
||
|
test_id = next(test_id);
|
||
|
}
|
||
|
|
||
|
// Reached the end?
|
||
|
if (test_id == etl::timer::id::NO_TIMER)
|
||
|
{
|
||
|
// Tag on to the tail.
|
||
|
ptimers[tail].next = timer.id;
|
||
|
timer.previous = tail;
|
||
|
timer.next = etl::timer::id::NO_TIMER;
|
||
|
tail = timer.id;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
//*******************************
|
||
|
void remove(etl::timer::id::type id_, bool has_expired)
|
||
|
{
|
||
|
timer_data& timer = ptimers[id_];
|
||
|
|
||
|
if (head == id_)
|
||
|
{
|
||
|
head = timer.next;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
ptimers[timer.previous].next = timer.next;
|
||
|
}
|
||
|
|
||
|
if (tail == id_)
|
||
|
{
|
||
|
tail = timer.previous;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
ptimers[timer.next].previous = timer.previous;
|
||
|
}
|
||
|
|
||
|
if (!has_expired)
|
||
|
{
|
||
|
// Adjust the next delta.
|
||
|
if (timer.next != etl::timer::id::NO_TIMER)
|
||
|
{
|
||
|
ptimers[timer.next].delta += timer.delta;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
timer.previous = etl::timer::id::NO_TIMER;
|
||
|
timer.next = etl::timer::id::NO_TIMER;
|
||
|
timer.delta = etl::timer::state::Inactive;
|
||
|
}
|
||
|
|
||
|
//*******************************
|
||
|
timer_data& front()
|
||
|
{
|
||
|
return ptimers[head];
|
||
|
}
|
||
|
|
||
|
//*******************************
|
||
|
const timer_data& front() const
|
||
|
{
|
||
|
return ptimers[head];
|
||
|
}
|
||
|
|
||
|
//*******************************
|
||
|
etl::timer::id::type begin()
|
||
|
{
|
||
|
current = head;
|
||
|
return current;
|
||
|
}
|
||
|
|
||
|
//*******************************
|
||
|
etl::timer::id::type previous(etl::timer::id::type last)
|
||
|
{
|
||
|
current = ptimers[last].previous;
|
||
|
return current;
|
||
|
}
|
||
|
|
||
|
//*******************************
|
||
|
etl::timer::id::type next(etl::timer::id::type last)
|
||
|
{
|
||
|
current = ptimers[last].next;
|
||
|
return current;
|
||
|
}
|
||
|
|
||
|
//*******************************
|
||
|
void clear()
|
||
|
{
|
||
|
etl::timer::id::type id = begin();
|
||
|
|
||
|
while (id != etl::timer::id::NO_TIMER)
|
||
|
{
|
||
|
timer_data& timer = ptimers[id];
|
||
|
id = next(id);
|
||
|
timer.next = etl::timer::id::NO_TIMER;
|
||
|
}
|
||
|
|
||
|
head = etl::timer::id::NO_TIMER;
|
||
|
tail = etl::timer::id::NO_TIMER;
|
||
|
current = etl::timer::id::NO_TIMER;
|
||
|
}
|
||
|
|
||
|
private:
|
||
|
|
||
|
etl::timer::id::type head;
|
||
|
etl::timer::id::type tail;
|
||
|
etl::timer::id::type current;
|
||
|
|
||
|
timer_data* const ptimers;
|
||
|
};
|
||
|
|
||
|
// The array of timer data structures.
|
||
|
timer_data* const timer_array;
|
||
|
|
||
|
// The list of active timers.
|
||
|
timer_list active_list;
|
||
|
|
||
|
bool enabled;
|
||
|
uint_least8_t number_of_registered_timers;
|
||
|
|
||
|
public:
|
||
|
|
||
|
const uint_least8_t MAX_TIMERS;
|
||
|
};
|
||
|
|
||
|
//***************************************************************************
|
||
|
/// The message timer
|
||
|
//***************************************************************************
|
||
|
template <uint_least8_t MAX_TIMERS_, typename TInterruptGuard>
|
||
|
class message_timer_interrupt : public etl::imessage_timer_interrupt<TInterruptGuard>
|
||
|
{
|
||
|
public:
|
||
|
|
||
|
ETL_STATIC_ASSERT(MAX_TIMERS_ <= 254, "No more than 254 timers are allowed");
|
||
|
|
||
|
typedef typename imessage_timer_interrupt<TInterruptGuard>::callback_type callback_type;
|
||
|
|
||
|
//*******************************************
|
||
|
/// Constructor.
|
||
|
//*******************************************
|
||
|
message_timer_interrupt()
|
||
|
: imessage_timer_interrupt<TInterruptGuard>(timer_array, MAX_TIMERS_)
|
||
|
{
|
||
|
}
|
||
|
|
||
|
private:
|
||
|
|
||
|
typename etl::imessage_timer_interrupt<TInterruptGuard>::timer_data timer_array[MAX_TIMERS_];
|
||
|
};
|
||
|
}
|
||
|
|
||
|
#endif
|