ROS2演習2-2021:亀で遊ぼう!
ROS2
2021.05.02
この記事は私が金沢工業大学ロボティクス学科で2020年度後学期に担当したロボットプログラミングⅡをROS2用に変更したものです。第1回でROS2をインストール、設定、動作を確認しました。第2回は、ROSの定番であるタートルシム(turtlesim)でROS2を体験してみましょう。なお、タートルは海亀のことでROSのマスコットで、Turtlesimは亀の2次元シミュレータです。この記事はROS2 Documentation Tutorials の次の記事を改変しています。
参考サイト
インストールと確認
次のコマンドでturtlesimパッケージをインストールする。パッケージはある目的のために作られたソフトウェア一式で一つのディレクトリにまとめられている。turtlesimパッケージは亀の2次元シミュレータに関するソフトウェア一式となっている。
$ sudo apt update
$ sudo apt install ros-foxy-turtlesim
インストールしたパッケージの実行可能ファイルを次のコマンドで確認しよう。
$ ros2 pkg executables turtlesim
無事インストールされていれば次のようにdraw_square、mimic、turtle_teleop_key、turtlesim_nodeの4つの実行可能ファイルが表示される。表示されない場合はもう一度、インストールしてみよう。
実 行
では、端末を開き、次のコマンドでturtlesimを起動しましょう。
$ ros2 run turtlesim turtlesim_node
端末には次のようにturtlesimのノード名/turtlesim、亀の名前 [turtle1]、姿勢(x, y, theta)が表示される。ノードはROSの実行中のプログラムで、Spawningのspawnは魚や蛙などが卵を生む意味であり、コンピュータゲームでキャラクタが登場する意味でも使われる。ここでは亀だけに2つをかけているのでしょうね。
亀を動かそう!
端末を開き、次のコマンドでキー操作により亀を動かしましょう。次のコマンドでrunがノードを実行するコマンドで、turtlesimがパッケージ名、最後のturtle_teleop_keyが実行可能ファイル。
$ ros2 run turtlesim turtle_teleop_key
端末には下図のように表示される。矢印キーで亀を動かすことができる。さっそく、矢印キーを押して亀を動かしてみましょう!亀が動くと動いた軌跡が白線で表示される。
現在、実行されているノードを次のコマンドで確認しよう。ros2 runコマンドで実行したteleop_turtleとturtlesimノードが実行されていることがわかる。
GUI開発ツールrqt
ROSのQTペースのGUI開発ツールrqtをインストールして、さっそく使ってみましょう。
インストール
$ sudo apt update
$ sudo apt install ~nros-foxy-rqt*
起動
端末を開き、次のコマンドを実行する。次の空白のウインドウが開く。
$ rqt
使い方
/killサービス :亀を消す/killサービスを実行しましょう。rqtのメニューPlugins→Services→Service callerをクリックすると色々なサービスが出てくる。その中の[/kill]を選択する。下図のように[Expression]を”turtle1″にして、右上の[Call]をクリックする。亀と軌跡の白線が消える。
/resetサービス :次にリセットする/resetサービスを同様にqtのメニューPlugins→Services→Service callerから選択して実行する。次のようにまた、turtle1が画面中央に現れる。端末には次のようにturtlesimがリセットされたことと、turtle1の姿勢が表示される。
/spawnサービス :新しい亀を生成する/spawnサービスを実行しましょう。同様にして、rqtのメニューPlugins→Services→Service callerを選択して、/spawnサービスを選択する。次のように設定して、[Call]をクリックして新しい亀を誕生させましょう。下図のように中央より少し右下に新しい”kame”が誕生する。
x: 7.0
y: 4.0
theta: 3.14
name: “kame”
/set_penサービス :軌跡の色を変更する/set_penサービスを使ってみよう。[Service]を”/turtle1/set_pen”を選ぶ。turtle1がない場合は[Service]の左の[ボタン]をクリックする。黄色で線の太さ10になるようにExpressionを次のように変更する。では、上で亀を動かしたようにturtle_teleop_keyノードを使って、適当に亀を動かして軌跡の色と太さが変わるのを確認する。
r: 255
g: 255
width: 10
/clearサービス :亀の軌跡を消す。
リマップ
トピック名を付け替えるリマップを使い、先程動かしたturtle_teleop_keyを使って新しく生成したkameを動かしてみましょう。新しい端末を開き次のコマンドを実行する。
$ ros2 run turtlesim turtle_teleop_key --ros-args --remap turtle1/cmd_vel:=kame/cmd_vel
終 了
では、turtlesimを終了させましょう。TurtleSimウインドウの[☓]をクリックするか、起動した端末でCtrl-C(コントロールキーを押しながらCキーを押す)を押すとノードが終了する。turtle_teleop_keyノードを終了させるときは、それを実行した端末でCtrl-Cを押すか、qキーを押す。
今回の記事はこれで終わりです。お疲れ様!
終わり
終わり
").attr(n.scriptAttrs||{}).prop({charset:n.scriptCharset,src:n.url}).on("load error",i=function(e){r.remove(),i=null,e&&t("error"===e.type?404:200,e.type)}),C.head.appendChild(r[0])},abort:function(){i&&i()}}});var Jt,Kt=[],Zt=/(=)\?(?=&|$)|\?\?/;ce.ajaxSetup({jsonp:"callback",jsonpCallback:function(){var e=Kt.pop()||ce.expando+"_"+jt.guid++;return this[e]=!0,e}}),ce.ajaxPrefilter("json jsonp",function(e,t,n){var r,i,o,a=!1!==e.jsonp&&(Zt.test(e.url)?"url":"string"==typeof e.data&&0===(e.contentType||"").indexOf("application/x-www-form-urlencoded")&&Zt.test(e.data)&&"data");if(a||"jsonp"===e.dataTypes[0])return r=e.jsonpCallback=v(e.jsonpCallback)?e.jsonpCallback():e.jsonpCallback,a?e[a]=e[a].replace(Zt,"$1"+r):!1!==e.jsonp&&(e.url+=(At.test(e.url)?"&":"?")+e.jsonp+"="+r),e.converters["script json"]=function(){return o||ce.error(r+" was not called"),o[0]},e.dataTypes[0]="json",i=ie[r],ie[r]=function(){o=arguments},n.always(function(){void 0===i?ce(ie).removeProp(r):ie[r]=i,e[r]&&(e.jsonpCallback=t.jsonpCallback,Kt.push(r)),o&&v(i)&&i(o[0]),o=i=void 0}),"script"}),le.createHTMLDocument=((Jt=C.implementation.createHTMLDocument("").body).innerHTML="
",2===Jt.childNodes.length),ce.parseHTML=function(e,t,n){return"string"!=typeof e?[]:("boolean"==typeof t&&(n=t,t=!1),t||(le.createHTMLDocument?((r=(t=C.implementation.createHTMLDocument("")).createElement("base")).href=C.location.href,t.head.appendChild(r)):t=C),o=!n&&[],(i=w.exec(e))?[t.createElement(i[1])]:(i=Ae([e],t,o),o&&o.length&&ce(o).remove(),ce.merge([],i.childNodes)));var r,i,o},ce.fn.load=function(e,t,n){var r,i,o,a=this,s=e.indexOf(" ");return-1
").append(ce.parseHTML(e)).find(r):e)}).always(n&&function(e,t){a.each(function(){n.apply(this,o||[e.responseText,t,e])})}),this},ce.expr.pseudos.animated=function(t){return ce.grep(ce.timers,function(e){return t===e.elem}).length},ce.offset={setOffset:function(e,t,n){var r,i,o,a,s,u,l=ce.css(e,"position"),c=ce(e),f={};"static"===l&&(e.style.position="relative"),s=c.offset(),o=ce.css(e,"top"),u=ce.css(e,"left"),("absolute"===l||"fixed"===l)&&-1<(o+u).indexOf("auto")?(a=(r=c.position()).top,i=r.left):(a=parseFloat(o)||0,i=parseFloat(u)||0),v(t)&&(t=t.call(e,n,ce.extend({},s))),null!=t.top&&(f.top=t.top-s.top+a),null!=t.left&&(f.left=t.left-s.left+i),"using"in t?t.using.call(e,f):c.css(f)}},ce.fn.extend({offset:function(t){if(arguments.length)return void 0===t?this:this.each(function(e){ce.offset.setOffset(this,t,e)});var e,n,r=this[0];return r?r.getClientRects().length?(e=r.getBoundingClientRect(),n=r.ownerDocument.defaultView,{top:e.top+n.pageYOffset,left:e.left+n.pageXOffset}):{top:0,left:0}:void 0},position:function(){if(this[0]){var e,t,n,r=this[0],i={top:0,left:0};if("fixed"===ce.css(r,"position"))t=r.getBoundingClientRect();else{t=this.offset(),n=r.ownerDocument,e=r.offsetParent||n.documentElement;while(e&&(e===n.body||e===n.documentElement)&&"static"===ce.css(e,"position"))e=e.parentNode;e&&e!==r&&1===e.nodeType&&((i=ce(e).offset()).top+=ce.css(e,"borderTopWidth",!0),i.left+=ce.css(e,"borderLeftWidth",!0))}return{top:t.top-i.top-ce.css(r,"marginTop",!0),left:t.left-i.left-ce.css(r,"marginLeft",!0)}}},offsetParent:function(){return this.map(function(){var e=this.offsetParent;while(e&&"static"===ce.css(e,"position"))e=e.offsetParent;return e||J})}}),ce.each({scrollLeft:"pageXOffset",scrollTop:"pageYOffset"},function(t,i){var o="pageYOffset"===i;ce.fn[t]=function(e){return M(this,function(e,t,n){var r;if(y(e)?r=e:9===e.nodeType&&(r=e.defaultView),void 0===n)return r?r[i]:e[t];r?r.scrollTo(o?r.pageXOffset:n,o?n:r.pageYOffset):e[t]=n},t,e,arguments.length)}}),ce.each(["top","left"],function(e,n){ce.cssHooks[n]=Ye(le.pixelPosition,function(e,t){if(t)return t=Ge(e,n),_e.test(t)?ce(e).position()[n]+"px":t})}),ce.each({Height:"height",Width:"width"},function(a,s){ce.each({padding:"inner"+a,content:s,"":"outer"+a},function(r,o){ce.fn[o]=function(e,t){var n=arguments.length&&(r||"boolean"!=typeof e),i=r||(!0===e||!0===t?"margin":"border");return M(this,function(e,t,n){var r;return y(e)?0===o.indexOf("outer")?e["inner"+a]:e.document.documentElement["client"+a]:9===e.nodeType?(r=e.documentElement,Math.max(e.body["scroll"+a],r["scroll"+a],e.body["offset"+a],r["offset"+a],r["client"+a])):void 0===n?ce.css(e,t,i):ce.style(e,t,n,i)},s,n?e:void 0,n)}})}),ce.each(["ajaxStart","ajaxStop","ajaxComplete","ajaxError","ajaxSuccess","ajaxSend"],function(e,t){ce.fn[t]=function(e){return this.on(t,e)}}),ce.fn.extend({bind:function(e,t,n){return this.on(e,null,t,n)},unbind:function(e,t){return this.off(e,null,t)},delegate:function(e,t,n,r){return this.on(t,e,n,r)},undelegate:function(e,t,n){return 1===arguments.length?this.off(e,"**"):this.off(t,e||"**",n)},hover:function(e,t){return this.on("mouseenter",e).on("mouseleave",t||e)}}),ce.each("blur focus focusin focusout resize scroll click dblclick mousedown mouseup mousemove mouseover mouseout mouseenter mouseleave change select submit keydown keypress keyup contextmenu".split(" "),function(e,n){ce.fn[n]=function(e,t){return 0
タイトルとURLをコピーしました
コメント