かしこいLEDライトを作ろう!その5 振動センサー編 2

 さて、前回で振動センサーに翻弄されたわけですが、今回はそれの続きです

振動があるかないかだけを判断するものでは不十分だと気づいた私は、他に振動を検知するものが無いのかを探しました。

そして、ジャイロセンサーの存在を知ります。

というより、知ってはいたのですが、こういうときにこそ使うものだと理解していませんでした。

ジャイロセンサーというのは、自分がどのように傾いているのかを把握するセンサーです。

加えて、加速度を測るための軸が加わるとどのように動いているのかを測ることができます。

さてそれを叶えてくれる安価なセンサーがこちら、「MPU6050」を使います。

https://amzn.asia/d/7GCYDmU

X軸、Y軸、Z軸と、加速度3軸を測れる6軸センサーだそうです。

動かすにあたり、参考にしたのはこちら(こちらはArduinoを使用されています)

https://zenn.dev/suzuky/articles/54852b5ae04023

なのですが、さっそくこのセンサーをRaspberry Pi picoに接続して…とすんなりとはいきませんでした。

まず、このセンサーを使うには、I2C通信が必要です。

どうもセンサー間でやり取りされる信号の一つらしいのですが、Raspberry Piにはこの機能が備わっています。

ですので、この信号をやり取りできるGPIOにセンサーを接続すれば動く…はずなのですが、うまくいきませんでした。

というのも、私はこのセンサーをRaspberry Pi picoで扱う方法を、chatGPTに聞いていました。

その際の回答がこちらです




ここで言われている「2,ソフトウェアの準備」のうち、の1,はすでにこの記事で済んでいるのですが、問題は2でした。

検索したところ、最も使用されているらしいライブラリが、私の使っているMicroPythonでは使用できなかったのです。

困りながらも検索してみると、こんな記事を見つけました

https://wisteriahill.sakura.ne.jp/CMS/WordPress/2023/06/30/pi-pico-mpu-6050/

ライブラリが載ってる!Raspberry Piでのセンサーの使い方まで!!
ということで、ありがたく使用いたします。
使用するには、Raspberry Pi picoを接続した状態で、Thonnyで以下のライブラリを開き

from machine import Pin, I2C
import utime
 
PWR_MGMT_1 = 0x6B
SMPLRT_DIV = 0x19
CONFIG = 0x1A
GYRO_CONFIG = 0x1B
ACCEL_CONFIG = 0x1C
TEMP_OUT_H = 0x41
ACCEL_XOUT_H = 0x3B
GYRO_XOUT_H = 0x43
 
def init_mpu6050(i2c, address=0x68):
    i2c.writeto_mem(address, PWR_MGMT_1, b'\x00')
    utime.sleep_ms(100)
    i2c.writeto_mem(address, SMPLRT_DIV, b'\x07')
    i2c.writeto_mem(address, CONFIG, b'\x00')
    i2c.writeto_mem(address, GYRO_CONFIG, b'\x00')
    i2c.writeto_mem(address, ACCEL_CONFIG, b'\x00')
 
def read_raw_data(i2c, addr, address=0x68):
    high = i2c.readfrom_mem(address, addr, 1)[0]
    low = i2c.readfrom_mem(address, addr + 1, 1)[0]
    value = high << 8 | low
    if value > 32768:
        value = value - 65536
    return value
 
def get_mpu6050_data(i2c):
    temp = read_raw_data(i2c, TEMP_OUT_H) / 340.0 + 36.53
    accel_x = read_raw_data(i2c, ACCEL_XOUT_H) / 16384.0
    accel_y = read_raw_data(i2c, ACCEL_XOUT_H + 2) / 16384.0
    accel_z = read_raw_data(i2c, ACCEL_XOUT_H + 4) / 16384.0
    gyro_x = read_raw_data(i2c, GYRO_XOUT_H) / 131.0
    gyro_y = read_raw_data(i2c, GYRO_XOUT_H + 2) / 131.0
    gyro_z = read_raw_data(i2c, GYRO_XOUT_H + 4) / 131.0
 
    return {
        'temp': temp,
        'accel': {
            'x': accel_x,
            'y': accel_y,
            'z': accel_z,
        },
        'gyro': {
            'x': gyro_x,
            'y': gyro_y,
            'z': gyro_z,
        }
    }

Raspberry Pi picoに「mpu6050.py」というファイル名で保存します
タブの名前が[mpu6050.py]という表記になれば成功です。

次にRaspberry Piとセンサーを物理的につなぎます。
使うのは以下のピンです

・ VCCと3V3(OUT) (36ピン)
・GDNとGDN (38ピン)
・SCLとGPIO5 (7ピン)
・SDAとGPIO4 (6ピン)

これらをそれぞれブレットボード上でつなげて、先程chatGPTに教えてもらったプログラムをテストします。

つなげた様子はこちら



そしてプログラムの全貌はこちら

from machine import Pin, I2C
import time

# MPU6050のアドレスとレジスタ定義
MPU6050_ADDR = 0x68
MPU6050_PWR_MGMT_1 = 0x6B
MPU6050_ACCEL_XOUT_H = 0x3B

# I2Cインターフェースの設定 (SCL=GP5, SDA=GP4)
i2c = I2C(0, scl=Pin(5), sda=Pin(4), freq=400000)

# MPU6050の初期化
def init_mpu6050():
    i2c.writeto_mem(MPU6050_ADDR, MPU6050_PWR_MGMT_1, bytearray([0]))

# データの読み取り
def read_mpu6050():
    data = i2c.readfrom_mem(MPU6050_ADDR, MPU6050_ACCEL_XOUT_H, 6)
    accel_x = (data[0] << 8 | data[1]) if data[0] < 0x80 else -((65535 - (data[0] << 8 | data[1])) + 1)
    accel_y = (data[2] << 8 | data[3]) if data[2] < 0x80 else -((65535 - (data[2] << 8 | data[3])) + 1)
    accel_z = (data[4] << 8 | data[5]) if data[4] < 0x80 else -((65535 - (data[4] << 8 | data[5])) + 1)
    return accel_x, accel_y, accel_z

# MPU6050を初期化
init_mpu6050()

# データ取得ループ
while True:
    accel_x, accel_y, accel_z = read_mpu6050()
    print('Accel X: {}, Accel Y: {}, Accel Z: {}'.format(accel_x, accel_y, accel_z))
    time.sleep(0.5)


するとこのような結果が!

きちんとセンサーを認識しているようです
それではいよいよ、この値を使ったLEDライトのプログラムを作っていきますよー!

というところで、次回に続く!

コメント