LoginSignup
11
7

(番外編)Raspberry Piでcm精度のRTK-GPS~2019年のあゆみ

Last updated at Posted at 2020-01-01

はじめに

この記事は私が2019年に苦闘した記録ですが技術的に有用な情報はあまりないのであしからず。

(2020.2.6)追記
なんとかフィールドテストまでたどり着きました。実作業で使えるかはこれからです。

ここまでの歩み(2018年)

最初の記事に書いたようにUblox-M8Pを手にし初めてRTKをしたのが2年前。4ヶ月ぐらいかけて直進ガイダンスを作り春の田植作業に使用。有用性を感じてQiitaに投稿したのが6月。秋の農繁期を終えて11月にFOSS4Gという地図好きの集まりがあると知り東京までいって刺激を受けてくる。(この頃からTwitter始める)
 ボタン一つでAB基準線を呼び出したり自分の使いたい機能を付けて満足しつつあるときに、
AgOpenGPS (以下AOG)というソフトをカナダの農家が作成してオープンソースで公開していることを知る。自作でモーターを取り付け自動操舵までやってる!!

2019年1月~3月

自作ガイダンスでトラクター作業をしつつ [帽子にLEDを付けてみたり] (https://twitter.com/mnlt18/status/1093017845347151872) , 傾斜補正をつけてみたり しているが自動操舵の方は手つかず。
巷ではF9Pを手にした方の報告が上がるようになり指をくわえてみている。

4月~5月

春の農繁期。自作の他にAOGも併用して使い方がだんだんわかってくる。セクションコントロール や、GPSでお絵かきなど。
忙しさの勢いでF9Pを一つだけ買うがまだ2周波の威力を試せず

6月~8月

F9Pの使い方を覚えたり,
自分用のNtripCasterを立ち上げたり
時間ができ、またAOGのフォーラムを読んでいると自動操舵用のPCBの設計まで公開していた。
そのなかからESP32,IMU,モータードライバ,A/Dコンバータ、Ethernet,リレー,F9Pコネクタ…全部乗せの基板のガーバーデータが公開されているのを知る

当時fusionpcbで基板製造+部品実装5枚で実装代無料のキャンペーンが行われていたこともあり、無謀にも初のPCBで表面実装部品点数120以上/枚を発注

9月~10月

結局発注から到着するまで一月半かかり秋の農繁期に入ってしまったので基板は手つかずのまま。
コンバインにガイダンスをつけて使ってみたら中割作業に役立った
また降水予測機能を付けて助かったり騙されたり
台風で稲刈りが出来ない日に試しにコンバインの自動操舵を付けてみたら意外にスムーズに動いた!

11月~12月

稲刈りも終わりいよいよトラクタの自動操舵に手を付ける。
ざっくりとAOGの仕組みを説明すると

1. GPS受信機からNMEAを受信(AOGからRTCMを送信する機能もあり)
2. AutosteerPCBからRoll,Headingを受信 
3. AOG本体はWindowsPC上で動くC#で書かれていて、ステアリングの目標角を計算しAutosteerPCBに送信。
4. AutosteerPCB上のAruduinoまたはESP32 で受け取った**目標角(steerAngleSetPoint)と、ポテンショメータとA/Dコンバータで計測した前輪の操舵角(steerAngleActual)**の差がゼロになるようにPID制御(実際はP制御のみ)でモータードライバのPWM値を決めハンドルに取り付けたDCモーターを回す。

1.2.4.を一つのESP32 で動かそうとマルチコアだとか非同期UDP通信とか(AsyncUDP)とか、入門書には書いてないようなものを訳も分からずコピペで動かそうとする。一瞬うごいた気がしたが安定には程遠く数十秒で再起動を繰り返し原因がつかめず。

 それはひとまず置いおいて、並行してモーター取り付けのハードウェアにも取り掛かる。とりあえず置いてみただけでは強度的にも精度的にも使い物にならないので海外のサイトを参考に探していたら、ドイツのフォーラムで3Dプリンタ用のギア図面を公開している人がいる!
 
 3DCADソフトFusion360の基本的な使い方を覚えて(つくづくフリーソフトが好きだな)3万以下の3DプリンターEnder-3 Proを購入。
ABS樹脂の層割れや反りなど初心者の失敗を一通り経験したあと、PETG樹脂で ハードは結構うまく出来上がった!

 そして現時点。AOG-ESP(wifi_UDP)の通信部のエラーがまだ未解決。ならばと自作ラズパイとESPにUSB接続で動かせないか、と考えてみたがこれも制御アルゴリズムを一から勉強しないと難しそう

 もうひとつの手はせっかく作ったESPの基板を諦めてAruduinoではじめから作り直す。こちらはAOGの作者本人が作ったのでスケッチも改変せずにそのままで動くはず(?)

さて2020年には完成するでしょうか?  ... to be continued

2020年1月~

 上の記事書いて読み直していると気づいた点が問題はwifi_UDPの通信部が問題ならばシリアル(USB)でAOGと接続すればよいのでは?
 ArduinoNANOを使ったスケッチではUSBとEthernet_UDP接続の2つの方法が選べるようになっている。これをESP32に移植。int型がArduinoでは16bit,ESP32では32bitであること。millis()の戻り値をunsigned longで受け取ることなどにつまずきつつなんとか完成。
 さらにBluetoothSerialライブラリを使えばタブレットのUSBポートを使わずに無線で接続できた(たまに切れることもあるが)
https://github.com/mnltake/AutosteerPCBv_esp32

 またモーターも2個搭載することでトルク不足による発熱も抑えられ連続運転も可能になった。
https://github.com/mnltake/Steer-motor-3D-Print-for-ISEKI/
路上での試運転は成功したのでいよいよ圃場作業での実戦に挑む!

11
7
7

Register as a new user and use Qiita more conveniently

  1. You get articles that match your needs
  2. You can efficiently read back useful information
  3. You can use dark theme
What you can do with signing up
11
7