mirs_esp_pio
読み取り中…
検索中…
一致する文字列を見つけられません
sensor_task.cpp
[詳解]
1#include "sensor_task.hpp"
2#include <Arduino.h>
3#include <freertos/FreeRTOS.h>
4#include <freertos/task.h>
5
6#include "hardware_config.hpp"
7#include "VoltageSensor.hpp"
8#include "BMX055.hpp"
9#include "Registry.hpp"
10#include "SensorPlugin.hpp"
11#include "VoltagePlugin.hpp"
12#include "ImuPlugin.hpp"
13#include "SystemContext.hpp"
14
15// 電圧は変化が緩やかなため4制御周期に1回(約60ms)読む
16#define VOLTAGE_DIVIDER 4
17#define MAX_PLUGINS 4
18
19// ---- 合成ルート:追加・削除はこの登録リスト1行 ----
20// ハード実体とプラグインの寿命はタスクと同一(static)。
21// IMU不在時は begin() 失敗で無効化されるため、#if分離はしない。
22static VoltageSensor voltage_sensor_1, voltage_sensor_2;
23static BMX055 bmx055;
30
31void sensorTask(void *arg) {
32 (void)arg;
33
36 (void)registry.add(&imu_plugin, 1);
37
38 for (size_t i = 0; i < registry.size(); ++i) {
39 if (!registry.beginPlugin(i)) {
40 Serial.printf("[sensor] %s unavailable, disabled\n", registry.name(i));
41 }
42 }
43
44 // 蓄積スナップショット。間引き中の電圧は前回値を保持する
45 static SharedSensor snapshot{};
46
47 for (;;) {
48 registry.updateAll(snapshot);
49 g_sys.setSensor(snapshot);
50 vTaskDelay(pdMS_TO_TICKS(TIMER_INTERVAL_MS));
51 }
52}
IMUの接続を調べ、加速度・角速度・地磁気の計測値をセンサ処理へ渡す。
センサ処理を登録し、登録した順に初期化・更新する。
センサごとに共通して呼び出す初期化と更新の窓口を定義する。
SystemContext g_sys
制御・通信・センサのタスク間で、指令と計測値を排他制御して受け渡す。
電圧センサの計測を初期化し、バッテリー電圧を共有データへ保存する。
IMU(BMX055)プラグイン。加速度・角速度・地磁気を書き込む。
固定容量のタスク内プラグインレジストリ。ヒープ不使用。
void setSensor(const SharedSensor &s)
電圧センサプラグイン。担当ch(1/2)の電圧[V]を書き込む。
ESP32のピン、RC信号の範囲、速度上限と周期を定義する。
#define ADC_RESOLUTION
#define PIN_IMU_SDA
#define PIN_BATT_1
#define PIN_BATT_2
#define PIN_IMU_SCL
#define ADC_REF_VOLTAGE
#define VOLTAGE_DIVIDER_RATIO
#define TIMER_INTERVAL_MS
static VoltageSensor voltage_sensor_2
#define VOLTAGE_DIVIDER
static Registry< ISensorPlugin, SharedSensor, MAX_PLUGINS > registry
static VoltageSensor voltage_sensor_1
static ImuPlugin imu_plugin(bmx055, PIN_IMU_SDA, PIN_IMU_SCL)
static BMX055 bmx055
static VoltagePlugin voltage_plugin_2(voltage_sensor_2, 2, PIN_BATT_2, VOLTAGE_DIVIDER_RATIO, ADC_REF_VOLTAGE, ADC_RESOLUTION)
static VoltagePlugin voltage_plugin_1(voltage_sensor_1, 1, PIN_BATT_1, VOLTAGE_DIVIDER_RATIO, ADC_REF_VOLTAGE, ADC_RESOLUTION)
void sensorTask(void *arg)
IMUと電圧を周期的に読み取り、制御・通信タスクへ渡す。
センサ系テレメトリ。