Release candidate 2.0.0-rc.1 #1
No files matched your search
@@ -0,0 +1,147 @@
|
||||
#include "app_state.h"
|
||||
#include "config.h"
|
||||
|
||||
AppState::AppState(const settings_t *settings, RadioSink *radio)
|
||||
: settings_(settings), radio_(radio)
|
||||
{
|
||||
}
|
||||
|
||||
void AppState::begin(uint32_t now_ms, bool transmit)
|
||||
{
|
||||
set_mode(AppMode::NORMAL, WHEEL_FL, now_ms, transmit);
|
||||
}
|
||||
|
||||
uint32_t AppState::interval_s(bool ignition) const
|
||||
{
|
||||
#if PIN_ACC >= 0
|
||||
return ignition ? settings_->ignition_interval_s : settings_->parking_interval_s;
|
||||
#else
|
||||
(void)ignition;
|
||||
return settings_->normal_interval_s;
|
||||
#endif
|
||||
}
|
||||
|
||||
bool AppState::transmit(uint8_t wheel)
|
||||
{
|
||||
bool ok = radio_ != NULL && radio_->send(wheel);
|
||||
if (!ok) {
|
||||
++error_count_;
|
||||
}
|
||||
return ok;
|
||||
}
|
||||
|
||||
bool AppState::send_current()
|
||||
{
|
||||
return transmit(active_wheel_);
|
||||
}
|
||||
|
||||
bool AppState::send_wheel(uint8_t wheel)
|
||||
{
|
||||
return wheel < WHEEL_COUNT && transmit(wheel);
|
||||
}
|
||||
|
||||
bool AppState::send_all()
|
||||
{
|
||||
bool ok = true;
|
||||
for (uint8_t i = 0; i < WHEEL_COUNT; ++i) {
|
||||
ok = transmit(i) && ok;
|
||||
}
|
||||
return ok;
|
||||
}
|
||||
|
||||
void AppState::schedule(uint32_t now_ms, bool immediate)
|
||||
{
|
||||
next_tx_ms_ = immediate ? now_ms : now_ms + LEARN_PERIOD_MS;
|
||||
}
|
||||
|
||||
bool AppState::set_mode(AppMode mode, uint8_t wheel, uint32_t now_ms,
|
||||
bool transmit_now)
|
||||
{
|
||||
if (wheel >= WHEEL_COUNT) {
|
||||
return false;
|
||||
}
|
||||
mode_ = mode;
|
||||
active_wheel_ = wheel;
|
||||
mode_start_ms_ = now_ms;
|
||||
wheel_start_ms_ = now_ms;
|
||||
schedule(now_ms, transmit_now);
|
||||
if (mode == AppMode::NORMAL) {
|
||||
next_tx_ms_ = transmit_now ? now_ms : UINT32_MAX;
|
||||
}
|
||||
if (transmit_now && mode != AppMode::NORMAL) {
|
||||
send_current();
|
||||
schedule(now_ms, false);
|
||||
} else if (transmit_now) {
|
||||
send_all();
|
||||
next_tx_ms_ = now_ms + settings_->normal_interval_s * 1000u;
|
||||
}
|
||||
return true;
|
||||
}
|
||||
|
||||
bool AppState::next_wheel(uint32_t now_ms)
|
||||
{
|
||||
if (mode_ == AppMode::NORMAL) {
|
||||
return false;
|
||||
}
|
||||
if (mode_ == AppMode::LEARN && active_wheel_ == WHEEL_RL) {
|
||||
return set_mode(AppMode::NORMAL, WHEEL_FL, now_ms, false);
|
||||
}
|
||||
active_wheel_ = (uint8_t)((active_wheel_ + 1u) % WHEEL_COUNT);
|
||||
wheel_start_ms_ = now_ms;
|
||||
send_current();
|
||||
schedule(now_ms, false);
|
||||
return true;
|
||||
}
|
||||
|
||||
void AppState::short_press(uint32_t now_ms)
|
||||
{
|
||||
if (mode_ == AppMode::NORMAL) {
|
||||
send_all();
|
||||
next_tx_ms_ = now_ms + settings_->normal_interval_s * 1000u;
|
||||
} else {
|
||||
next_wheel(now_ms);
|
||||
}
|
||||
}
|
||||
|
||||
void AppState::long_press(uint32_t now_ms)
|
||||
{
|
||||
if (mode_ == AppMode::LEARN) {
|
||||
set_mode(AppMode::NORMAL, WHEEL_FL, now_ms, false);
|
||||
} else {
|
||||
set_mode(AppMode::LEARN, active_wheel_, now_ms);
|
||||
}
|
||||
}
|
||||
|
||||
void AppState::very_long_press(uint32_t now_ms)
|
||||
{
|
||||
if (mode_ == AppMode::SINGLE) {
|
||||
set_mode(AppMode::NORMAL, WHEEL_FL, now_ms, false);
|
||||
} else {
|
||||
set_mode(AppMode::SINGLE, active_wheel_, now_ms);
|
||||
}
|
||||
}
|
||||
|
||||
void AppState::tick(uint32_t now_ms, bool ignition)
|
||||
{
|
||||
if (mode_ == AppMode::LEARN) {
|
||||
if ((uint32_t)(now_ms - mode_start_ms_) >= LEARN_TOTAL_MS
|
||||
|| (uint32_t)(now_ms - wheel_start_ms_) >= LEARN_WINDOW_MS) {
|
||||
set_mode(AppMode::NORMAL, WHEEL_FL, now_ms, false);
|
||||
return;
|
||||
}
|
||||
} else if (mode_ == AppMode::SINGLE
|
||||
&& (uint32_t)(now_ms - mode_start_ms_) >= SINGLE_TIMEOUT_MS) {
|
||||
set_mode(AppMode::NORMAL, WHEEL_FL, now_ms, false);
|
||||
return;
|
||||
}
|
||||
|
||||
if (next_tx_ms_ != UINT32_MAX && (int32_t)(now_ms - next_tx_ms_) >= 0) {
|
||||
if (mode_ == AppMode::NORMAL) {
|
||||
send_all();
|
||||
next_tx_ms_ = now_ms + interval_s(ignition) * 1000u;
|
||||
} else {
|
||||
send_current();
|
||||
schedule(now_ms, false);
|
||||
}
|
||||
}
|
||||
}
|
||||
@@ -0,0 +1,61 @@
|
||||
/* Przenosna maszyna stanow NORMAL/LEARN/SINGLE (fake clock/radio w testach). */
|
||||
#ifndef TPMS_APP_STATE_H
|
||||
#define TPMS_APP_STATE_H
|
||||
|
||||
#include <stdint.h>
|
||||
#include "settings.h"
|
||||
|
||||
enum class AppMode : uint8_t {
|
||||
NORMAL = 0,
|
||||
LEARN = 1,
|
||||
SINGLE = 2,
|
||||
};
|
||||
|
||||
class RadioSink {
|
||||
public:
|
||||
virtual ~RadioSink() = default;
|
||||
virtual bool send(uint8_t wheel) = 0;
|
||||
};
|
||||
|
||||
class AppState {
|
||||
public:
|
||||
AppState(const settings_t *settings, RadioSink *radio);
|
||||
|
||||
void begin(uint32_t now_ms, bool transmit = true);
|
||||
void tick(uint32_t now_ms, bool ignition);
|
||||
void short_press(uint32_t now_ms);
|
||||
void long_press(uint32_t now_ms);
|
||||
void very_long_press(uint32_t now_ms);
|
||||
|
||||
bool set_mode(AppMode mode, uint8_t wheel, uint32_t now_ms,
|
||||
bool transmit = true);
|
||||
bool next_wheel(uint32_t now_ms);
|
||||
bool send_current();
|
||||
bool send_wheel(uint8_t wheel);
|
||||
bool send_all();
|
||||
|
||||
AppMode mode() const { return mode_; }
|
||||
uint8_t active_wheel() const { return active_wheel_; }
|
||||
uint32_t interval_s(bool ignition) const;
|
||||
uint32_t last_error_count() const { return error_count_; }
|
||||
|
||||
private:
|
||||
static const uint32_t LEARN_PERIOD_MS = 2000u;
|
||||
static const uint32_t LEARN_WINDOW_MS = 60000u;
|
||||
static const uint32_t LEARN_TOTAL_MS = 900000u;
|
||||
static const uint32_t SINGLE_TIMEOUT_MS = 300000u;
|
||||
|
||||
const settings_t *settings_;
|
||||
RadioSink *radio_;
|
||||
AppMode mode_ = AppMode::NORMAL;
|
||||
uint8_t active_wheel_ = WHEEL_FL;
|
||||
uint32_t next_tx_ms_ = 0;
|
||||
uint32_t mode_start_ms_ = 0;
|
||||
uint32_t wheel_start_ms_ = 0;
|
||||
uint32_t error_count_ = 0;
|
||||
|
||||
bool transmit(uint8_t wheel);
|
||||
void schedule(uint32_t now_ms, bool immediate);
|
||||
};
|
||||
|
||||
#endif
|
||||
Reference in new issue
Block a user