アフレル スプリングカップ２０１９向けロボット ～レゴマインドストームEV3～
コンテンツ
アフレルスプリングカップ２０１９について
アフレル社が主催するアフレルスプリングカップ２０１９の競技規則が公開されていたので試しにロボットを組み立ててプログラミングした時の備忘録。
アフレルスプリングカップ２０１９は３月２６日に東京、２８日に大阪で開催される予定のロボットコンテストでWRO（World Robot Olympiad）を簡易にした競技内容で初めての人でも参加しやすい大会になっている。
部門は、
- 小学生・中学生・高校生ミドル部門
- 小学生エキスパート部門
- 中学生エキスパート部門
- 高校生エキスパート部門
- ARCミドル部門
- ARCエキスパート部門
に分かれていた。
小学生・中学生・高校生ミドル部門の競技規則を見た所、面白そうだったので挑戦してみることにした。
尚、自分は実際に出場するわけでは無いのと今回の記事のロボットとプログラミングではまだまだ詰めが足りない部分があるのでその辺はご承知おきください。
この記事ではカラーセンサーを２つ使用していますが実際の大会ではカラーセンサーは１つしか使えません。
大会ではレゴ・マインドストームEV3の基本セットの部品のみが使用できます。
自分は他のセットと混在していたのでうっかりカラーセンサーを２つ使ってしまっています。
競技規則
ミドル部門の詳しい競技規則はこちらを参照して欲しいのだが、ざっくり説明すると以下のルールになっている。
- スタートして最初に２色（赤または黄）、４枚のラベルを読む
- ラベルの並び順はランダム（下記の図では赤、黄、黄、赤）
- ラベルが赤の場合は手前（画面下）のＴ字型のブロックを奥（画面上）の枠ブロック内に移動させる
- ラベルが黄の場合は奥（画面上）のＴ字型のブロックを手前（画面下）の枠ブロック内に移動させる
- ブロックの移動を合計４回繰り返す
- ゴールする
| Ｔ字型ブロック |  |
| 枠ブロック |  |
コースの制作
まずはコースの制作。
模造紙、ビニールテープは１００円ショップで購入、後はえんぴつとハサミとのりで”できるだけ”正確にコースを再現した。
この”できるだけ”というがミソで実は自作のコースは本番とかなり出来が違う。
例えば、
- １００円ショップのビニールテープが本番は中川ケミカル製のカッティングシート
- 黒ライン（ビニールテープ）が本番は印刷
- 外枠は緑のビニールテープでつくったが本番は茶色（茶色のテープが無かった）
- 模造紙を張り合わせたのでコースの所々が浮いている
等々。
そして最大の違いはコースの左半分しか無いこと。
机のサイズの都合で左半分しか作れなかったけど、まぁこれでもプログラミングの基本的なところは組めるので良しとした。
実際の大会では試走の時間がとれるので、そこで本番環境との違いを調整する必要がある。
カラーセンサーは外部環境（屋外、屋内、昼、夜、照明など）によって測定値が変わってくるので、これだけ材質が違うと仮に実際に大会に出場するのならばかなりの調整が必要になるのだろうけど、今回は遊びなので良しとした。
機体の説明
機体のベースはトレーニングロボットとした。
機動性を考慮すると改良の余地はあると思うが、まずは基本的な機体で試してみることにする。
| Ｔ字ブロックを持ち上げるアーム | Ｍモーターでワームギアー＞２４枚ギアを使ってアームを上下させる 下限に達するとタッチセンサーが押されるようにした
アームが上がっている時
アームが下がってタッチセンサーが押された状態
|
| カラーセンサー | カラーセンサーはボディ下部に２つ 黒ラインのトレースと赤、黄ラベルの判断に使用する 車体を下からみた所
２つのカラーセンサーでライントレースする |
Mainプログラム概要
Mainプログラムの概要は以下の通り
尚、実際の動きとプログラミングの様子の動画を記事の最後に載せているので参考にして欲しい。
- 初期処理
- 最初の４枚のラベルの色を読んで数値配列に保存した後、右ターン
- 黒ラインまで前進した後、色（赤、黄）によって右または左ターンして赤ラベルまでライントレースしながら前進する
- Ｔ字型ブロックを持ち上げて反転、逆サイドの赤ラベルまでライントレースした後、Ｔ字型ブロックを枠内に下ろす
- バックして中央付近に戻った後、ラベルの色（赤、黄）によって右または左ターンして３に戻る
マイブロックは以下の４種類を作った。
| Initial | 初期処理用のマイブロック |
| LineTrace | 黒ライントレース用のマイブロック 以前に作成したカラーセンサー２つでライントレースするプログラムを参考にしている |
| ColorStock | カラーセンサーで読み取った色を数値配列に保存するマイブロック 数値配列についてはこちらの記事を参照 |
| LiftDown | アームを下げてＴ字型ブロックを枠内に下ろすマイブロック |
Mainプログラム
Mainのプログラム。
量が多いので４枚に分けている
| １ | プログラム開始 |
| ２ | 初期処理（Initial）変数等の初期設定を行う |
| ３ | ４～１０までを４回繰り返す |
| ４ | カラーセンサーが赤（５）または黄（４）を感知するまで５を繰り返す |
| ５ | 黒ライン上をトレースする（LineTrace) |
| ６ | 止まる |
| ７ | ０．１秒待機する |
| ８ | カラーセンサーで色を読み取って数値配列に保存する（ColorStock） |
| ９ | カラーセンサーが赤（５）または黄（４）以外を感知するまで１０を繰り返す |
| １０ | 黒ライン上をトレースする（LineTrace) |
| １１ | 止まる |
| １２ | 右に９０度旋回する |
| １３ | １４～３７を２回繰り返す（本番では４回繰り返す必要がある） |
| １４ | カラーセンサーの反射光の強さが２０以下になるまで（黒ラインを検出するまで）１５を繰り返す |
| １５ | 直進する |
| １６ | 数値配列（Color）から保存した色を読み込む |
| １７ | 数値配列（Color）からループインデックスに対応する色情報を取り出して１８に引き渡す |
| １８ | １７からの色情報が５（赤）の時は１９、４（黄）の場合は２０に分岐する |
| １９ | 右旋回する |
| ２０ | 左旋回する |
| ２１ | カラーセンサーが赤を検出するまで２２を繰り返す |
| ２２ | 黒ライン上をトレースする（LineTrace) |
| ２３ | 止まる |
| ２４ | アームを上げてＴ字型ブロックを持ち上げる |
| ２５ | その場で１８０度旋回する |
| ２６ | カラーセンサーが赤を検出するまで２７を繰り返す |
| ２７ | 黒ライン上をトレースする（LineTrace) |
| ２８ | 止まる |
| ２９ | 少しだけ前進する（Ｔ字型ブロックを下ろす位置の調整） |
| ３０ | アームを下げてＴ字型ブロックを下ろす |
| ３１ | 中央付近まで後進する |
| ３２ | 止まる |
| ３３ | 数値配列（Color）から保存した色を読み込む |
| ３４ | 数値配列（Color）からループインデックスに対応する色情報を取り出して３５に引き渡す |
| ３５ | ３３からの色情報が５（赤）の時は３６、４（黄）の場合は３７に分岐する |
| ３６ | 右旋回する |
| ３７ | 左旋回する |
Mainで使用しているブロック
Mainで使用しているブロックは以下の１１種類。
Initialブロック（マイブロック）
初期処理を行うマイブロック。
 | 変数などを初期化する |
ループブロック
指定した条件に一致するまでループ（同じ処理を繰り返す）する。
 | ４回繰り返す ※赤 or 黄のラベルを４回読み込むのに使用する
|
 | カラーセンサーの色が赤（５）または黄（４）になるまで繰り返す
最初の４枚のラベルの判断に使用する |
 | カラーセンサーの色が赤（５）または黄（４）以外になるまで繰り返す
次のラベルに行くためのループ |
 | ２回繰り返す
|
 | 反射光の強さが２０以下（黒ライン上）になるまで繰り返す
黒ライン上では反射光の強さは１１程度になったので２０以下を黒ライン上と判断した |
 | カラーセンサーの色が赤（５）になるまで繰り返す
コース上の赤ライン上で停止するために使用する |
LineTraceブロック（マイブロック）
黒ライン上のトレースを行うマイブロック。
 | 左右のカラーセンサーの反射光の強さの差分から左右の車輪のパワーを調整して黒ライン上のトレースを行うマイブロック |
ステアリングブロック
左右のLモーターを同時に制御するブロック。前進、後退の他に旋回などの制御も可能。
 | 左右のＬモーターを停止させる
カラーセンサーで色を読み取る時などに車輪を停止させるために使用する |
 | 右に９０度旋回する
最初の４枚のラベルを読んだ後の右旋回で使用する |
 | パワー１５で前進する
黒ラインを見つけるまで前進する時に使用する |
 | 右に旋回する
黒ラインを見つけた後、右旋回する時に使用する その場ので旋回では無く大きく回ることによりカラーセンサーが黒ラインを捉えるような角度での旋回を行う |
 | 左に旋回する
上記の右旋回の逆の動きをする ラベルの色（赤 or 黄）によって左右逆の動きをする |
 | その場で１８０度旋回する
アームでＴ字型ブロックを持ち上げた後、その場で旋回するために使用する |
 | 少しだけ前進する
Ｔ字型ブロックを下ろす前に位置調整の為、少しだけ前進する |
 | バック（後進）する
Ｔ字型ブロックを下ろした後に中央付近に戻るためにバックする |
 | 左に９０度旋回する
次の黒ラインに向かうに辺り旋回する為に使用する ラベルが黄色の場合は次の黒ラインに向かうには左旋回する必要がある |
待機ブロック
指定された条件に一致するまで待機するブロック。
 | ０．１秒待機する
カラーセンサーで色を読み取る時など正確性を増すために０．１秒待機する 待機させる事により誤動作が減ったので待機させている |
ColorStockブロック（マイブロック）
 | カラーセンサーで読み取った色の情報を数値配列に保存するブロック |
変数ブロック
プログラム中の数値や文字列、ロジック（”真” or ”偽”）を保存する事ができる。
 | 数値配列（Color）から保存されている色情報を読み取る
ColorStockブロックで保存されたラベルの色（赤 or 黄）の情報を取り出すために使用する |
配列操作ブロック
数値配列やロジック配列の操作（追加、読み込み）を行うブロック。
 | 数値配列（Color）に保存されている色情報をインデックス順に読み込む
ループインデックスは０、１、２、３・・・と０から始まりカウントアップされる |
スイッチブロック
入力された条件により処理を分岐するブロック。
 | 読み込んだ数値（色情報）により処理を分岐する
赤の時は上の処理、黄の時は下の処理を行う |
Mモーターブロック
軽いものを素早く動かすのが得意なMモーター。
 | Mモーターでアームを上げてＴ字型のブロックを持ち上げる
|
LiftDownブロック（マイブロック）
 | Mモーターを使ってアームを下げるマイブロック |
Initialマイブロック
Initialは初期化をするマイブロック。
| １ | ブロック開始 |
| ２ | 変数Powerに１８をセットする Powerはライントレースの時の左右のＬモーターのベースとなるパワー |
| ３ | 数値配列Colorを空にする |
| ４ | ポート１（左側）のカラーセンサーを反射光の強さのモードにする |
| ５ | ポート４（右側）のカラーセンサーを反射光の強さのモードにする |
Initialで使用しているブロック
使用しているブロックは以下の２種類。
変数ブロック
プログラム中の数値や文字列、ロジック（”真” or ”偽”）を保存する事ができる。
 | 変数（Power)に１８をセットする
ライントレースする時のベースとなる車輪のパワーを１８に設定する この値を変えるとライントレースしている時のスピードが変わる |
 | 数値変数（Color)を空にする
カラーセンサーで読み取った色情報を格納する為の数値配列 最初に空にしておく |
カラーセンサーブロック
 | カラーセンサーのモードを反射光の強さを測定するモードにする
カラーセンサーには３種類のモードがある。
このプログラムでは反射光の強さと色の判定の両方のモードを使用しているが初期処理ではまずは反射光の強さを測定するモードにしている |
LineTraceマイブロック
LineTraceは黒ライン上をトレースするマイブロック。
| １ | ブロック開始 |
| ２ | ポート１（左側）のカラーセンサーで反射光の強さを読み取る |
| ３ | ポート４（右側）のカラーセンサーで反射光の強さを読み取る |
| ４ | 左右のカラーセンサーの反射光の強さの差分から補正値を算出する |
| ５ | Power変数からベースのパワー（１８）を読み取る |
| ６ | ベースのパワーに補正値を加算する |
| ７ | 左車輪のＬモーターに６の値をセットする |
| ８ | ベースのパワーから補正値を減算する |
| ９ | 右車輪のＬモーターに８の値をセットする |
LineTraceで使用しているブロック
使用しているブロックは以下の４種類。
カラーセンサーブロック
 | ポート１（左）と４（右）のカラーセンサーの反射光の強さを読み取る
|
変数ブロック
 | Initialマイブロックで設定した変数Powerの値を読み込む
|
数学ブロック
数学計算を行って結果を出力するブロック。
 | 左右のカラーセンサーの反射光の強さの差から補正値を計算する
※ａーｂの値をそのまま左右の車輪のパワーに加・減算してしまうと値が大きすぎて蛇行してしまうので、適当な数値で割っている また計算の考え方の詳細はこちらの記事を参照 |
 | ベースのパワー（１８）と上記の補正値を合算して左車輪のパワーに代入する
|
 | ベースのパワー（１８）から補正値を減算して右車輪のパワーに代入する
|
Ｌモーターブロック
左右のパワーの計算結果をデータワイヤーで受け取って制御する。
 | 左車輪のパワーを制御する
|
 | 右車輪のパワーを制御する
|
ColorStockマイブロック
ColorStockはカラーセンサーで読み取った色を数値情報として数値配列（Color）に保存するマイブロック。
| １ | ブロック開始 |
| ２ | 数値配列（Color）を読み込む |
| ３ | ポート１（左側）のカラーセンサーから色を読み込む ※同じカラーセンサーでも個体差があり、ポート１に接続したカラーセンサーの方が色を正確に読み取るのでポート１のカラーセンサーを使う事にした |
| ４ | 数値配列に３で読み込んだ値を追加する（一番最後に追加される） |
| ５ | 数値配列にセットする |
| ６ | ３で読み込んだ値が５（赤）なら上、４（黄）なら下のロジックに分岐する ６以降の処理は競技としては必須では無いが読み取った色やタイミングが音で明示的に分かった方がご動作を検証しやすくなる |
| ７ | １７６０Hzのトーン周波数を再生する |
| ８ | ４４０Hzのトーン周波数を再生する |
ColorStockで使用しているブロック
使用しているブロックは以下の５種類。
変数ブロック
 | 数値配列（Color）に値を保存するために読み込む
|
 | 数値配列（Color）に値を書き込む
|
カラーセンサーブロック
 | ポート１（左側）のカラーセンサーを使って色を読み取る
|
配列操作ブロック
数値配列やロジック配列の操作（追加、読み込み）を行うブロック。
 | カラーセンサーで読み取った色情報を順に数値配列に追加していく
|
スイッチブロック
入力された条件により処理を分岐するブロック。
| 読み込んだ数値（色情報）により処理を分岐する
赤の時は上の処理、黄の時は下の処理を行う |
音ブロック
様々な音を再生する為のブロック。
 | 読み込んだ色が赤の時に1760Hzのトーン周波数の再生を行う
|
 | 読み込んだ色が黄の時に440Hzのトーン周波数の再生を行う
|
LiftDownマイブロック
LiftDownはＭモーターでアームを下限まで下げるためのマイブロック。
下限はタッチセンサーが押された事で判断する。
| １ | ブロック開始 |
| ２ | ３をタッチセンサーが押されるまで繰り返す |
| ３ | Mモーターを使ってアームを下げる |
| ４ | Mモーターを停止する |
LiftDownで使用しているブロック
使用しているブロックは以下の２種類。
ループブロック
指定した条件に一致するまでループ（同じ処理を繰り返す）する。
 | タッチセンサーが押されるまでループする
アームが下限まで達するとタッチセンサーが押される構造になっている |
Mモーターブロック
軽いものを素早く動かすのが得意なMモーター。
 | Mモーターでアームを下げる
タッチセンサーが押されるまで下げ続ける |
 | Ｍモーターを止める（アームを止める）
|
プログラミングと実際に動かしてみた時の動画
プログラミングと実際に動かしてみた時の動画。
ロボットがＴ字型のブロックを反対側まで運ぶ様子を動画で確認してみて欲しい。
最近のコメント