RobotCでの基本プログラミング

Transcription

1 2012 年度プロジェクト研究 L E G O 早稲田大学先進理工学部電気 情報生命工学科 内田健康研究室

2 1. はじめに LEGO MINDSTORMS とはレゴ社が MIT( 米国マサチューセッツ工科大学 ) と共同開発した, ロボティクスの先駆的な製品であり,NXT( ロボットの頭脳に相当 ) と呼ばれるマイクロプロセッサが組み込まれたインテリジェントブロックを含むキットである ( 図 1 参照 ).NXT には USB ポート,4つの入力ポート( センサ用 ),3つの出力ポート( モータ用 ),4つのボタン( オレンジ : 決定 /ON, 黒 : クリア, グレー : 左右セレクト ) がある. 図 1:NXT また, サーボモータ ( 図 2 参照 ) と以下に示す各種センサ ( 図 3~6 参照 ) を使うことによって ロボットに複雑な動きをさせることが可能となる. 図 2: サーボモータ タッチセンサ 何かにぶつかって押されたり, 離されたりしたことを感知 することができる. 図 3: タッチセンサ 1

3 光センサ 明暗を感じ取ることができ, 周囲の光の強さの計測, 色の ついた物体の表面が反射する光の強さの計測ができる. 図 4: 光センサ 図 5: 超音波センサ 図 6: 音センサ 超音波センサ物体との距離をセンチメートルで計測できる (0~255± 3cm). 物体へ放った超音波が物体に反射して戻ってくる時間を計測することで距離を読み取る. そのため, 球面を持つもの, 非常に小さいものなどの計測は困難な場合がある. 音センサ音の大きさを感じ取ることができる.90dB までの音圧を計測できる. 90dB: カラオケ室内 40dB: 図書館 80dB: 地下鉄車内 20dB: 木の葉のふれあう音 60dB: 普通の会話 2. NXT の使い方 図 7 に示すような LEGO によるロボットが完成したら, 次は NXT での制御を考える必要がある.NXT で制御するためのプログラミングには MindStorm 用言語である robotc を用いる. また, プログラムの送信には USB ケーブルを使用する. 以下に robotc の使い方を説明する. 図 7: サンプル 2

4 1 USB ケーブルをパソコンと NXT に接続する. デスクトップにある ROBOTC for Mindstorm1.10 アイコン ( 図 8) をダブルクリックし,robotC を起動する. 2 NXT の電源を入れる. 3 図 9のような画面になれば robotc の起動は完了である. 4 上部の robot Download Firmware を選択し,NXT とパソコンの接続を確認する.NXT Bricks currently connected via USB 内のアドレスが図 10 のように表示されていれば接続完了である. 5 プログラムを作成する場合は File New で新しいファイルを作成するか,File Open ですでに作成してあるファイル (filename.c) を開く. 6 プログラムができたら,File Save でファイルを保存する.(Save As で名前指定 ただし, 日本語では保存できないので注意してほしい ) 7 Robot Compile and Download program または F5 を押すことで, コンパイルできる. 図 11 のような画面が表示されればコンパイル成功である.Start ボタンを押すことでプログラムを実行することができる. また,Step Into ボタンでは, プログラムを 1 行ずつ実行ずることができる. 8 7ができた時点でプログラムは NXT に書き込まれているので,USB ケーブルをはずし, パソコンなしで実行することもできる. その場合は,NXT の電源をいれ,My Files Software Files 実行したいファイル名 Run で実行することができる. 図 8:robotC アイコン 図 9:robotC 起動画面 3

5 図 10:PC,NXT 間の接続状況 図 11: プログラム実行画面 3. RobotC での基本プログラミング ここでは robotc での基本的なプログラミングについて述べる. まず,robotC でのプログラムにおいては, 必ず task main( ) を含み以下のような書き方をする. コマンド 1; コマンド 2; コマンドは後ほど紹介する.RobotC では大文字小文字の区別があるので注意が必要である. また, robotc にはすでに登録されているコマンドがいくつかある. 登録されているコマンドは特別な意味を持ち,robotC 上では色が変わるのでプログラムの際に参考にするとよい. 4

6 3.1 モータ制御用コマンド lego を動かすためには, モータを駆動させなければならない. そのため, ここではモータを制御するためのコマンドについて説明する. motor[ 引数 1] = 数値 ; 引数 1 に書かれたモータを数値の速度で動かす. モータは数値を負にすることで逆回転にすることができる. ( 引数 1;motorA,motorB,motorC) wait1msec( 数値 ); 数値 1[msec] だけ同じ動作を繰り返す. ( 数値 : 自然数 ) wait10msec( 数値 ); 数値 10[msec] だけ同じ動作を繰り返す. ( 数値 : 自然数 ) 以上が, モータ制御用のコマンドであるが, 次にここで紹介したコマンドを組み合わせて使用し てみる. なお, この例ではモータを A と B に取り付けた LEGO を想定している. 例 秒間前進して,4 秒間後退するプログラム motor[motora] = 75; motor[motorb] = 75; wait1msec(4000); motor[motora] = -75; motor[motorb] = -75; wait1msec(4000); 5

7 4. 構文用コマンド LEGO に望ましい動きをさせるには, 多少複雑なプログラムを組む必要がある. その際に, 構文用のコマンドが必要になる. 構文用コマンドには, プログラムを短く見やすくするためのコマンドや もし~したら,~しなさい といった if 文 ( もしくは if-else 文 ) や, ~している間は,~ しなさい といった while 文などの条件文などがある. 以下に, 構文用のコマンドのいくつかを挙げる. ここに挙げるコマンドはモータ制御用のコマンドとは異なり, 使用の際には他のコマンドと組み合わせることが重要となる. この章は, 多少理解が難しいので読み飛ばして, 実際に使用する場面で改めて読み直してもよい. // /* */ コメントアウト // 以下に書かれたプログラムは無効になる ( 同じ行でのみ有効 ) /* と */ にはさまれたプログラムは無効になる #define 定数数字定数を数字として使用できるように定義する ( 定数 : 英数字, 一般的には大文字 ) ( 数字 : 自然数 ) 注意 :#define は task の前 ( プログラムの先頭 ) で使用する int 変数 ; 整数型の変数を定義する ( 変数 : 英文字, 一般的には小文字 ) 注意 :int は task の前 (#define がある場合はその次 ) で使用する最大で 32 個まで使用可能 while( 条件文 ) ( ) 内の条件が満たされている間, 内に書かれたコマンドが実行される. ( 条件文 : 等式, 不等式など ) 注意 : 条件文に true( もしくは 1) を入れておくと無限ループになる do while( 条件文 ) 内に書かれたコマンドが実行された後, 条件文が満たされていれば再び 内に書かれたコマンドが実行される. ( 条件文 : 等式, 不等式など ) 6

8 for( 初期化文 ; 継続条件文 ; 再初期化文 ) ( ) 内の継続条件文が真である間は 内に書かれたコマンドが実行される. 一般的に継続条件文は, 初期化文および再初期化文に基づいた条件文となる例 :for(i=0;i<10;i++) until( 条件文 ) ( 条件文 ) が満たされるまで 内に書かれたコマンドが実行される ( 条件文 : 等式, 不等式など ) if( 条件文 1) else if( 条件文 2) else ( ) 内の各条件が満たされていれば if( 条件文 1 または 2) 以下の 内に書かれたコマンドが実行される. 尚,else は省略可能である ( 条件文 : 等式, 不等式など ) break; 条件文を強制的に抜ける場合に使用する構文用のコマンド以外にも演算用の演算子もある. 演算子には,=,+,-,*,/( 代入, 加減乗除 ) や +=,-=,*=,/=( 左辺と右辺を演算した後, 左辺に代入 ) がある. また, 条件文には左辺が右辺に対して ==( 等しい ),<( 小さい ),<=( 小さいか等しい ),>( 大きい ),>=( 大きいか等しい ),!=( 異なる ) があり,&&( かつ ) および ( または ) を組み合わせることもできる. 5. センサ用コマンド 1つの NXT には最大 4つまでセンサを使用できる. 使用できるセンサの種類は前述したタッチ センサ, 光センサ, 超音波センサ, 音センサである. センサを用いるプログラムを書く前には使 用するセンサを設定しなければならない. まずその方法を以下に示す. Robot Mortors and Sensors Setup をクリック 図 12 のようなウィンドウが表示されたら Sensors タブをクリック S1~S4( 入力ポート 1~4) に使用したいセンサに対応する Name と Type を入力して OK をクリック ( 各センサとの対応は次の表のようである ) センサ Name Type タッチセンサ touchsensor Touch 光センサ lightsensor Light Active 超音波センサ sonarsensor SONAR 音センサ soundsensor Sound DB 7

9 図 12:Motrs and Sensor Setup ウィンドウ 例えば, ポート 1 にタッチセンサを, ポート 2 に超音波センサを設定すると, 自動的に #pragma config(sensor, S1, touchsensor, sensortouch) #pragma config(sensor, S2, sonarsensor, sensorsonar) //*!!Code automatically generated by 'ROBOTC' configuration wizard!!*// という文が生成される. これでセンサの設定が完了する. この文を自分で打ち込んで入力すると エラーになるので注意. 以下では各センサを使ったプログラムの例を示す. 例 5.1 直進していき, 障害物にぶつかったときに 1 秒間後退するプログラム 解答 : タッチセンサを使用する #pragma config(sensor, S1, touchsensor, sensortouch) //*!!Code automatically generated by 'ROBOTC' configuration wizard!!*// while(sensorvalue(touchsensor) == 0) motor[motora] = 75; motor[motorb] = 75; motor[motora] = -75; motor[motorb] = -75; wait1msec(1000); 8

10 例 5.2 黒い線上をトレースするプログラム解答 : 光センサを使用し, 地面が黒だったら左へ, 白だったら右へ移動するように設定 #pragma config(sensor, S3, lightsensor, sensorlightactive) //*!!Code automatically generated by 'ROBOTC' configuration wizard!!*// while(true) if(sensorvalue(lightsensor) < 45) // 黒だったら motor[motorb] = 75; // 左旋回 motor[motorc] = 0; else motor[motorb] = 0; motor[motorc] = 75; // 白だったら // 右旋回 例 5.3 直進していき, 障害物の 25cm 手前で停止するプログラム 解答 : 超音波センサを使用する #pragma config(sensor, S1, sonarsensor, sensorsonar) //*!!Code automatically generated by 'ROBOTC' configuration wizard!!*// do motor[motora] = 75; // 前進 motor[motorb] = 75; while(sensorvalue(sonarsensor) > 25); //25cm より大きい間, 繰り返す 9

11 例 5.4 音が鳴るまで直進, 音が鳴ったら 1 秒停止を繰り返すプログラム解答 : 音センサを使用する 音センサを使うときには誤動作防止のため, プログラムの初めに wait1msec(1000); をつける. #pragma config(sensor, S1, soundsensor, sensorsounddb) //*!!Code automatically generated by 'ROBOTC' configuration wizard!!*// wait1msec(1000); // 誤動作防止 while(true) motor[motora] = 75; // 前進 motor[motorb] = 75; if(sensorvalue(soundsensor)>=50) motor[motora] = 0; motor[motorb] = 0; wait1msec(1000); // 停止 // 一秒待つ // 音が鳴ったら 6. 高度なコマンド 今まで扱ってきたコマンドは,LEGO を制御するための基本的なコマンドである.RobotC にはより高度なコマンドが用意されており,LEGO をより複雑に動かすことが可能となっている. ここではそのうちのいくつかを挙げるが, ここに乗せていないコマンドは, 文献 [][] などを参考にされたい. タイマ NXT は 4 つのタイマ ( タイマ番号 T1~T4) を内蔵している. これらのタイマの刻み時間は 1[Msec] である. time 数字 [ タイマ番号 ] = 数値 ; タイマ番号のタイマのカウントを数値に初期化する ( 数字は 1,10,100) ( 例 :time10[t2] = 11; タイマ番号 T2 を 110[Msec] に初期化 ) 10

12 例 6.1 例 3.1 の 4 秒間前進して,4 秒間後退するプログラムをタイマを用いて考える. time100[t1]=0; until(time100[t1]>40) motor[motora]=75; motor[motorb]=75; until(time1 [T1]>8000) motor[motora]=-75; motor[motorb]=-75; // タイマ番号 T1 を 0 に初期化 //T1 が 4 秒より経過するまで // 前進 //8 秒経過するまで // 後退 関数タスクの中でよく出てくるコマンド列 ( いくつかのコマンドの組 ) を, ひとつの関数としてまとめることができる. この関数はコマンドのように使用することができる. void 関数名 ( 引数 ) 内に書かれたコマンドを実行する関数を定義する. 引数の使用も可能. ( 引数 :int 引数名 ) 注意 ; 引数はなくてもよい. 例 6.2 時間を引数として,LEGO が左右に曲がるための関数を作成し, また, 作成した関数を main( ) 内で呼び出して使用するプログラム void right_turn(int time) wait1msec(time); motor[motora]=0; motor[motorb]=40;// 右旋回 wait1msec(time);//(time)msec 待つ motor[motora]=40;// 前進 motor[motorb]=40; void left_turn(int time) wait1msec(3000);//3 秒待つ left_turn(1500);// 関数実行 motor[motora]=40;// 左旋回 right_turn(1500); motor[motorb]=0; 11

13 複数のタスク 今まで扱ってきたプログラムでは 1 つのタスクによって実行してきたが,NXT では複数のタス クを同時に実行させることができる. 複数のタスクを扱う場合の書式は次のようになる. task main( ) コマンド 1; コマンド 2; start task_name2 start task_name3 task task_name2( ) コマンド 3; task task_name3( ) コマンド 4; コマンド 5; main( ) の中で start taskname とすることで, 複数のタスクを実行させることができる.stop taskname とすることでタスクをとめることもできる. 次に例を示す. 例 6.3 複数のタスクを用いた例( ロボットが黒線で囲まれた領域を探索するプログラム ) #pragma config(sensor, S1, lightsensor, StopTask(move); sensorlightactive) motor[motora]=-50; //*!!Code automatically generated by 'ROBOTC' motor[motorb]=-30; configuration wizard!!*// #define THRESHOLD 45 task move() motor[motora]=50; motor[motorb]=50; task check_light() while(sensorvalue(lightsensor)<=thresho ; while(true) StartTask(check_light); StartTask(move); LD) この例では, 前進するプログラム (move( )) とライトセンサを調べ, 後退するプログラム (check_light( )) が同時に動いている.check_light( ) 内で, 条件が満たされると,move( ) のタスク をやめ, 次にロボットが少し回転するようにモータを動かすコマンドを実行する. 12

14 その他のコマンド robotc で用意されているその他のコマンドについて述べる. これらは,LEGO を制御することに 直接関係はないので, 余裕がある場合に使用してみていただきたい. playtone( 数字 1, 数字 2) 数字 1の周波数の音を数字 2 1[Msec] の間鳴らす ( 数字 : 整数 ) 注意 : 周波数は 49 以上に設定すること (48 以下だと音が出ない ) playsound( 引数 1 または数字 ) 引数 1 で指定されたすでに決められている音を鳴らす ( 引数 1:Soundbeep,Downwordtone 等 ) ( 数字 :0~9) nxtdisplaytextline( 数字, 文字, 引数 ) NXT 画面上に数字で行を指定し, 内に書かれた文字を表示させる. 引数を伴う場合は 内に %d を書き, 引数に変数名を入力することで変数を表示させることができる. 7. おわりに 本稿では,NXT の使用方法と robotc を用いた LEGO Mindstorms のプログラミングについて簡単に説明した. より詳しい情報は Web サイトなどにも載っているので必要に応じて各自で調べていただきたい. 13