mirs_esp_pio
Toggle main menu visibility
読み取り中…
検索中…
一致する文字列を見つけられません
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分離はしない。
22
static
VoltageSensor
voltage_sensor_1
,
voltage_sensor_2
;
23
static
BMX055
bmx055
;
24
static
VoltagePlugin
voltage_plugin_1
(
voltage_sensor_1
, 1,
PIN_BATT_1
,
25
VOLTAGE_DIVIDER_RATIO
,
ADC_REF_VOLTAGE
,
ADC_RESOLUTION
);
26
static
VoltagePlugin
voltage_plugin_2
(
voltage_sensor_2
, 2,
PIN_BATT_2
,
27
VOLTAGE_DIVIDER_RATIO
,
ADC_REF_VOLTAGE
,
ADC_RESOLUTION
);
28
static
ImuPlugin
imu_plugin
(
bmx055
,
PIN_IMU_SDA
,
PIN_IMU_SCL
);
29
static
Registry<ISensorPlugin, SharedSensor, MAX_PLUGINS>
registry
;
30
31
void
sensorTask
(
void
*arg) {
32
(void)arg;
33
34
(void)
registry
.add(&
voltage_plugin_1
,
VOLTAGE_DIVIDER
);
35
(void)
registry
.add(&
voltage_plugin_2
,
VOLTAGE_DIVIDER
);
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
}
ImuPlugin.hpp
IMUの接続を調べ、加速度・角速度・地磁気の計測値をセンサ処理へ渡す。
Registry.hpp
センサ処理を登録し、登録した順に初期化・更新する。
SensorPlugin.hpp
センサごとに共通して呼び出す初期化と更新の窓口を定義する。
g_sys
SystemContext g_sys
定義
SystemContext.cpp:3
SystemContext.hpp
制御・通信・センサのタスク間で、指令と計測値を排他制御して受け渡す。
VoltagePlugin.hpp
電圧センサの計測を初期化し、バッテリー電圧を共有データへ保存する。
ImuPlugin
IMU(BMX055)プラグイン。加速度・角速度・地磁気を書き込む。
定義
ImuPlugin.hpp:10
Registry
固定容量のタスク内プラグインレジストリ。ヒープ不使用。
定義
Registry.hpp:14
SystemContext::setSensor
void setSensor(const SharedSensor &s)
定義
SystemContext.hpp:131
VoltagePlugin
電圧センサプラグイン。担当ch(1/2)の電圧[V]を書き込む。
定義
VoltagePlugin.hpp:7
hardware_config.hpp
ESP32のピン、RC信号の範囲、速度上限と周期を定義する。
ADC_RESOLUTION
#define ADC_RESOLUTION
定義
hardware_config.hpp:24
PIN_IMU_SDA
#define PIN_IMU_SDA
定義
hardware_config.hpp:27
PIN_BATT_1
#define PIN_BATT_1
定義
hardware_config.hpp:20
PIN_BATT_2
#define PIN_BATT_2
定義
hardware_config.hpp:21
PIN_IMU_SCL
#define PIN_IMU_SCL
定義
hardware_config.hpp:28
ADC_REF_VOLTAGE
#define ADC_REF_VOLTAGE
定義
hardware_config.hpp:23
VOLTAGE_DIVIDER_RATIO
#define VOLTAGE_DIVIDER_RATIO
定義
hardware_config.hpp:22
TIMER_INTERVAL_MS
#define TIMER_INTERVAL_MS
定義
hardware_config.hpp:44
voltage_sensor_2
static VoltageSensor voltage_sensor_2
定義
sensor_task.cpp:22
VOLTAGE_DIVIDER
#define VOLTAGE_DIVIDER
定義
sensor_task.cpp:16
registry
static Registry< ISensorPlugin, SharedSensor, MAX_PLUGINS > registry
定義
sensor_task.cpp:29
voltage_sensor_1
static VoltageSensor voltage_sensor_1
定義
sensor_task.cpp:22
imu_plugin
static ImuPlugin imu_plugin(bmx055, PIN_IMU_SDA, PIN_IMU_SCL)
bmx055
static BMX055 bmx055
定義
sensor_task.cpp:23
voltage_plugin_2
static VoltagePlugin voltage_plugin_2(voltage_sensor_2, 2, PIN_BATT_2, VOLTAGE_DIVIDER_RATIO, ADC_REF_VOLTAGE, ADC_RESOLUTION)
voltage_plugin_1
static VoltagePlugin voltage_plugin_1(voltage_sensor_1, 1, PIN_BATT_1, VOLTAGE_DIVIDER_RATIO, ADC_REF_VOLTAGE, ADC_RESOLUTION)
sensorTask
void sensorTask(void *arg)
定義
sensor_task.cpp:31
sensor_task.hpp
IMUと電圧を周期的に読み取り、制御・通信タスクへ渡す。
SharedSensor
センサ系テレメトリ。
定義
SystemContext.hpp:61
src
tasks
sensor_task.cpp
構築:
1.18.0