mirs_esp_pio
読み取り中…
検索中…
一致する文字列を見つけられません
ImuPlugin.cpp
[詳解]
1#include "ImuPlugin.hpp"
2#include "BMX055.hpp"
3
4ImuPlugin::ImuPlugin(BMX055 &imu, int sda_pin, int scl_pin)
5 : imu_(imu)
6 , sda_pin_(sda_pin)
7 , scl_pin_(scl_pin)
8{
9}
10
12 return imu_.begin(sda_pin_, scl_pin_);
13}
14
16 BMX055Data data{};
17 if (!imu_.update(data)) {
18 snapshot.imu_ok = false;
19 snapshot.mag_ok = false;
20 snapshot.ax = snapshot.ay = snapshot.az = 0.0f;
21 snapshot.gx = snapshot.gy = snapshot.gz = 0.0f;
22 snapshot.mx = snapshot.my = snapshot.mz = 0.0f;
23 return;
24 }
25 snapshot.imu_ok = imu_.isAccelOk() || imu_.isGyroOk();
26 snapshot.mag_ok = imu_.isMagOk();
27 snapshot.ax = data.ax;
28 snapshot.ay = data.ay;
29 snapshot.az = data.az;
30 snapshot.gx = data.gx;
31 snapshot.gy = data.gy;
32 snapshot.gz = data.gz;
33 snapshot.mx = data.mx;
34 snapshot.my = data.my;
35 snapshot.mz = data.mz;
36}
IMUの接続を調べ、加速度・角速度・地磁気の計測値をセンサ処理へ渡す。
bool begin() override
ImuPlugin(BMX055 &imu, int sda_pin, int scl_pin)
コンストラクタ。バス固有値は全て注入する。
void update(SharedSensor &snapshot) override
担当フィールドをsnapshotに書き込む。
センサ系テレメトリ。