Ken Van Hoeylandt
60 lines
1.3 KiB
C++
60 lines
1.3 KiB
C++
#pragma once
|
|
|
|
#include <Tactility/freertoscompat/RTOS.h>
|
|
#include <Tactility/RecursiveMutex.h>
|
|
|
|
#include <minmea.h>
|
|
|
|
#include <ranges>
|
|
#include <memory>
|
|
|
|
namespace tt::hal::gps {
|
|
|
|
/** Thread-safe storage of recent satellites */
|
|
class SatelliteStorage {
|
|
|
|
public:
|
|
|
|
static constexpr size_t recordCount = 32;
|
|
|
|
private:
|
|
|
|
struct SatelliteRecord {
|
|
minmea_sat_info data {
|
|
.nr = 0,
|
|
.elevation = 0,
|
|
.azimuth = 0,
|
|
.snr = 0
|
|
};
|
|
TickType_t lastUpdated = 0;
|
|
bool inUse = false;
|
|
};
|
|
|
|
RecursiveMutex mutex;
|
|
std::array<SatelliteRecord, recordCount> records;
|
|
uint16_t recycleTimeSeconds;
|
|
uint16_t recentTimeSeconds;
|
|
|
|
SatelliteRecord* findRecord(int number);
|
|
|
|
SatelliteRecord* findUnusedRecord();
|
|
|
|
SatelliteRecord* findRecordToRecycle();
|
|
|
|
/** Tries to find an existing record, otherwise return a free one, otherwise return the oldest active one */
|
|
SatelliteRecord* findWithFallback(int number);
|
|
|
|
public:
|
|
|
|
explicit SatelliteStorage(
|
|
uint16_t recycleTimeSeconds = 120,
|
|
uint16_t recentTimeSeconds = 60
|
|
) : recycleTimeSeconds(recycleTimeSeconds), recentTimeSeconds(recentTimeSeconds) {}
|
|
|
|
void notify(const minmea_sat_info& info);
|
|
|
|
void getRecords(const std::function<void(const minmea_sat_info&)>& onRecord) const;
|
|
};
|
|
|
|
} // namespace tt::hal::gps
|