Download
latest Releases : 2.0.0-RELESE
2.0.0-RELESE | Download page |
Number of Projects
RT-Component | 153.5 |
RT-Middleware | 35 |
Tools | 22 |
Documentation | 2 |
Choreonoid
Motion editor/Dynamics simulator
OpenHRP3
Dynamics simulator
OpenRTP
Integrated Development Platform
AIST RTC collection
RT-Components collection by AIST
TORK
Tokyo Opensource Robotics Association
DAQ-Middleware
Middleware for DAQ (Data Aquisition) by KEK
初心者用の課題
ひな形コードの作成
新規作成した RTC を RaspberryPiMouseRTC と接続して制御するまでの手順を説明します。
まずは Windows、Ubuntu上で このページ の手順に従って RTC を作成してください。 RTC の仕様は以下のように入力します。
この RTC ではコンフィギュレーションパラメーター forward_velocity、rotate_velocity に入力した速度を target_velocity から RaspberryPiMouseRTC に送信します。 さらに distance_sensor で受信した距離センサーの計測値から、物体をある程度まで近づけると前進できなくなるようにします。
※RTC は Raspberry Pi 上で動作させることを前提にしていますが、動作確認や講習会での利用には Windows や Ubuntu上で動作させても問題はないので、その場合はコードの編集をする前に CMake で Visual Studio、もしくは Code::Blocks のプロジェクトを生成しておくことをお勧めします。CMake でプロジェクト生成からビルドまでの手順は以下のページに記載してあります。
プロジェクトが生成できたら Visual Studio の場合は RasPiMouseSampleCPP.sln、Code::Blocks の場合は RasPiMouseSampleCPP.cbp を開いてソースコードの編集を行ってください。
コードの編集
まずは onExecute 関数を編集します。
以下は forward_velocity、rotate_velocity の値を target_velocity から送信するコードです。
C++(src/RasPiMouseSampleCPP.cpp)
Python(RasPiMouseSamplePy.py)
一応、非アクティブ状態の時は停止するように onDeactivated で速度0を送信するようにします。
C++(src/RasPiMouseSampleCPP.cpp)
Python(RasPiMouseSamplePy.py)
共通インターフェース仕様書 では進行方向をX軸正方向にしているため、Velocity2D型の vx に直進速度、va に回転速度を入力します。
Python ではさらにコンストラクタの以下の部分を修正してください。
Python(RasPiMouseSamplePy.py)
※ここまでの作業だけでもラズパイマウスの動作は可能なので、面倒ならば以下の手順は飛ばしてもらっても大丈夫です。
次に距離センサーで物体を検知した場合に停止する処理を書きます。 ここで distance_sensorにonExecute が呼び出された時に新規に受信したデータが必ず存在するとは限らないので、距離センサーのデータを一時的に格納しておく変数を宣言しておきます。
C++(include/RasPiMouseSampleCPP/RasPiMouseSampleCPP.h)
Python(RasPiMouseSamplePy.py)
次に onExecute に距離センサーが物体を検知した場合に停止する処理を追加します。
C++(src/RasPiMouseSampleCPP.cpp)
Python(RasPiMouseSamplePy.py)
一応ですが、onActivate 関数で m_last_sensor_data を0に設定するようにします。
C++(src/RasPiMouseSampleCPP.cpp)
Python(RasPiMouseSamplePy.py)
Raspbianにdoxygen がインストールされていない場合は CMakeLists.txt の以下の部分を修正してください。
編集が完了したら Raspberry Pi にソースコードを転送してください。 Tera Term を使用している場合はZIP等に圧縮して転送してから Raspberry Pi 側で解凍してください。
※Windows、Ubuntuで動作させる場合は転送しないでください。
ビルド
ソースコードの編集が終了したら C++ の場合はビルドを行います。
※Visual Studio、もしくは Code::Blocks で編集している場合は GUI 上の操作でビルドを行ってください。
ソースコードのあるディレクトリーに移動して以下のコマンドを入力すればビルドできます。
cmakeがインストールされていない場合は以下のコマンドを入力してください。
RTC 起動
ビルドが完了したら RTC を起動します。 以下のコマンドで起動できます。
C++
Python
※Windows上で RTC を起動する場合は RasPiMouseSampleCPPComp.exe(RasPiMouseSamplePy.py)をダブルクリックしてください。
次に RaspberryPiMouseRTC を起動させます。 以下のコマンドで起動してください。
動作確認
まずは動作確認のためにデータポートの接続を行います。 Windows側で RTシステムエディタを起動してください。 最初に Raspberry Pi で起動しているネームサーバーを RTシステムエディタのビューに追加します。 [ネームサーバー追加] ボタンをクリックして Raspberry Pi の IPアドレスを入力してください。
Raspberry Pi の IPアドレスは以下のコマンドで確認できます。
ネームサーバーを追加したらデータポートを以下のように接続してください。
そして RTC をアクティブ化すると動作を開始します。 動作開始前にモーター電源スイッチはONにしておいてください。
まずは RasPiMouseSampleCPP(RasPiMouseSamplePy) のコンフィギュレーションパラメーターを変更する事でラズパイマウスを操作してみます。
RTシステムエディタで RasPiMouseSampleCPP0(RasPiMouseSamplePy0) を選択して、Configuration View の編集を選択してください。
すると以下のウインドウが起動します。
forward_velocity と rotate_velocity のスライダーによりラズパイマウスを操作できます。
次に距離センサーが障害物を検知した場合に停止するかを確認してみます。 forward_velocity を0.2等に設定して前進させてください。その状態で障害物を進行方向に置いて動作を確認してください。
停止した場合は forward_velocity を0未満に設定して後退すれば前進できるようになります。
参考までにですが、/dev/rtlightsensor0のデバイスファイルから取得できる数値とセンサーまでの距離との関係は以下のようになっています。
手作業で測った数値なので、あくまで参考までに利用してください。
今回作成したサンプルコードは ここ から入手できます。
応用(中級者用課題)
ここからはさらに距離センサーで計測した距離が一定以下になった場合に回転のより障害物を回避する動作を実装します。 まず、ラズパイマウスのセンサーは以下のように取り付けられてあります。
このため、右側のセンサーで計測した距離が一定以下の場合は左方向へ、左側のセンサーで計測した距離が一定以下の場合は右方向へ回転運動することで回避運動を行います。
コンフィギュレーションパラメーター
新たに以下のコンフィギュレーションパラメーターを設定します。 前進する速度が stop_velocity 以上で、さらにセンサーの値が sensor_limit 以下の場合に回避運動を行います。
onExecute 関数の実装
onExecute 関数の実装を以下のように実装します。 ここで 動作確認の項目 で述べたように距離センサーは距離が短くなるほど大きな値を出力するので注意してください。
RTシステムの保存について
RTシステムの保存については RTシステムエディタ上でもできるのですが、rtshell により RTシステムの復元を自動化することができます。 RTシステムエディタでポートの接続、コンフィギュレーションパラメーターを設定後、rtcryo コマンドを実行してください。
これで、testSystem.rtsys というファイルにRTシステムの情報が保存されます。
ただし今回の課題のように複数のネームサーバーに登録された RTC を使用する場合、以下のように複数のネームサーバーを指定する必要があります。
保存した RTシステムを復元するためには rtresurrect コマンドを使用します。
RTC をアクティブ化するには rtstart コマンドを使用します。
RTC の非アクティブ化は rtstop コマンドを使用します。
ポートを切断する場合は rtteardown コマンドを使用します。
注意点として、RTC はデフォルトの設定だとネームサーバーにはホスト名. host_cxt 以下に登録されます。 ホスト名は環境によって違うので、この手順で RTシステムを保存しても他の環境では再現できないという事になります。 このため、rtc.conf を編集してネームサーバーの Root 直下に登録するようにすると、他の環境でも RTシステムの復元ができるようになります。