Arduino 入門 Lesson 32 【６軸モーションセンサ編　その２】

子供と一緒に始めるマイコンプログラム
Arduino 入門
Lesson 32
【６軸モーションセンサ編　その２】

「Arduino」を使ったマイコンプログラミングを子供と一緒に学習するブログ。

少しずつ、子供と一緒に楽しみながら気長にアップしてく予定です。

本記事はLesson 32 【６軸モーションセンサ編　その2】です。

Lesson 31では、とりあえず動かしてデータを取得して遊びました。

そのため、スケッチの記述内容がなんでそうなるのか？

という説明は省略しています。

本Lessonでは、スケッチ内で設定しているMPU6050のレジスタについてレジスタマップと照らし合わせて解説していきます。

これで、スケッチで何をしているのか少し理解が進むはず。

本Lessonでは安価なMPU-6050（GY-521）の6軸モーションセンサを使用しています。

REES52 MPU-6050 使用３軸ジャイロスコープ・３軸加速度センサーモジュール

REES52

学習、遊び、試行用途であれば、お手頃な値段。

Amazon購入の場合、複数個購入しても1000円以下で購入可能です。

Arduino入門編の解説にて使用しているArduinoは互換品です。

互換品とは言え、Arduinoはオープンソースであり複製して販売するのもライセンス的に問題なし。

そのため互換品の品質も悪くなく、それでいて値段は安いです。

正規品本体の値段程度で豊富な部品が多数ついています。

ELEGOO Arduino用UNO R3スターターキットレベルアップチュートリアル付 mega2560 r3 nanoと互換 [並行輸入品]

ELEGOO

ELEGOO Arduino用のUNO R3 最終版スタータキット UNOチュートリアル付 (63 Items)

ELEGOO

正規品の本体単品がほしい方はこちらとなります。

Arduino Uno Rev3 ATmega328 マイコンボード A000066 白

Arduino (アルドゥイーノ)

はじめに
Lesson 32 目標
コード確認の前に
コードの確認
まとめ
最後に
Amazonでお得に買う方法

はじめに

レジスタマップ内に記載されているレジスタ設定について確認していきます。

そのため、MPU-6050のレジスタマップを確認する必要があります。。

Lesson 31で紹介した、下記サイトでレジスタマップを確認することが可能です。

MPU-6050 | TDK InvenSense

にアクセスしましたらページ中央当たりに下記があります。

「MPU-6000 and MPU-6050 Register Maps and Descriptions」

ファイルはPDFファイルです。

Lesson 32 目標

本Lessonの目標は以下です。

スケッチ内で使用しているMPU-6050（GY-521）のレジスタ設定を理解する。

本Lessonで、レジスタマップのどこに記載されているかを確認しましょう。

コード確認の前に

通信にはI2C通信を使用します。

I2C通信に関しては、以下で解説していますので確認しておくことをおすすめします。

本Lessonでは解説は省略します。

Arduino 入門番外編 06 【I2C通信とは】

今回は、「Arduino 入門番外編０６ I2C通信とは」です。arduino 入門番外編はarduinoの基本的なことを書いていく予定です。今回は、arduinoの「I2C通信」について解説していきます。…

コードの確認

さっそく、コードを確認していきましょう。

下記はLesson 31で使用したスケッチとなります。

下記スケッチをレジスタマップと突き合せて確認していきます。

//Lesson 31-1 6軸モーションセンサ
//3軸ジャイロスコープ・3軸加速度センサ モジュール
//ジャイロセンサで検知したデータをシリアルモニタに表示
//https://omoroya.com/

// 電子部品
// MPU-0650使用のGY-521基板

//ライブラリインクルード
#include <Wire.h>

void setup() {
  Serial.begin(115200); //シリアル通信のデータ転送レートを設定しポート開放
  Serial.println("--- Started ---");
  
  Wire.begin();         //I2C通信開始
  // センサ開始動作
  Wire.beginTransmission(0x68); //アドレス0x68指定でMPU-6050を選択、送信処理開始
  Wire.write(0x6B);             //MPU6050_PWR_MGMT_1レジスタのアドレス指定
  Wire.write(0x00);             //0を書き込むことでセンサ動作開始
  Wire.endTransmission();       //スレーブデバイスに対する送信を完了
  
}

void loop() {
  // スタートアドレスの設定とデータの要求処理
  Wire.beginTransmission(0x68);     //アドレス0x68指定でMPU-6050を選択、送信処理開始
  Wire.write(0x3B);                 //ACCEL_XOUT_Hレジスタのアドレス指定
  Wire.endTransmission(false);      //false設定で接続維持
  Wire.requestFrom(0x68, 14, true); //MPU-6050に対して14byte分データを要求、I2Cバス開放
  
  int16_t ax, ay, az, gx, gy, gz, Temp; //符号付き整数を格納する16ビットの変数型の設定

  //シフト演算と論理和で16bitのデータを変数に格納
  //ax～gzまで、16bit(2byte) × 7 = 14byte
  ax = Wire.read() << 8 | Wire.read();    //x軸の加速度の読み取り 16bit
  ay = Wire.read() << 8 | Wire.read();    //y軸の加速度の読み取り 16bit
  az = Wire.read() << 8 | Wire.read();    //z軸の加速度の読み取り 16bit
  Temp  = Wire.read() << 8 | Wire.read(); //温度の読み取り 16bit
  gx = Wire.read() << 8 | Wire.read();    //x軸の角速度の読み取り 16bit
  gy = Wire.read() << 8 | Wire.read();    //y軸の角速度の読み取り 16bit
  gz = Wire.read() << 8 | Wire.read();    //z軸の角速度の読み取り 16bit

  //データの表示 1LSBの値はデータシートに記載
  //AFS_SEL設定 = 0, ±2g, 16384LSB/g
  //FS_SEL設定  = 0, ±250deg/s, 131LSB/deg/s 
  Serial.print(ax/16384.0); Serial.print(" g,  ");     //1LSBを加速度(G)に換算してシリアルモニタに表示
  Serial.print(ay/16384.0); Serial.print(" g,  ");     //1LSBを加速度(G)に換算してシリアルモニタに表示
  Serial.print(az/16384.0); Serial.print(" g,  ");     //1LSBを加速度(G)に換算してシリアルモニタに表示
  Serial.print(gx/131.0); Serial.print(" deg/s,  ");   //1LSBを角速度(deg/s)に換算してシリアルモニタに表示
  Serial.print(gy/131.0); Serial.print(" deg/s,  ");   //1LSBを角速度(deg/s)に換算してシリアルモニタに表示
  Serial.print(gz/131.0); Serial.println(" deg/s,  "); //1LSBを角速度(deg/s)に換算してシリアルモニタに表示
  //Serial.print(Temp/340.00+36.53); Serial.println(" deg.");    //温度換算シリアルモニタに表示

  delay(20);
}

センサ開始動作

スケッチ内のセンサ開始動作について確認していきます。

スケッチ内では以下のコードの部分が該当箇所となります。

Wire.begin(); //I2C通信開始
// センサ開始動作
Wire.beginTransmission(0x68); //アドレス0x68指定でMPU-6050を選択、送信処理開始
Wire.write(0x6B);             //MPU6050_PWR_MGMT_1レジスタのアドレス指定
Wire.write(0x00);             //0を書き込むことでセンサ動作開始
Wire.endTransmission();       //スレーブデバイスに対する送信を完了

 int16_t ax, ay, az, gx, gy, gz, Temp; //符号付き整数を格納する16ビットの変数型の設定

1つ1つ解説していきます。

Wire.begin();
I2C用の制御関数を使えるようにするための記述です。

Wire.beginTransmission(0x68);
対象のI2Cデバイスに接続しています。
「0x68」はこのデバイスのアドレスとなります。

レジスタの0x75番地にデバイスアドレスが格納されていて読み出して確認することも可能です。

WHO_AM_Iレジスタ（0x75）

上記レジスタの説明には、以下と記載されています。

このレジスタがデバイスのidentityを確認するために使用されること
このレジスタのデフォルト値が「0x68」であること
最下位ビットはAD0の状態で決定されること

ここでLesson 31を思い出してください。

AD0はどうしていたか？

そう、このピンはGY-521基板上で4.7kΩでプルダウンされているのです。

最下位bitは０ということですね。

よって、デフォルト値に変更はなくMPU-6050のデバイスアドレスは「0x68」。

実際に、レジスタ内容を確認したいかたはレジスタ値を読み出して確認してみてください。

Wire.write(0x6B);
1つ目のwrite関数で「レジスタのアドレス」を指定しています。
「0x6B」はPWR_MGMT_1レジスタです。

PWR_MGMT_1レジスタ（0x6B）へ書き込みしますよってことです。

Wire.write(0x00);
2つ目のwrite関数で「指定したレジスタにデータを格納」。
PWR_MGMT_1レジスタを「0x00」にするということ。

PWR_MGMT_1レジスタ（0x6B）

上記レジスタの説明には、以下と記載されています。

代表的な内容だけ抜粋。

電力モードとクロックの設定
デバイスのリセット、温度センサの無効化するためのbitあり
電力スリープモードの設定
供給するクロックの選択

このレジスタでにデータを送信し上記の設定をするということです。

「0x00」をレジスタに書き込むということは、上位4bitが0000、下位4bitが0000となります。

上位4bitは0000としているので特に機能を使用していません。

下位4bitの0000の設定は、上位ビットから考えると・・・

0：温度センサ enable（１設定でdisable）

000：3bitを使用してクロックを選択します。

選択できるクロックが以下となります。

000は10進数で0ですから、「Internal 8MHz oscillator」を選択していることになります。

Wire.endTransmission();
スレーブデバイスに対する送信完了しています。

スタートアドレス設定とデータ要求処理

スタートアドレス設定とデータ要求処理について確認していきます。

スケッチ内では以下のコードの部分が該当箇所となります。

 // スタートアドレスの設定とデータの要求処理
  Wire.beginTransmission(0x68);     //アドレス0x68指定でMPU-6050を選択、送信処理開始
  Wire.write(0x3B);                 //ACCEL_XOUT_Hレジスタのアドレス指定
  Wire.endTransmission(false);      //false設定で接続維持
  Wire.requestFrom(0x68, 14, true); //MPU-6050に対して14byte分データを要求、I2Cバス開放

1つ1つ解説していきます。

Wire.beginTransmission(0x68);
対象のI2Cデバイスに接続しています。
「0x68」はこのデバイスのアドレスとなります。

すでに解説済みですので省略します。

Wire.write(0x3B);
1つ目のwrite関数で「レジスタのアドレス」を指定しています。
「0x3B」はACCEL_XOUT_H（x軸加速度データの上位バイト）が格納されているレジスタの番地となります。

ここで何をしているかというと

加速度センサ（3軸）、デバイス温度、ジィイロ（3軸）の値を取り出すための準備をしています。

センサの検出値はそれぞれ、16bit(2byte）で構成されています。
※1つのデータが2byteで構成されているということ。

レジスタの「0x3B」番地から順に全ての検出値を取得。

そのためには14byte読み出す必要があるということです。

1つのデータが2byteですから、14byte / 2byte = 7。

7つのデータ = 加速度3軸、デバイス温度、ジャイロ3軸

ということがわかります。

下記に示す3Bから順に48まで読み出したいので、読み出す先頭の番地を指定しているとお考え下さい。

Wire.endTransmission(false);
アドレス指定とデータの読み込みを１つの通信をするための手法です。
デバイスとの接続を維持しつづけます。
※リピーテッド・スタート・コンディションと呼ばれる手法です。

Wire.requestFrom(0x68, 14, true);
0x68のデバイスの0x3Bアドレスから14byte分のデータを要求しています。

Wire.endTransmission()、Wire.requestForm()に引数を指定しているのが動作のミソとなります。

int16_t ax, ay, az, gx, gy, gz, Temp;
16bitの整数を格納するための宣言です。
1つのデータが2byte（16bit）だからです。

16bitのデータ読み込み処理

16bitデータの読み込み処理について解説します。

スケッチ内では以下のコードの部分が該当箇所となります。

  //シフト演算と論理和で16bitのデータを変数に格納
  //ax～gzまで、16bit(2byte) × 7 = 14byte
  ax = Wire.read() << 8 | Wire.read();    //x軸の加速度の読み取り 16bit
  ay = Wire.read() << 8 | Wire.read();    //y軸の加速度の読み取り 16bit
  az = Wire.read() << 8 | Wire.read();    //z軸の加速度の読み取り 16bit
  Temp  = Wire.read() << 8 | Wire.read(); //温度の読み取り 16bit
  gx = Wire.read() << 8 | Wire.read();    //x軸の角速度の読み取り 16bit
  gy = Wire.read() << 8 | Wire.read();    //y軸の角速度の読み取り 16bit
  gz = Wire.read() << 8 | Wire.read();    //z軸の角速度の読み取り 16bit

ax = Wire.read() << 8 | Wire.read();
検出するデータ長は16bitです。
しかし、I2C通信が1回で送ることができるデータは8bitとなります。
上記は、2回のI2C読み込み処理をすることで16bitのデータをaxに格納している処理となります。

Wire.read()でデータを読み取り、8bitシフトさせ、もう一度Wire.read()で読み取り16bit文のデータ長としています。

センサが検出する7つ分のデータを取得するために、同じ処理を、ay、az、Temp、gx、gy、gzでもしています。

シリアルモニタに表示

シリアルモニタ表示の処理となります。

スケッチ内では以下のコードの部分が該当箇所となります。

  //データの表示 1LSBの値はデータシートに記載
  //AFS_SEL設定 = 0, ±2g, 16384LSB/g
  //FS_SEL設定  = 0, ±250deg/s, 131LSB/deg/s 
  Serial.print(ax/16384.0); Serial.print(" g,  ");     //1LSBを加速度(G)に換算してシリアルモニタに表示
  Serial.print(ay/16384.0); Serial.print(" g,  ");     //1LSBを加速度(G)に換算してシリアルモニタに表示
  Serial.print(az/16384.0); Serial.print(" g,  ");     //1LSBを加速度(G)に換算してシリアルモニタに表示
  Serial.print(gx/131.0); Serial.print(" deg/s,  ");   //1LSBを角速度(deg/s)に換算してシリアルモニタに表示
  Serial.print(gy/131.0); Serial.print(" deg/s,  ");   //1LSBを角速度(deg/s)に換算してシリアルモニタに表示
  Serial.print(gz/131.0); Serial.println(" deg/s,  "); //1LSBを角速度(deg/s)に換算してシリアルモニタに表示
  //Serial.print(Temp/340.00+36.53); Serial.println(" deg.");    //温度換算シリアルモニタに表示