siroitori0413 が 2024年10月31日18時17分48秒 に編集
コメント無し
本文の変更
# ラズパイ搭載モデルロケット計画 福岡大学の松隈教授が、子供たちを対象に定期的にモデルロケットを作って飛ばすイベントをされています。植松電機のロケット教室を福岡で広める活動をされているとのことです。 モデルロケットには植松電機製のペーパークラフトで作成するロケットキットを使用されています。 そのイベントへ参加したときに「ラズパイを載せてみたい!」と思い、その提案に松隈教授も面白がっていただきこのプロジェクトが発足しました。 ![モデルロケット発射の様子](https://camo.elchika.com/f02d603e168e558c6b6ce656f1bf53c9662dfe2b/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f30613439623061322d303637642d343831662d616535342d6662376130303834316537342f31396135643963642d356137662d343266652d383162352d353333643832386331636233/) 第1弾はこの記事を書いている私[とり子](https://elchika.com/user/siroitori0413/)と息子[memetan](https://elchika.com/user/memetan/)で松隈教授にサポートいただきながら行っていましたが、今回はさらに小学生のメンバーを増やして大人はサポート役として若者をメインに活動しています。(若者たちかなりツヨイので大人のほうが教えられている…) 参加メンバーについてはこの記事の終わりに「メンバー紹介」として記載しています。 # 目標 **ラズパイを載せてロケットを飛ばし、パラシュートで落ちてくる**こと。 ラズパイでは、ロケット飛行中に以下を行う。 - **カメラ映像の記録** - **9軸センサ(加速度・ジャイロ・磁気)の値の記録** ### 前回の結果を踏まえて 前回第1弾で得た反省を踏まえて今回の実装を行う(前回の様子は[こちらのブログ](https://blog.memetan.dev/entry/2023/05/29/232758)に記載しています) - ラズパイの重量でロケットが重くなりパラシュートが開く前に落ちて大破してしまった →**軽量化**を行い、また重量を計測し**見合ったサイズのロケットとロケットエンジンを使用**する。 - 加速度・各速度の値が1秒間隔と長すぎ有用なデータとならなかった →**間隔を短く**し取りこぼしがないようにする 前回は大破してしまったので1度しか打ち上げられなかったのですが、確実にパラシュートが開けば中身が壊れることが少ないと思うので、調整しつつ何度もリトライすることができます。 # ハードウェア 今回のラズパイ搭載ロケットには以下を使用 - [ペーパークラフトロケットB型](https://uematsudenki.com/p-craft/) - [ロケットエンジンC6-3](https://amzn.to/3Aa5djV) - Raspberry Pi Zero WH - [Raspberry Pi Zero用スパイカメラ](https://www.switch-science.com/products/3323) - [BMX055使用9軸センサーモジュール](https://akizukidenshi.com/catalog/g/g113010) - リチウムイオン電池・USB基板 - 3Dプリントによる固定具 ### ロケット選定 前回より機材を積み込みやすくするようにロケットを一回り大きなB型のサイズにしました。(前回はA型でした) ![B型ロケット(組み立て前)](https://camo.elchika.com/f5ceb589264cbafa34c74826cdabfd5c9a7ca376/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f30613439623061322d303637642d343831662d616535342d6662376130303834316537342f32333366393331622d306334372d343365612d626435342d353765363838373531616466/) ![B型ロケット](https://camo.elchika.com/9e85f41adb9e3101fbfd54bed9c9259ffe82697a/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f30613439623061322d303637642d343831662d616535342d6662376130303834316537342f61383863383365372d333961362d343637382d616133312d393137386439336333306666/) ![B型ロケット重量](https://camo.elchika.com/7cdb969fb5443d1424b8403415bf76c4ac8db845/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f30613439623061322d303637642d343831662d616535342d6662376130303834316537342f39373037353166332d656561302d343666372d383736652d666566663337613066316263/) B型のロケットは本来B型エンジン用なのですが、ラズパイなどの重量が増えることを考えてエンジンはC型を使用することにしました。 前回はA型のロケットにB型のエンジンB6-6を使用したのですが、今回はC6-3を使用することにしました。「-」以降の数値が逆噴射までの時間なので今回利用するエンジンは3秒です。より短い時間にすることでパラシュートが開く前に落ちてしまうことを防ぎます。 ![エンジンC6-3重量](https://camo.elchika.com/761b53abda59aae069911a7da4ded340372956ef/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f30613439623061322d303637642d343831662d616535342d6662376130303834316537342f33633736663737332d333737632d346338332d613463342d646136336462303432653135/) 試しにB型ロケット+C型エンジンでラズパイを載せずにどれくらい飛ぶかのテストも行いました。 速いスピードですごく高い位置まで飛んでいき大学の建物を飛び越えてしまいました。 @[youtube](https://www.youtube.com/watch?v=lvtnqSdCs5Y) ### 電池 松隈教授の提案で電池は今回はリチウムイオン電池に昇圧回路を取り付けて使いました。 ![リチウムイオン電池と昇圧回路](https://camo.elchika.com/9603f5dcc36942d01bb0c25f494ac86a3687ade0/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f30613439623061322d303637642d343831662d616535342d6662376130303834316537342f37316361613935622d323531312d343061652d626562632d613034326564326233336131/) 満充電で加速度センサを動作させるプログラムを動かして試してみて約5時間駆動することを確認しています。 最低でもロケットを飛ばす間にバッテリー切れしなければ良いので大丈夫そうです。 ### 9軸センサ 最終的に速度と位置の情報を計算して取得するための9軸センサの配線です。 テストプログラムを実行し正しく値が取得できることを確認しました。 ![9軸センサ](https://camo.elchika.com/599313289e3030a1feaa5297560a586f22bac01b/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f30613439623061322d303637642d343831662d616535342d6662376130303834316537342f63376331303438392d306134352d343539342d623466372d373235613964353034613731/) 取得値からの位置計測の計算方法については松隈教授に教えていただきました。 テスト動作の結果の位置表示は以下のようになり正しく動作することが確認できました。 ![9軸センサの値からの位置計測](https://camo.elchika.com/2306ace816d0fdd71467e2b5982dd04e0c7bccc5/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f30613439623061322d303637642d343831662d616535342d6662376130303834316537342f36616161663031612d623661322d343264372d393531312d303536656461626663323539/) ### スイッチとLED リモート接続だとロケットが発射したときに通信が切れてしまう恐れがあるので、飛ばす間はWiFi接続は(Bluetooeh接続も)行いません。 このためロケット発射時(記録開始時・終了時)には物理スイッチでON/OFFさせる必要があります。 またラズパイは固定具で固定されてしまうため物理ボタンが手の届く位置にくるようにと考えジャンパワイヤの先にスイッチを接続することにしました。また、飛んでいる間の振動でスイッチが意図せず押されたらいけないので、スイッチはONしたあとジャンパワイヤごと抜いてしまい、落ちてきたあとにジャンパワイヤをまた差し込んでOFFにする方式としました。 またこのときに本当にON/OFFになったか確認する手段として、LEDを配線しました。 当初ラズパイ本体についているLEDを使用するよう設計していましたが、ロケットへのラズパイの配置の状態ではLEDランプの状態が位置的に見えなくなることが判明したので、別で取り付けるようにしました。 ![キャプションを入力できます](https://camo.elchika.com/1391bbab2b2776a09fc3b005e463ce607cb7078f/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f30613439623061322d303637642d343831662d616535342d6662376130303834316537342f36366638623961392d323432382d343737322d613838632d616134623139363230373264/) ![キャプションを入力できます](https://camo.elchika.com/a06573d908c5ef8d07c0348c579b4bc3a69af61d/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f30613439623061322d303637642d343831662d616535342d6662376130303834316537342f38613337643938312d623030632d343637382d383163642d373065376337636463666663/) ### 3Dプリント固定具 3D造形が得意な小学生の[fumi](https://sites.google.com/view/donut-pom/home)くんがAutodesk Fusionで設計・自宅3Dプリンタで出力してくれました。 3Dプリンター:Sermoon V1 Pro(Creality Japan) フィラメント:PLA ![ロケット内部パーツ固定部品3Dモデル](https://camo.elchika.com/1ab2d2aeb6ac053988944eb868fc051ac72157d9/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f30613439623061322d303637642d343831662d616535342d6662376130303834316537342f35303333343338352d316235302d343731302d396362322d626631343066633739313537/) ![ロケットへの装着](https://camo.elchika.com/e4fd98ed49eb785ed86afdd8411d0abe32282f03/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f30613439623061322d303637642d343831662d616535342d6662376130303834316537342f62613337303462662d316337302d343930392d393730662d376639326666663636386636/) 固定具はロケットのノーズコーンの位置にちょうどの大きさで入る形になります。ノーズコーンに入れる理由としては、下の部分になるとエンジンに近くなるため燃えてしまう可能性があるためです。 固定具にはラズパイほか部品を載せます。 ![笑顔で固定具にやすりがけをする松隈教授](https://camo.elchika.com/c218681a098773cd574c4b41d5a08bf6feb0cc77/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f30613439623061322d303637642d343831662d616535342d6662376130303834316537342f61653237313564612d336130302d343664622d393239372d636330326637643463316137/) # ソフトウェア ### プログラム [memetan](https://elchika.com/user/memetan/)がプログラムを作成しました。 前回はNode.jsで作ってましたが今回はPythonをレクチャーするという意図もありPythonでプログラムを作成しました。 以下の流れで処理を行っています。 1. (記録モードOFFの場合に)スイッチ入力 ⇒ 記録モードON 1. 記録中を示すLEDを点灯 1. 9軸センサの記録ファイル作成・オープン 1. カメラの動画記録プロセス開始 1. 9軸センサの記録開始…ループ処理で行追加して記録 1. (記録モードONの場合に)スイッチ入力 ⇒ 記録モードOFF 1. 記録中を示すLEDを消灯 1. 9軸センサの記録終了、ファイルクローズ 1. カメラの動画記録プロセス終了 ```python:raspi-rocket.py #!/usr/bin/python3 # -*- coding: utf-8 -*- import smbus import time import RPi.GPIO as GPIO import itertools import subprocess import sys import os import signal GPIO_BTN = 15 GPIO_LED = 18 I2C_BUS = 1 I2C_ACC = 0x19 I2C_GYRO = 0x69 I2C_MAG = 0x13 GPIO.setmode(GPIO.BCM) GPIO.setup(GPIO_BTN, GPIO.IN, pull_up_down=GPIO.PUD_UP) GPIO.setup(GPIO_LED, GPIO.OUT) def led(state): GPIO.output(GPIO_LED, state) def setup_bus(bus): # range (resolution): +-2g bus.write_byte_data(I2C_ACC, 0x0f, 0x03) # bw (bandwidth): 7.81 hz bus.write_byte_data(I2C_ACC, 0x10, 0x08) # disable suspend, sleep_dur: 0.5ms bus.write_byte_data(I2C_ACC, 0x11, 0x00) # range (full scale): 125 degree bus.write_byte_data(I2C_GYRO, 0x0f, 0x04) # bw (odr): 100 hz bus.write_byte_data(I2C_GYRO, 0x10, 0x07) # disable suspend, sleep_dur: 2ms bus.write_byte_data(I2C_GYRO, 0x11, 0x00) data = bus.read_byte_data(I2C_MAG, 0x4b) if (data == 0): # soft reset bus.write_byte_data(I2C_MAG, 0x4b, 0x83) time.sleep(0.5) # normal opmode, data rate (odr): 10 hz bus.write_byte_data(I2C_MAG, 0x4c, 0x00) # enable x, y and z-axis bus.write_byte_data(I2C_MAG, 0x4e, 0x84) # no. of repetitions x and y axis: 9 bus.write_byte_data(I2C_MAG, 0x51, 0x04) # no. of repetitions z-axis: 15 bus.write_byte_data(I2C_MAG, 0x52, 0x16) def read_data(bus): # x_accel lsb, xaccl msb, y_accel lsb, yaccl msb, z_accel lsb, zaccl msb data = bus.read_i2c_block_data(I2C_ACC, 0x02, 6) x_accel = ((data[1] * 256) + (data[0] & 0xf0)) / 16 if x_accel > 2047: x_accel -= 4096 y_accel = ((data[3] * 256) + (data[2] & 0xf0)) / 16 if y_accel > 2047: y_accel -= 4096 z_accel = ((data[5] * 256) + (data[4] & 0xf0)) / 16 if z_accel > 2047: z_accel -= 4096 # x_gyro lsb, xgyro msb, y_gyro lsb, ygyro msb, z_gyro lsb, zgyro msb data = bus.read_i2c_block_data(I2C_MAG, 0x02, 6) x_gyro = data[1] * 256 + data[0] if x_gyro > 32767: x_gyro -= 65536 y_gyro = data[3] * 256 + data[2] if y_gyro > 32767: y_gyro -= 65536 z_gyro = data[5] * 256 + data[4] if z_gyro > 32767: z_gyro -= 65536 # x-axis lsb, x-axis msb, y-axis lsb, y-axis msb, z-axis lsb, z-axis msb data = bus.read_i2c_block_data(I2C_GYRO, 0x42, 6) x_mag = ((data[1] * 256) + (data[0] & 0xf8)) / 8 if x_mag > 4095: x_mag -= 8192 y_mag = ((data[3] * 256) + (data[2] & 0xf8)) / 8 if y_mag > 4095: y_mag -= 8192 z_mag = ((data[5] * 256) + (data[4] & 0xfe)) / 2 if z_mag > 16383: z_mag -= 32768 return ( (x_accel, y_accel, z_accel), (x_gyro, y_gyro, z_gyro), (x_mag, y_mag, z_mag) ) def record_bus_frame(bus, file): data = read_data(bus) file.write(str(time.time_ns())) file.write(",") file.write( ",".join( map( lambda x: str(x), list(itertools.chain.from_iterable(data)) ) ) ) file.write("\n") file.flush() def start_camera_record(ts): vid = subprocess.Popen([ "libcamera-vid", "-t", "0", "--width", "640", "--height", "480", "--codec", "h264", "--framerate", "30", "-o", "-" ], stdout=subprocess.PIPE, stderr=sys.stderr) subprocess.Popen([ "ffmpeg", "-i", "-", "-c", "copy", "recording-" + str(ts) + ".mp4" ], stdin=vid.stdout, stdout=sys.stdout, stderr=sys.stderr) return vid def before_record(): ts = time.time_ns() text_file = open("recording-" + str(ts) + ".txt", "w") text_file.write( "timestamp_ns," "acc_x,acc_y,acc_z," "gyro_x,gyro_y,gyro_z," "mag_x,mag_y,mag_z\n" ) camera = start_camera_record(ts) return (text_file, camera)
def record_tick(data, bus): (text_file) = data
def record_tick(bus, data): text_file, *_ = data
record_bus_frame(bus, text_file) def after_record(data):
(text_file, camera) = data
text_file, camera = data
text_file.close() os.kill(camera.pid, signal.SIGTERM) if __name__ == '__main__': bus = smbus.SMBus(I2C_BUS) setup_bus(bus) record_state = False record_data = None while True: if record_state:
record_tick(record_data, bus)
record_tick(bus, record_data)
toggle = not GPIO.input(15) if not toggle: if not record_state: time.sleep(0.5) continue record_state = not record_state led(record_state) if record_state: record_data = before_record() else: after_record(record_data) while not GPIO.input(15): time.sleep(0.5) ``` 出力される9軸センサのログとなるテキストは、以下のような形式(カンマ区切りCSV)となります。下記はプログラムを実際に動かして記録したものであり、およそ**6ミリ秒**ごとに記録できています。 ``` timestamp_ns,acc_x,acc_y,acc_z,gyro_x,gyro_y,gyro_z,mag_x,mag_y,mag_z 1729777337952932558,-1016.0,94.0,-44.0,-21,-109,45,-79.0,-64.0,-11.0 1729777337958797524,-1017.0,95.0,-44.0,-21,-109,45,-79.0,-64.0,-11.0 1729777337963993494,-1017.0,95.0,-44.0,-39,-19,67,-79.0,-64.0,-11.0 1729777337969275463,-1017.0,95.0,-44.0,-39,-19,67,-79.0,-64.0,-11.0 ``` 動画はMP4コンテナ(H264コーデック)で出力されます。 # ロケット打ち上げ いざロケット打ち上げ!! のはずでしたが、、あいにくの天候で打ち上げることができずラズパイIoTコンテストに間に合うタイミングとなりませんでした。。 打ち上げが行えたら追記します。次回打ち上げは12月を予定しています。 # メンバー紹介 |メンバー|属性|役割| |---|---|---| | [memetan](https://elchika.com/user/memetan/)|17歳男子|ラズパイ全般・プログラム担当| |[fumi](https://sites.google.com/view/donut-pom/home) |小学5年男子|パーツ固定部品の3D設計担当| | ゆう|小学5年男子|ロケット担当| |松隈先生|福岡大学教授|現場監督| |[とり子](https://elchika.com/user/siroitori0413/)|memetanの母|ドキュメント整理| |fumiくんのお父さん||雑用| |ゆうママ|ゆうくんのお母さん|雑用| ![作業の様子](https://camo.elchika.com/35b342ee2feb5c30af27026715432cfb4b9b5075/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f30613439623061322d303637642d343831662d616535342d6662376130303834316537342f36353637663332352d626431652d343532652d393632352d383063303330343630336432/)