ラズパイ日記...番外編...母艦新たに

10年ぶりにPCを新たに購入しました。
DELLのキットは、Celeron3G,Mem2G,Win7,SSD128M,HDD1Tというスペックでした。
古いXP時代のマシンなので、upgradeももう限界です。
新しいのに移行して、こちらはLinux化して引き続き使おうと思います。

新たに購入したのはIntel NUCです。
型式は以下のとおりです。

INTEL インテル i5-8259U M.2 SSDに対応 2.5" (9.5mm厚) HDD/SSDも搭載可能 ハイパフォーマンス小型ベアボーンキット BOXNUC8I5BEH

第8世代のCore i5が搭載されてます。見た目も小さいし、Win10へやっと移行します。

 Amazonで購入しこんな感じで到着です。多治見AFCからの発送でした。
本体はこちら
メモリーは16Gです。が、これはNUCにはまりません、デスクトップ用ではなくノート用のもう少し短いタイプだそうです。返品して交換します。「DDR4-2400」というキーワードだけ見てました。

SSDは、こんな小さいのに500GB。SATA3より高速なM.2という規格です。発熱するそうなので冷却用のヒートシンクも購入しました。効果の程はわかりません。 
電源コネクターも必要です。3pin端子の形状からミッキーコネクターと言うそうです。

メモリーを返送交換して来週にはOSインストールできればと思います。

ラズパイ日記...27日目...加速度センサー比較

先日新しく購入した加速度センサーと以前購入したもの2つについて生データ出力を比較しました。

ESP32でもいいのですが、とりあえずPi zeroに繋いであるのでそのまま活用しました。
確認はpythonで2つのセンサーを読み出して、加速度3軸から角度を求める計算式で同じように計算した結果を比較してます。

リアルタイムなグラフ表示を目指してmatplotlib格闘中ですが、いまだ表示出来てません。
古風なやり方ですが、標準出力をファイルに書き出してgnuplotでグラフ化。画面キャプチャしてます。
Pi zeroとの接続は、各センサーこのようにI2C経由でバス接続で。電源はPi zeroの3.3Vで問題ありません。各センサーのSDA,SCL配線を間違わないように。
 
センサー部分を拡大するとこちら。
向かって左側が新しく購入したmpu6050。電源オンでLEDが点灯するので繋がってる感は目視できます。右側がbosch製のbmx055。こちらは電源オンしてもだんまりです。

まずは、センサーを動かさない状態で観測します。左のメモリは左右の傾き度数、横軸は時間です。
 
紫線がmpu6050、緑線がbmx055です。どちらも完全に水平に基板に刺さっているわけではないのとセンサー個体差で若干のオフセットが生じます。
どちらもプラスマイナス1度程度の振れです。ややbmx055の方が振れ幅大きい感じです。もっとbmx055の方が振れ幅が大きいイメージでしたが、比べるとほぼ同じでした。先入観はいけません。

基板を左右に45度動かすとこんな感じです。
0度からのオフセットは置いといて、ほぼ同じような動きです。角度としてはどちらも基板の動きにほぼ追従してます。
引き続き、フィルターに入れた場合の差、リアルタイムなグラフ化を目指したいと思います。

雑誌「トランジスタ技術」2019年7月号はカルマンフィルターの歴史が記事になってます。
カルマンフィルターはアポロ11号が月に行くための軌道計算のために開発されたそうです。その記事の続きで2輪倒立振子の製作が掲載されてます。
グッドなタイミングです。armが乗ったSTM32でC++言語で開発記事でした。タイヤ軸にロータリーエンコーダにかまして、移動距離をフィードバックするような感じです。第1弾GW宿題は倒立までたどり着かなかったので、夏休みの自由研究を目指して第2弾準備中です。

ラズパイ日記...26日目...Pi zero USB-serial他

今日は五月雨にいろいろな内容を

★Pi zeroのUSBをシリアルとして認識させる。
そうすると母艦PCからシリアルポートにて接続可能となります。

参考はこのあたりを
https://blog.goo.ne.jp/lm324/e/60f508289efeb89c9ea024127032649c

https://www.slideshare.net/matoken/lutris?next_slideshow=1

https://learn.adafruit.com/turning-your-raspberry-pi-zero-into-a-usb-gadget/serial-gadget

まとめると、
①/boot/cmdline.txtと/boot/config.txtを変更追加する。
②/dev/ttyGS0.serrvie にリンクを張る
がPi zero側の作業です。
母艦側はOSにあわせてUSB OTGなドライバーをインストールする。

Windows7 + TeraTerm + COM9でPi zeroに接続している様子です。

★ WindowsにX windowを飛ばす
Pi zeroをX window表示にしてそれをWindowsに飛ばします。これで、センサー情報を可視化できるかも。
参考はこのあたりで
http://manabi.science/library/2017/02142121/
WindowsのX clinetはこちら。最近は無料で結構あるようです。
https://sourceforge.net/projects/xming/

TeraTermの設定で、「設定」→「SSH転送」の中で「リモートのXアプリケーション...」をチェックしておくと、新しくポップアップしたウインドウは常にWindowsへ画面を転送してくれます。

★mpu6050のフィルター
bmx055と比較すると、ノイズが大分少ないようです。定常状態で観測すると以下のとおりです。
 
左軸は角度です。
紫線は1軸から計算した角度、緑線は3軸から計算した角度、水色線はさらにLPFを入れたグラフです。静止状態でLPF入れなくてもプラスマイナス1度位しか変動ありません。

X軸で左右に45度ほど傾けて動かしてみると
 線の色は、先ほどと同じです。1軸だけだとたまに異常値が出ますが、3軸から角度を出すとほぼ正確でフィルターも要らない感じです。LPF通すとやはり少し遅延が出ます。
 3軸の値を使って角度計算すると正確かつ速度も十分な感じです。Madgwickフィルターを使わなくても大丈夫な感じです。

センサー出力をスペース区切りで出力させ、gnuplotでグラフ書きました。pythonからgnulotをパイプで繋げて、リアルタイムでグラフ作成も可能なようです。なるほど。
gnuplot久しぶりで懐かしい感じです。大学院時代のグラフ作成にはよく使ってました。

 倒立のセンサーをbmx055からmpu6050へ交換してみようと思います。

ラズパイ日記...25日目...ちょっとPi zeroでmpu6050

このところ、ESP32+micropython環境でずーと頑張ってましたが、micropythonはモジュールに制限があり、大きな配列等は扱えません。

加速度センサー値をMadgwickフィルターを通してみたいのですが、micropythonのモジュールは見つかりませんでした。Pythonでは沢山あるので、一時的にPi zeroでセンサー調べを行いたいと思います。

半年振りにPi zeroを引っ張り出してきました。
センサーとも接続し、値を読み出してみることに。
接続はPi zeroとI2Cなので、3.3V, GND, SCL, SDAの4線を接続すればOKです。
あれ、Linuxではコマンドなんだったけ?と完全に忘れてます。
あと、
%sudo apt-get update
%sudp apt-get upgrade
したら、 30分ほど終りませんでした。

ESP32からPi zeroに環境変えるだけで1日費やしました。
Linuxもコマンド叩いてないと、結構忘れてます。
Pi zeroをシリアル接続する方法。
https://qiita.com/mt08/items/84d3d3053bee92609c2d

このページを参考に、センサーの値を読み出して、角度表示させるまでは出来ました。
http://www.widesnow.com/entry/2015/09/06/211055
 あとは、この値をMadgwickフィルターに渡して、フィルターなしの場合をグラフで比較したいと思います。Linuxでグラフ表示はどうするのか。しばらくは、Pi zeroでがんばってみたいと思います。

ラズパイ日記...24日目...倒立反省+センサー見直し

倒立振子2ヶ月ほど頑張りましたが、いまだ倒立せずです。
いろいろと振り返って、改善ポイントをまとめると以下のとおりです。

本体

  • 重心は車軸の上に。出来るだけ重心上にものを集めて、重量物なモーターや電池は軸下に配置し、モーターが出来るだけ軽い力で制御できるようにする 

センサー

  • 生データのドリフトやばらつきは、しっかりフィルターで除去する
  • あまりフィルターかけすぎると、遅延が発生するので精度と応答速度のバランスが重要

モーター

  • DCモーターは、電圧をかけてからトルクが出るまでに時間を要する(200-300ms)
  • 電池の状態は、常に気にしないと充電したてと放電してからでは制御パラメータが異なる

制御プログラム 

  • 単一ループでセンサー読み取り→モーター駆動するとモーター駆動間の待ち時間に処理が止まる。センサー読み取りとフィルター処理部分とモーター駆動処理は別のタスクにした方がうまくいくかも(未確認)
と、これまでの反省点です。半日で倒立というblog記事ありますが「倒立は一日にして立たず」が実感です。

まずは、センサーの見直しというか、他のセンサーはどんな動きなのかというのを調べるために2つ新たに購入しました。


左はKXSD9-2050(秋月で720円)、右はMPU-6050(Amazonで320円)とAmazonの方がお安いですが、カメラやビデオの手ブレ補正に使われてるらしく数が出ているものだと思います。

まずは端子を半田付けします。


接続はI2CなのでVCC,GNDとSDA,SCLの4線です。レギュレーター内臓なので、VCCは5V,3.3VいずれでもOKです。
まずはMPU6050から動作確認のためESP32と接続します。
 
micropythonのライブラリを探して、出力されているところまでは確認しました。
あとは、師匠に教えてもらったMadgwickフィルターを調べて、LPFと動きの違いを検証してみたいと思います。

ラズパイ日記...23日目...重心を下げて軸上に

本体の低重心化です。基板等はゴムバンドで止めているだけなので、ぱっと外せます。

付け替えるのが面倒なのはギヤボックスです。ユニバーサル基板と微妙に大きさがネジ穴の位置が違うため、切欠きを新たに。
 ギヤボックスと電池を床下において、軸上に重心センターがくるべく調整します。
重心を合わせるために計量です。
ギヤボックスは、82g。
 
電池ケースは、90g。
 
 差は8gです。これは後で微調整。
あとは、床上に配線の取り回しを考えて基板を配置します。
DCモーターへの配線が短かったので、長いものに交換します。
 
 動作確認して再度パラメータ探しの旅です。高重心の時に比べると、倒立しそうな感じですが、なかなかじっとしません。

師匠から重心とDCモーターの残電池容量の確認、モーターコントロールをタイマー割り込みをやってみるとよいとのアドバイスをもらいました。
電池は再度充電、重心はクリップで微調整しほぼ車輪軸上になりました。

この1週間だいぶ戯れましたが、今日のところまでで「倒立」せずです。(とほほ)

しかし、micropythonの勉強や、9軸センサーの補正方法、DCモーターの特性等いろいろと勉強になりました。頭で理解したつもりでも、実際はいろいろとうまくいきません。
あと、タイマー割り込みはまだ勉強中です。これも取り入れていきたいと思います。

残り少ないGWですが、最後に「倒立」するのか?

ラズパイ日記...22日目...倒立調整中→重心を低く

倒立振子の母体は完成し、センサー出力とDCモーターは連動することまでは確認できました。ただ、このままでは倒立しません。センサーとモーター出力を調整する必要があります。

とりあえず、センサー出力を可視化して眺めてみます。

ジャイロの出力が急峻なのでLPFで滑らかに、加速度は出力をそのまま使うのではなく、角度情報に変換して活用します。

加速度センサーから角度への変換はこちらを参考に
https://garchiving.com/angle-from-acceleration/

micropythonでCtrl-Cを掴んで、終了処理をする方法については以下を。これをいれないとモーターが動きっぱなしになります。
https://qiita.com/keisuke-nakata/items/e77b123d75d4b52aac77

当初のセンサー出力です。センサー出力そのままです。

 青線が加速度、赤線がジャイロの出力です。傾きとジャイロの方向は合っています。
このジャイロ出力にLPFを、加速度はatan2(dx,dy)を計算すると角度になるということで、その結果を入れたのがこちら。
ジャイロ出力がマイルドになり、加速度も角度に変換したので、滑らかに角度を表してます。
これで、加速度とジャイロの係数、LPFの係数、モーターの駆動時間等を変化させながら、最適値を探りましたが、最適値にはたどり着かずです。

これで最適値を探す旅もつらい感じなので、まずはボディーの低重心化をして再挑戦したいと思います。
ざくっとは、こんな感じです。結構重心は下がりました。
BEFORE(高重心版)
AFTER(低重心版)

ラズパイ日記...esp32(arduino)+mpu6050

# esp32で6軸センサー読み出し esp32で6軸センサーを読み出し、値をグラフ表示して動作を確認します。 ## 準備 ハード的な接続は、センサーが3.3V駆動できるので、3.3VとGNDの2線で電源供給します。I2C用にSDAとSCLのデータ線が必要ですが、esp...