かしこいLEDライトを作ろう!その5 振動センサー編 2
さて、前回で振動センサーに翻弄されたわけですが、今回はそれの続きです
振動があるかないかだけを判断するものでは不十分だと気づいた私は、他に振動を検知するものが無いのかを探しました。
そして、ジャイロセンサーの存在を知ります。
というより、知ってはいたのですが、こういうときにこそ使うものだと理解していませんでした。
ジャイロセンサーというのは、自分がどのように傾いているのかを把握するセンサーです。
加えて、加速度を測るための軸が加わるとどのように動いているのかを測ることができます。
さてそれを叶えてくれる安価なセンサーがこちら、「MPU6050」を使います。
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でのセンサーの使い方まで!!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,
}
}
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)




コメント
コメントを投稿