第1部:OpenRTM-aistおよび
RTコンポーネントプログラミングの概要
(独)産業技術総合研究所
知能システム研究部門
安藤慶昭
1
22
• RT = Robot Technology cf. IT
– ≠Real-time
– 単体のロボットだけでなく、さまざまなロボット技術に基づく機能要素
をも含む (センサ、アクチュエータ, 制御スキーム、アルゴリズム、
etc….)
• RT-Middleware (RTM)
– RT要素のインテグレーションのためのミドルウエア
• RT-Component (RTC)
– RT-Middlewareにおけるソフトウエアの基本単位
RT-Middleware
+ + + + +
RTとは?
産総研版RTミドルウエア
OpenRTM-aist
3
従来のシステムでは…
Joystick
Robot Arm
Joystick
software
互換性のあるインターフェース同士は接続可能
Robot Arm
Control software
4
ロボットによって、インターフェースは色々
互換性が無ければつながらない
Joystick
Humanoid’s Arm
Robot Arm
Joystick
software
Humanoid’s Arm
Control software
Robot Arm
Control software
従来のシステムでは…
5
compatible
arm interfaces
RTミドルウエアは別々に作られた
ソフトウエアモジュール同士を繋ぐ
ための共通インターフェース
を提供する
ソフトウエアの再利用性の向上
RTシステム構築が容易になる
Joystick
Joystick
software
Arm A
Control software
Arm B
Control software
Humanoid’s Arm
Robot Arm
RTミドルウエアでは…
6
RTミドルウエアとRTコンポーネント
6
RT
コンポーネント
フレームワーク
RT
コンポーネント
ロジック
ロジックを箱(フレームワーク)に入れたもの=RTコンポーネント(RTC)
RTミドルウエア
RTC RTC RTC RTC RTC RTC RTC RTC
RTCの実行環境(OSのようなもの)=RTミドルウエア(RTM)
※RTCはネットワーク上に分散可能
・デバイス制御
・制御アルゴリズム
・アプリケーション
etc…
RTコンポーネントの主な機能
7
Inactive Active
Error
アクティビティ・実行コンテキスト
ライフサイクルの管理・コアロジックの実行
共通の状態遷移
センサRTC
複合実行
制御RTC
アクチュエータRTC
エンコーダ
コンポーネント
アクチュエータ
コンポーネント
制御器
ンポーネントコ
1
TI s
TDs
Kp+
-
目標値
位置
位置
電圧
データポート
• データ指向ポート
• 連続的なデータの送受信
• 動的な接続・切断
データ指向通信機能
サーボの例
• 定義可能なインターフェースを持つ
• 内部の詳細な機能にアクセス
– パラメータ取得・設定
– モード切替
– etc…
サービスポート
画像
データ
3Dデプス
データ
ステレオビジョンの例
ステレオビジョン
インターフェース
・モード設定関数
・座標系設定関数
・キャリブレーション
・etc…
サービスポート
ステレオビジョン
コンポーネント
データポート
サービス指向相互作用機能
名前
値
セット名
名前
値
セット名
複数のセットを
動作時に
切り替えて
使用可能
コンフィギュレーション
• パラメータを保持する仕組み
• いくつかのセットを保持可能
• 実行時に動的に変更可能
RTミドルウエアによる分散システム
RTCRTC
RTM
Windows
RTCRTC
RTM
TRON
RTCRTC
RTM
Linux
RTCRTC
RTM
Solaris
RTCRTC
RTM
FreeBSD
RTCRTC
RTM
ARTLinux
RTC
アプリケーション 操作デバイス センサ
ロボットA ロボットB
ロボットC
ネットワーク
RTMにより、
ネットワーク上に
分散するRTCを
OS・言語の壁を
越えて接続する
ことができる。
RTC同士の接続
は、プログラム
実行中に動的に
行うことが出来る。
モジュール化のメリット
• 再利用性の向上
– 同じコンポーネントをいろいろなシステムに使いまわせる
• 選択肢の多様化
– 同じ機能を持つ複数のモジュールを試すことができる
• 柔軟性の向上
– モジュール接続構成かえるだけで様々なシステムを構築
できる
• 信頼性の向上
– モジュール単位でテスト可能なため信頼性が向上する
• 堅牢性の向上
– システムがモジュールで分割されているので、一つの問
題が全体に波及しにくい
RTコンポーネント化のメリット
モジュール化のメリットに加えて
• ソフトウエアパターンを提供
– ロボットに特有のソフトウエアパターンを提供することで、
体系的なシステム構築が可能
• フレームワークの提供
– フレームワークが提供されているので、コアのロジックに
集中できる
• 分散ミドルウエア
– ロボット体内LANやネットワークロボットなど、分散システ
ムを容易に構築可能
11
OMG RTC 標準化
• 2005年9月
RFP: Robot Technology Components
(RTCs) 公開。
• 2006年2月
Initial Response : PIM and PSM for
RTComponent を執筆し提出
提案者:AIST(日)、RTI(米)
• 2006年4月
両者の提案を統合した仕様を提案
• 2006年9月
ABにて承認、事実上の国際標準獲得
FTFが組織され最終文書化開始
• 2007年8月
FTFの最後の投票が終了
• 2007年9月
ABにてFTFの結果を報告、承認
• 2008年4月
OMG RTC標準仕様公式リリース
• 2010年1月
OpenRTM-aist-1.0リリース
OMG RTC ファミリ
12
Name Vendor Feature
OpenRTM-aist AIST C++, Python, Java
OpenRTM.NET SEC .NET(C#,VB,C++/CLI, F#, etc..)
miniRTC, microRTC SEC CAN・ZigBee等を利用した組込用RTC実装
Dependable RTM SEC/AIST 機能安全認証 (IEC61508) capableなRTM実装
RTC CANOpen SIT, CiA CANOpenのためのCiA (Can in automation) における
RTC標準
PALRO 富士ソフト 小型ヒューマノイドのためのC++ PSM 実装
OPRoS ETRI 韓国国家プロジェクトでの実装
GostaiRTC GOSTAI,
THALES
ロボット言語上で動作するC++ PSM実装
H-RTM (仮称) 本田R&D OpenRTM-aist互換、FSM型コンポーネントをサポート
同一標準仕様に基づく多様な実装により
• 実装(製品)の継続性を保証
• 実装間での相互利用がより容易に
Success stories
13
HRP-4: Kawada/AIST
DAQ-Middleware: KEK/J-PARC
KEK: High Energy Accelerator Research Organization
J-PARC: Japan Proton Accelerator Research Complex
HRP-4C: Kawada/AISTTAIZOU: General Robotics Inc. HIRO: Kawada/GRX
RTコンポーネントの開発
14
OpenRTMを使った開発の流れ
15
コンポーネント
の仕様
RtcTemplate
コードの雛型
(C++のクラス)
コアロジック
RTC開発者が
開発したプログ
ラム資産
.so or DLL
雛型にコアロジック
を埋め込む
コンパイル
コード生成
どのようなコンポーネントか?
・名前
・データポート
・サービスポート
・コンフィギュレーション
実行
マネージャ
(ミドルウエア)
フレームワークとコアロジック
ステレオビジョン
ルゴリズムア
コアロジック
右目画像左目画像
デプスマップ
RT ンポーネント
レームワーク
コ
フ
RT ンポーネント
準インターフェース
コ
標
ステレオビジョン
RT ンポーネントコ
RT ンポーネント
準インターフェース
コ
標
右目画像左目画像
デプスマップ
+ =中身は空
RTCフレームワーク+コアロジック=RTコンポーネント
コンポーネントの作成
(Windowsの場合)
17
RTBUilder CMake Visual C++
コンポーネントの
仕様の入力
VCのプロジェクト
ファイルの生成
実装および
VCでコンパイル
実行ファイルの生成
テンプレートコード
の生成
コード例
• 生成されたクラスのメン
バー関数に必要な処理
を記述
• 主要な関数
– onExecute (周期実行)
• 処理
– InPortから読む
– OutPortへ書く
– サービスを呼ぶ
– コンフィギュレーションを
読む
18
コンポーネント内の状態遷移
ActiveDo/RTC::onExecuteはここに入る
(DataFlow型のコンポーネントのとき)
ユーザがあまり
意識しなくてよい部分
コンポーネント開発時に
必要な部分
コールバック関数
コールバック関数 処理
onInitialize 初期化処理
onActivated アクティブ化されるとき1度だけ呼ばれる
onExecute アクティブ状態時に周期的に呼ばれる
onDeactivated 非アクティブ化されるとき1度だけ呼ばれる
onAborting ERROR状態に入る前に1度だけ呼ばれる
onReset resetされる時に1度だけ呼ばれる
onError ERROR状態のときに周期的に呼ばれる
onFinalize 終了時に1度だけ呼ばれる
onStateUpdate onExecuteの後毎回呼ばれる
onRateChanged ExecutionContextのrateが変更されたとき1度だけ呼ばれる
onStartup ExecutionContextが実行を開始するとき1度だけ呼ばれる
onShutdown ExecutionContextが実行を停止するとき1度だけ呼ばれる
RTCの作成=コールバック関数に処理を埋め込む
とりあえずは
この5つの関数
を押さえて
おけばOK
InPort
• InPortのテンプレート第2引数:バ
ッファ
– ユーザ定義のバッファが利用
可能
• InPortのメソッド
– read(): InPort バッファから
バインドされた変数へ最新値
を読み込む
– >> : ある変数へ最新値を読
み込む リングバッファ
バインドされた変数
read()
operator>>
最新値
InPort
Robot
Component
Sensor Data
例
基本的にOutPortと対になる
データポートの型を
同じにする必要あり
OutPort
• OutPortのテンプレート第2引数:
バッファ
– ユーザ定義のバッファが利用
可能
• OutPortのメソッド
– write(): OutPort バッファへ
バインドされた変数の最新値
として書き込む
– >> : ある変数の内容を最新
値としてリングバッファに書き
込む
リングバッファ
バインドされた変数
write()
operator<<
OutPort
最新値
Sensor
Component
Sensor Data
例基本的にInPortと対になる
データポートの型を
同じにする必要あり
データ変数
struct TimedShort
{
Time tm;
short data;
};
struct TimedShortSeq
{
Time tm;
sequence<short> data;
};
• 基本型
– tm:時刻
– data: データそのもの
• シーケンス型
– data[i]: 添え字によるアクセス
– data.length(i): 長さiを確保
– data.length(): 長さを取得
• データを入れるときにはあらかじめ
長さをセットしなければならない。
• CORBAのシーケンス型そのもの
• 今後変更される可能性あり
動作シーケンス
24
ネームサーバ
① 参照を登録 ② 参照を登録
③ 参照を取得
④ ポートを接続
ネットワークインターフェースが
2つある場合の注意
25
ネーム
サーバ
Address A
Address B
こちらのアドレスを基に
CORBA参照を生成
登録はアドレスB側の
ネームサーバ
登録はアドレスB側の
ネームサーバ
RTC-A
RTC-A (Address B)
RTC-A (Address B)
ってどこ?
rtc.confについて
RT Component起動時の登録先NamingServiceや、登録
情報などについて記述するファイル
記述例:
corba.nameservers: localhost:9876
naming.formats: SimpleComponent/%n.rtc
(詳細な記述方法は etc/rtc.conf.sample を参照)
以下のようにすると、コンポーネント起動時に読み込まれ
る
./ConsoleInComp –f rtc.conf
まとめ
• RTミドルウエアの概要
– 背景、目的、利点
– 標準化、適用例
– 過去のプロジェクト、Webページ
• RTコンポーネントの開発
– 開発の流れ
– 動作シーケンス
– コールバック、データポート、rtc.conf
27

130710 01