[[2014a/Member]] #contents *課題1について [#q7f3660d] **メンバー紹介 [#j1385904] 今回は、私一人のみでなく、二人で課題に取り組んだ。ここに参加メンバーを記しておく。 ・kiyomizu(私) ・suiden **課題1の内容 [#pe113d30] まずは、何をすればよいのか課題1の内容(ルール)を確認したいと思う。 1.スタート地点から出発し、黒い線にそって動く。 2.一つ目の十字の交差点と二つめの十字の交差点の間に置かれたピンポン玉をつかむ。 3.さらに黒線に沿って動いてゴール地点を目指す。 4.ゴールに向けてピンポン玉をシュートする。 (注1*なお、この課題は二人で同一のロボットを使い、お互いに逆の経路をたどるという課題である。ちなみに、私はスタートからゴール担当。) (注2*私達はピンポン玉ではなく、備え付けのボールを使用することになっていた。扱う玉の大きさが大きさがロボットの構造に影響を大きく与えたのでここに記しておく。) #ref(./roboコース課題1,50%,課題1のコース) これを見て、やるべきことを考えたところ、大雑把に2段階の作業が必要であることがわかった。 1つ目、今回の課題をクリアするための能力を持ったロボットを作る。2つ目、それを要求通りに動かすプログラムを作る。以下、それらについて書きたいと思う。 *ロボットの制作 [#a720d0bc] **課題1をクリアするための能力を持ったロボットを作る [#mf31951d] 課題1をクリアするための能力とは何であろうか。3つの能力がこのロボットには必要であると私は考えた。(プログラムで身につけられる能力は除外し、最初から備え付けにしておく必要のある能力のみここに挙げた。) ・ボールを保持する能力 ・ボールをシュートする能力 ・黒い線に沿って進む能力 <ボールを保持する能力>…開発当初は前の空いたコの字型の"囲い"をロボットの前につけておき、ロボットが進みながら、その中へボールを入れゴールへ持っていくという構造(図1)が検討されたが、返しをつけるなど工夫をしたところでボールを保持したままゴールへ行く確率が低いことに加え、ボールを入れる際に囲い自身にボールが当たってはじかれてしまいボールをそもそも保持できない可能性がそこそこあるなどの理由で却下された。この欠点を解決し得る構造(それもシュートする機能も兼ねた素晴らしいもの)ができたのでそれを採用した。ボールをシュートする能力と説明がかぶるのでそちらで説明する。 <ボールをシュートする能力>…初期では、囲いを使うという構造に合わせそれを妨害せず、まっすぐ前にボールを飛ばすことのできるもの(図2)が考えられ、ブロックの組み合わせでできた"足"をモーターで前に回し、シュートする構造が考案された。(ちなみに、この構造は横から見るとサッカー選手の足の動作に見えなくもないもので、私のお気に入りであった。)しかし、これも囲いの構造のとりやめに伴い没になった。では、どのようにしたのか。シュートするための構造は、どのようにボールを保持しているのかによってある程度の制約を受ける。そこで、できるだけ高確率でボールを保持する構造とそれに適したシュートをする構造をつくりあげる必要性が出てきた。 これらの条件をたった1つの構造でクリアしているのが今回私達が採用した"二重バー構造"(図3)である。(注3)二重バー構造とは何か。一言でいうと、前後に二つの棒(バー)を配置した"閉じた枠"を、先に述べた足へと取り付けた構造である。ボールを捕まえるときは、これを振り下ろしボールを枠の中に閉じ込める。この時、バーがボールにあたりボールが若干はねてしまうが絶妙な高さで調整された前後のバーと横への取りこぼし防止バンパーがボールの脱出を許さない。このバンパーとバーの位置の調整が優れており、ほぼ100%でボールを捕獲する。(今回のこの調整はセット付属のボール専用チューンなのでピンポン玉では多少成功率が落ちることになる。先ほど"注2"でボールの種類について特に指定したのはこのことによる。)シュートをするときには、この足を上へと振り上げ枠の後部についたバーがボールをはじき前へととばす。この時、かちんと小気味よい音がなり、見ている方も大変気持ちがよい。さらに、先ほどの"足"構造と同じく、シュート動作がサッカー選手の足に心なしか見えるという、ビジュアル面にも優れた素晴らしい構造である。このような素晴らしい構造の案をだしてくれたsuiden氏にこの場を借りてお礼を申し上げたい。 (注3*今回のこの構造は私ではなく相方のsuiden氏が考案したものであり、私に命名権があるわけではないが便宜的にこのように名づけた。各人留意されたし。) <黒い線に沿って進む能力>…この課題の直前に"ライントレース"という機能を持ったロボットを作っていたのでそれを踏襲した。ライントレースとは、ある線に沿って進むという機能のことで、光センサーを用い、検知した明るさによって進む方向を決めるというものである。(今回は、センサーが黒い線の左側の境界をたどるようにしたのだが、詳しくはプログラムの制作で説明する。)したがって、光センサーを取り付ける必要がある。が、問題はどこに取り付けるのかということである。センサーと車輪の位置が離れすぎているとセンサーが明るさを読み取ってから車輪が回ったとき大幅に黒い線からずれてしまうことがありえるし、課題1のコースは急カーブが多いのであまり大柄なロボットを作ってしまうとターンが難しいなど条件があり、ほどほどに車輪に近い位置に取り付けることが必要だった。また、以前のものをできるだけ流用するため、つまりなるべくプログラムを変更することがないようにすることが必要で、光センサーの高さ、角度もあまり変えないように配置した。 *プログラムの制作 [#c696ddba] **課題1をクリアするために必要なプログラムを組む [#c8e3a9d8] 題名の通り、課題1をクリアするために必要なプログラムを組む。具体的には、先のロボット製作の段階で盛り込んだ機能を使えるようにプログラムを組んでいく。よって、必要なプログラムは先ほどと同じ3つである。 ・ボールを保持するプログラム ・ボールをシュートするプログラム ・黒い線に沿って進むプログラム <ボールを保持するプログラム>…今回の私たちのロボットでは、ボールを保持することは枠の中へ入れることですでに達成していることになるので、ボールを枠の中へ入れることをプログラミングすればよいのである。有り体にいうと、二重バー構造のついた足を下ろせばよい。よって、モーターを前回転させるというプログラムを組むことにした。その際、ただの前回転ではなくモーターの回転角を決めることのできるものを使うことにした。またその下ろすタイミングは時間でとることにした。 <ボールをシュートするプログラム>…ボールを保持するプログラムの真逆である。なので、上の逆 つまりモ−ターを後ろ回転させることにした。上げるタイミングは交差点でカウントし何個目かで測ることにした。(最後のゴール地点はT字であるが、このプログラミングだと交差点の判定をするため。交差点の判定の詳細は下にて。) <黒い線に沿って進むプログラム>…今回の一番の鬼門である。センサーが黒い線の左側の境界をたどるようにした。具体的にどうしたのかを説明すると、あらかじめロボットについている明るさの度合いを調べる機能で黒い線の上、紙の白い部分、それらの境界の明るさを測定し、黒い線の上の数値が出たら進路を左へ、紙の白い部分だったら進路を右へ、紙の白い部分だったら進路はそのままとなるようにプログラムした。(図4)が、その判定をする値を決めるのが難しく、ちょうどよい値を模索しなくてはならない。また、モーターの出力が高いと軌道修正する前にはるかかなたへ行ってしまうのでそのような調整もしなくてはならなかった。加えて、この課題のコースには交差点が存在しそのままライントレースしていると悲しかな正規ルートから抜け出て行ってしまうので、交差点の判別も必要である。この問題はロボットの判定回数を利用することで解決した。どういうことかというと、ある一定の数を設定しておきロボットが異常な数(最初に設定したある数)以上に横に曲がる判定をロボットがした場合、一時的にライントレースを中断し直進させ、その後またライントレースを開始するという方法である。 **実際に組んだプログラム [#sc93f4f9] これらをもとに実際に組んだプログラムがこれである。ざっと流れを説明すると、始めに今回使う様々な数などの定義、次に使う関数の定義(kiyomizuオリジナルの関数)、続いて開始数秒の動作、それからボールをとるまでの動作、それからゴールにつくまでの動作、シュートを打つ動作となっている。 ・数などの定義 #define THRESHOLD 50 //しきい値(明るさ判定でつかう値)// #define SPEED 75 //シュート動作などでのモーターの出力(%)// #define SPEED_T 40 //ターン時のモーターの出力(%)// #define SPEED_S 30 //直進時のモーターの出力(%)// #define STEP 1 //明るさ判定の頻度 (x回/1000s)// #define CROSS_TIME 200 //交差点を直進する際にかける時間// #define SHOOT_TIME 1000 //シュート動作にかける時間// #define nMAX 300 //交差点判定での異常な数の目安// #define START_DASH 1000 //スタート直後の直進する動作にかける時間// #define TRACE_TIME 8000 //スタート直後の直進の後のライントレース(最初の交差点の手前まで)にかける時間// #define short_break Off(OUT_BC); Wait(1000); //判定の後、交差点をわたるまでの微妙な時間調整// #define CATCH_TIMING 30000 //動作開始からボールをつかむまでにかける時間// ・使う関数の定義 sub start_go() //スタート直後の直進する動作の関数の定義// { OnFwd(OUT_BC,SPEED_S); Wait(START_DASH); Off(OUT_BC); } sub go_forward() //前に進む動作の定義// { OnFwd(OUT_BC,SPEED_S); } sub turn_left0() //左に曲がる動作の定義// { OnFwd(OUT_C,-SPEED_T); } sub turn_left1() //その場で左に旋回する動作の定義// { OnFwd(OUT_B,SPEED_T); OnRev(OUT_C,SPEED_T); } sub turn_right0() //右に曲がる動作の定義// { OnFwd(OUT_B,-SPEED_T); } sub turn_right1() //その場で右に旋回する動作の定義// { OnFwd(OUT_C,SPEED_T); OnRev(OUT_B,SPEED_T); } sub cross_line() //交差点を突っ切る動作の定義// { PlaySound(SOUND_LOW_BEEP); OnFwd(OUT_BC,SPEED_S); Wait(CROSS_TIME); short_break; } sub pre_shoot() //ボールを捕獲する前に足を振り上げる動作(ボール捕獲前の予備動作)の定義// { RotateMotor(OUT_A,SPEED,-200); } sub Messi_Shoot() //まるでメッシのようなシュートを打つ動作の定義// { RotateMotor(OUT_B,SPEED,45); RotateMotor(OUT_C,SPEED,45); RotateMotor(OUT_A,SPEED,200); Wait(SHOOT_TIME); Off(OUT_A); } sub shoot_performance() //シュート後にするパフォーマンスをする動作の定義// { PlaySound(SOUND_DOUBLE_BEEP); RotateMotor(OUT_B,SPEED,90); RotateMotor(OUT_C,SPEED,90); RotateMotor(OUT_B,SPEED,90); RotateMotor(OUT_C,SPEED,90); } これから下が実際に行う動作のプログラムになる。 プログラムの順は下記のようである。 ミッションスタート→少し直進(黒いスタートの枠から外に出る)→最初の交差点手前までライントレース(あれ、これいらないんじゃね) →ライントレース(交差点判定あり、時限式ボール捕獲あり)→交差点カウンター式メッシのようなシュート。 ・メインのプログラム $様々な定義$ task main() { SetSensorLight(S1); //光センサーの接続先指定// int nOnline=0; //後々使う交差点判定のときの数を定義+現在その値は0と指定// int cross_line_times=0; //通過した交差点の数カウンターの定義+現在その値は0と指定// long t0 = CurrentTick(); //開始直後の時間を記録// $直進$ pre_shoot(); //ボール捕獲のための予備動作兼威嚇// start_go(); //直進(黒いスタートの枠から外に出るため)// $最初の交差点手前までライントレース$…ここからはプログラムの詳しい説明も交えていく。 while (CurrentTick()-t0 <= TRACE_TIME){ //開始から過ぎた時間がある値より小さければずっと以下(”→}”の印まで)の関数を実行// if (SENSOR_1 < THRESHOLD-35){ //もしセンサーの値がある値より小さければ左へ旋回しろ// turn_left1(); } else { //でない状況で// if (SENSOR_1 < THRESHOLD-15){ //もしセンサーの値がある値より小さければ左へまがれ// turn_left0(); } else if (SENSOR_1 < THRESHOLD+15){ //でない状況で、もしセンサーの値がある値より小さければまっすぐすすめ// go_forward(); } else if (SENSOR_1 < THRESHOLD+35){ //でない状況で、もしセンサーの値がある値より小さければ右へ曲がれ// turn_right0(); } else { //でない状況で、もしセンサーの値がある値より小さければ右へ旋回しろ// turn_right1(); } Wait(STEP); //判断時間と黒い線に沿うための動作時間の合計の指定// ”→}” PlaySound(SOUND_UP); //区切りでの警笛// $ライントレース(交差点判定あり、時限式ボール捕獲あり)+交差点カウンター式メッシのようなシュート$ while (true) { long t1 = CurrentTick(); //開始から測った現在の時間を記録// while (nOnline < nMAX){ //異常な数 if (SENSOR_1 < THRESHOLD-35){ //ここから// turn_left1(); nOnline++; } else { if (SENSOR_1 < THRESHOLD+15){ turn_left0(); } else if (SENSOR_1 < THRESHOLD+15){ go_forward(); } else if (SENSOR_1 < THRESHOLD+35){ turn_right0(); } else { turn_right1(); } nOnline=0; } Wait(STEP); } //ここまで $最初の交差点手前までライントレース$と同じ// if(t1-t0 = CATCH_TIMING){ RotateMotor(OUT_A,SPEED,200);}//もし開始から今までの経過時間がある値と同じならば、足を振り下ろせ(=ボールを捕まえろ)// } } (以下、交差点を渡る+シュートを打つ) short_break; //時間調整のための小休止// turn_right1(); //交差点を直進する際の入射角度調整// Wait(nMAX*STEP); cross_line_times++; //通過した交差点の数カウンターの値に+1// if (cross_line_times==3){Messi_Shoot();shoot_performance();} else{cross_line();} nOnline=0; } } あ あ いいいいい う ええええ お お かかかかか あ あ い う え え おお おお か あ あ い う え え おお おお か あああああ いいいいい う ええええ お お お お かかかかか あ あ い う え お お お お か あ あ い う え お お お か あ あ いいいいい ううううう え お お かかかかか