*

C言語でEV3開発(28)-EV3の移動距離を計算できるようにしてみた

公開日: : C言語, マインドストーム/EV3, 開発

(テーマ)
C言語でEV3開発(28)-EV3の移動距離を計算できるようにしてみた

(下書き)
どもです。
今回は、Ev3の移動距離の算出についてです。

1.算出方法について
移動距離は、積分により算出します。
即ち、規定時間内での変化量から、その間での移動距離を算出、その値の積算値を移動距離とします。
具体的な計算の順番は、以下の通りです。

(1).各時間ごとのモーターの角度を算出する。
(2).各時間内でのモーターの角度の変化量を算出する。
(3).角度の変化量に対するタイヤの円周を算出する。
(4).算出した円周を積算する。

2.算出方法の実装
上記計算の実装は、下記の通りです。

上記実装では、calc_distance()で角変化量から、対応するタイヤの円周を算出しています。
円周を計算しているのが、

の部分です。
この式は、「2 x π x R x (θ / 360) = π x R x (θ / 180)」です。
この「θ」の部分が、変化量となっています。
また、円周の算出の際に使用するパラメータですが、具体的な値と精度(LSB)は下記のように設定しています。

なお、モーターの角度については、EV3RTのAPIを用いて取得しています。
具体的な実装を、下記に示します。

この設定値から、calc_distance()で算出される円周の精度は0.01(mm)と、少し高精度の値となります。
その後、少し精度を下げて移動方向を考慮した値と、移動方向を考慮していない値を算出しています。

3.実行/実測結果
上記の実装を用いた測定の結果のグラフを、以下に示します。
移動距離の測定結果

グラフを見ると、移動距離の測定値は、おおよそ170cm(1700mm)となっています。
では、実際の様子を動画で録画したので、見てみましょう。

えー、こちらでもおおよそ171~2cm(1710~20mm)となっており、上記の測定結果と一致しています。
これにより、Ev3の移動距離が算出できていることが確認できました。

まとめ
以上、今回のエントリでは、モータの回転角度とEV3に同梱されているタイヤのサイズから移動距離を算出する方法を記載してみました。
また、その方法で算出される移動距離が、実際の測定距離と一致していることを確認しました。
コレにより、積分を用いて測定された移動距離が、実際の値と一致することが証明できました。

以上!
ではっ!!

関連記事

raspberry-pi

QtでRaspberryPi/GUI開発(1):ためしに時計を作ってみた

どもです。 また更新の間隔が空いてしまいました。 久しぶりの更新です。 前回のエントリーで

記事を読む

toppers

C言語でEV3開発(19)-コマンド通信処理でEchoBackしてみた

どもです。 前回は、Bluetoothの接続状態の変化に伴う、状態遷移について書きました。 今回

記事を読む

toppers

C言語でEV3開発(20)-超音波センサと安全状態

どもです。 前回は、BluetoothでPCとEv3を接続してコマンドの送受信について書きました。

記事を読む

toppers

C言語でEV3開発(24)-APIの実行時間を測定してみた。

どもです。 今回、以前から気になっていた、開発環境/プラットフォームであるTOPPERS HRP2

記事を読む

no image

C言語でEV3開発(21)-モーター出力の制御

どもです。 前回は、超音波センサから前方障害物との距離を取得し、それを元に安全状態を判断する、とい

記事を読む

RasPi_Qt

QtでRaspberryPi/GUI開発(5):pigpioを使ってみた

どもです。 RaspberryPiを購入して、LEDも手に入れたのでコレをチカらせてみようと思いま

記事を読む

no image

Windows-QtCreatorでのデバッグ

どもです。 更新の間隔が空いてしまいました。 久しぶりの更新です。 最近、Qtを触り始めま

記事を読む

OpenCvLogo

OpenCvによる画像サイズ変更

どもです。 最近、カメラの動画をOpenCvで加工する、ということに挑戦し始めました。 しか

記事を読む

no image

C言語でEV3開発(14)-opOUTPUT_TIME_SPEEDコマンド

どもです。 今回のエントリーは、モーターを動かすコマンドである「opOUTPUT_TIME_SPE

記事を読む

eclipse_4.3_kepler

elicpse/CDTでのgdbでのソースを追従したデバッグができない問題

どもです。 今回のエントリーは、Eclipse上でgdbを利用したデバッグ中に発生する問題について

記事を読む

Message

メールアドレスが公開されることはありません。 * が付いている欄は必須項目です

CAPTCHA


次のHTML タグと属性が使えます: <a href="" title=""> <abbr title=""> <acronym title=""> <b> <blockquote cite=""> <cite> <code class="" title="" data-url=""> <del datetime=""> <em> <i> <q cite=""> <strike> <strong> <pre class="" title="" data-url=""> <span class="" title="" data-url="">

no image
QtでRaspberryPi/GUI開発(8):pigpioを使用したチャタリング対策の問題の対策

どもです。 だいぶ、間が空いてしまいました。 久しぶりの更新です。

raspberry-pi
QtでRaspberryPi/GUI開発(7):pigpioを使用したチャタリング対策の問題

どもです。 前回のエントリーで、pigpioを使用したチャタリング対

RasPi_Qt
QtでRaspberryPi/GUI開発(6):pigpioを使用したチャタリング対策

どもです。 前回のエントリーで、pigpioを使用したボタンを使用し

RasPi_Qt
QtでRaspberryPi/GUI開発(5):pigpioを使ってみた

どもです。 RaspberryPiを購入して、LEDも手に入れたので

RasPi_Qt
QtでRaspberryPi/GUI開発(4):イベントハンドラの設定

どもです。 前回のエントリーで、「タッチスクリーンを買った」と書きま

→もっと見る

PAGE TOP ↑