こうなるとMultiWiiのソースコード(”Goebish build dsm2 2048 multiwii 2.3″)をひと通り調査しないといけない。
まずはセンサー編。
Sensors.cpp
のvoid initSensors()
から。
if (GYRO)
で始まる各種センサーの有無を調べると、Pocket QuadであるのはGYRO
とACC
の2つ。
BARO
, MAG
, SONAR
の3つは無い。
ジャイロと加速度センサーはMPU-6050というチップとI2Cでやりとりする。
MPU-6050の資料
AVRのI2C制御アーカイブ
I2C関連の関数を抜き出した。