*

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

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

どもです。
前回は、超音波センサから前方障害物との距離を取得し、それを元に安全状態を判断する、という内容について書きました。
今回は、前回の内容を踏まえて、モーターの出力値を制御する方法について記載します。

1.モーターの設定
モーターを設定、出力値(動作させたい値)を指定、あるいは動作値(現在の出力値)は、やっぱりEV3RTのAPIを使用します。詳細は、コチラに掲載されているので、このエントリーで詳細は記載しません。必要に応じて、参照して下さい。

モーターの特性については、コチラからダウンロードできる資料を参考にして下さい。
また、コチラのサイトも参考になるかも知れませんので、リンクを張っておきます。

2.モーターの目標出力値の指定
モーターを動かす/制御するに当たり、「目標となるモーターの出力値」を指定する必要があります。これは、前回までのエントリーで紹介してきた、Bluetooth通信を用いたコマンド処理により行います。
また、単にモーターの出力を指定するだけではなく、ステアリング比(こんな言葉があるのか?)もコマンドで指定するようにします。
モーターの出力値を指定するためのコマンドは、以下のように設計しました。
SetMotorPower_CmdFrmt
SetSteer_CmdFrmt

3.モーター出力値の算出
コマンドで目標モーター出力値を受信してから実際にモーターにその値を通知するまでは、下記のような順で処理を実行します。

SoftwareArchitecture_DriveMotor

この構成に従ったモーター制御の処理順の実装は、下記の通りです。

※MOTOR_TASK_INTERVALは、10msecを設定しています。

モーター出力確定では、フィードバック制御を用いて、最終的なモーター出力値を算出します。
とくに、フィードバック制御では、PID制御を適用します。
PID制御を適用した理由ですが、以前PID制御を用いたモーター制御について検討したことがあるためです。
<詳しくは、コチラの記事を参照>

具体的には、以下のようにPID制御を実装しています。

※他の処理(モーター出力の最大値の判定)の実装は、このエントリーでは割愛します。

4.Ev3の車に載せて動かしてみた
上記の通りに実装したアプリケーションを使用してEv3を動作させた際の様子が、以下の動画です。

…おかしいですね…。
期待した動きとしては、
「まっすぐ進んで、壁の直前で停止して、バックして、またまっすぐ進んで…」
という動きを繰り返すように動かしたつもりなんですが…。
ハンドル操作(?)を間違えたかな?
それとも、バグ!?
とりあえず、動きをロギングできていないので、原因は闇の中になってしまいました。

今回のエントリー/動画では、上記で実装したPID制御とそれによる車の制御を見せたかったのですが、何やら目的と違うエントリーになってしまいました。無念です。
あ。
前回のエントリーで書いた、超音波センサから取得した前方の障害物との距離から安全状態を判定する、という機能は正しく動作していることだけは確認できました。

次回は、もう少し、まともなエントリーにします。

ではっ!

関連記事

raspberry-pi

libpigpioでのRaspberryPi3とArduinoのSPI通信

どもです。 今回は、libpigpioを使用してRaspberryPi3とArduinoでSPI通

記事を読む

Arduino_Logo

フォトレジスタを使ってみた-Arduinoで光検出

どもです。 今回は、タイトル通り「フォトレジスタの使い方」です。 1.フォトレジスタって何?

記事を読む

raspberry-pi

RaspberryPiで物体検出(2)-白線検出への挑戦(2):輪郭検出による白線検出(実機編)

どもです。 今回は、前回に引き続きOpenCvを用いて道路の白線検出について、です。 1.今

記事を読む

RasPi_Qt

Rasbianの新しいバージョンが出たので、クロス環境を更新してみた。(さらにその後)

どもです。 前回の投稿から、かなり時間が空いてしまいましたが、今回は前回の続きとして、「QtC

記事を読む

Arduino_Logo

ホールセンサーの種類と使い方

どもです。 今回のエントリは、表題にある「ホールセンサー」についてです。 1.「ホールセンサ

記事を読む

toppers

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

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

記事を読む

no image

C言語でEV3開発(15)-TOPPERS/HRP2 EV3 で PID制御

どもです。 今回のエントリーは、コレまでのエントリーから内容を変えて、モーターの動作の制御をします

記事を読む

MY_MFC_LOGO

MFCプログラミング(2):コピー機能の実装

どもです。 前回に引き続き、今回もMFCネタです。 内容は、MFCでの「クリップボードへのデータ

記事を読む

no image

C言語でEV3開発(13)-opOUTPUT_STEP_SPEEDコマンド

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

記事を読む

RasPi_Qt

QtでRaspberryPi/GUI開発(11)-SPI通信をしてみた(その3)

どもです。 えー。 「Qtで…」とか書いておきながら、今回もやっぱりQtは出てきません。 そろ

記事を読む

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="">

source_trail_eye_catch
Sourcetrailを試してみました(2)-Eclipseと連携

どもです。 前回のエントリで、ソースコードを解析するオープンソース「

source_trail_eye_catch
Sourcetrailを試してみました

どもです。 つい最近、ソースコードの解析に役に立ちそうなツールを見つ

SEN0193_0114_eye_catch
土壌湿度センサーの出力値の比較:SEN0114とSEN0193

どもです。 今回も、センサーの性能、測定結果を比較してみた結果につい

ADT7310_DHT11_eye_catch
温度センサの出力値の比較

どもです。 今回は、センサーの性能、測定結果を比較してみたので、それ

DIY_eye_catch
自宅で電子工作(2)-ラズパイのSPIコネクタ自作

どもです。 今回は、電子工作です。 1.何を作った 今回紹介

→もっと見る

PAGE TOP ↑