2011a/A1/課題２左 - ロボティクス入門ゼミ

[ トップ ] [ 編集 | 凍結 | 差分 | 履歴 | 添付 | リロード ] [ 新規 | 一覧 | 検索 | 最終更新 | ヘルプ | ログイン ]

チームメンバー
課題内容
- 黒い線をライントレースするロボットを作る
プログラム
- 直角
- 近道
ロボット紹介
コース紹介
感想
コメント

チームメンバー†

TAMA MIYA

課題内容†

黒い線をライントレースするロボットを作る†

周回コースの条件
交差点が２ヶ所ある
ロータリーが１つある
ニアピンカーブを１つ
スタートとゴールを作る
直角な曲がる道を作る
直角に曲がる道を通らないとか道を作る
ペアの同士で逆回りと近道か直角で分ける

プログラム†

直角†

#define THRESHOLD 45
#define go OnFwd(OUT_A+OUT_C); //前進
#define L OnFwd(OUT_C);Off(OUT_A); //左
#define R OnFwd(OUT_A);Off(OUT_C); //右
task main()
{
 SetSensor(SENSOR_1, SENSOR_LIGHT);
 SetSensor(SENSOR_3, SENSOR_LIGHT);
 int cross = 0;　//両方黒になった回数をカウントする変数
//
 while(cross!=2)　//黒黒が2回来たら止める
 {
  if(SENSOR_1 < THRESHOLD) {L;}　//左側のセンサーが黒になったら左に曲がる
  if(SENSOR_3 < THRESHOLD) {R;}　//右側のセンサーが黒になったら右に曲がる
  if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD) {go;cross++;} //両方黒になったらcross=cross+1　直進
  if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;}　//両方白になったら直進
 }
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);
 cross = 0;
 //                                                    ロータリー開始
 while(cross!=1)　//黒黒が1回来たら止める
 {
  if(SENSOR_1 < THRESHOLD) {L;}//左側のセンサーが黒になったら左に曲がる
  if(SENSOR_3 < THRESHOLD) {R;}//右側のセンサーが黒になったら右に曲がる
  if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD)
   {OnFwd(OUT_A);Wait(90);cross++;}//cross=cross+1
  if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;} 
 }
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);
 cross = 0;
//
 while(cross!=1)　//黒黒が1回来たら止める
 {
  if(SENSOR_1 < THRESHOLD) {L;}//左側のセンサーが黒になったら左に曲がる
  if(SENSOR_3 < THRESHOLD) {R;}//右側のセンサーが黒になったら右に曲がる
  if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD)
   {OnFwd(OUT_A);Wait(90);cross++;}//cross=cross+1
  if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;}
 }
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);
 cross = 0;
//
 while(cross!=1) //黒黒が1回来たら止める
 {
  if(SENSOR_1 < THRESHOLD) {L;}//左側のセンサーが黒になったら左に曲がる
  if(SENSOR_3 < THRESHOLD) {R;}//右側のセンサーが黒になったら右に曲がる
  if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD)
   {OnFwd(OUT_A);Wait(90);cross++;}//cross=cross+1
  if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;} 
 }
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);
 cross = 0;
                                                    //ロータリー終了
ClearTimer(0);
 while(Timer(0) <= 125)
 {
  if(SENSOR_1 < THRESHOLD) {L;}//左側のセンサーが黒になったら左に曲がる
  if(SENSOR_3 < THRESHOLD) {R;}//右側のセンサーが黒になったら右に曲がる
  if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD) {go;}
  if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;} 
 }
OnFwd(OUT_C);Off(OUT_A);Wait(150);
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);　　//交差点～直角まで
 cross = 0;
                                                    // ロータリー開始
  while(cross!=1) //黒黒が1回来たら止める
 {
  if(SENSOR_1 < THRESHOLD) {L;}//左側のセンサーが黒になったら左に曲がる
  if(SENSOR_3 < THRESHOLD) {R;}//右側のセンサーが黒になったら右に曲がる
  if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD)
   {OnFwd(OUT_A);Wait(90);cross++;}//cross=cross+1
  if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;} 
 }
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);
 cross = 0;
// 
 while(cross!=1) //黒黒が1回来たら止める
 {
  if(SENSOR_1 < THRESHOLD) {L;}//左側のセンサーが黒になったら左に曲がる
  if(SENSOR_3 < THRESHOLD) {R;}//右側のセンサーが黒になったら右に曲がる
  if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD)
   {OnFwd(OUT_A);Wait(90);cross++;}//cross=cross+1
  if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;}
 }
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);
 cross = 0;
//
 while(cross!=1) //黒黒が1回来たら止める
 {
  if(SENSOR_1 < THRESHOLD) {L;}//左側のセンサーが黒になったら左に曲がる
  if(SENSOR_3 < THRESHOLD) {R;}//右側のセンサーが黒になったら右に曲がる
  if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD)
   {OnFwd(OUT_A);Wait(90);cross++;}//cross=cross+1
  if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;} 
 }
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);
 cross = 0;
                                                     // ロータリー終了
  while(true)
  {
  if(SENSOR_1 < THRESHOLD) {Off(OUT_A+OUT_C);}
  if(SENSOR_3 < THRESHOLD) {R;}//右側のセンサーが黒になったら右に曲がる
  if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD) {Off(OUT_A+OUT_C);}
  if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;} 　//ゴール
 }
}

近道†

#define THRESHOLD 45
#define go OnFwd(OUT_A+OUT_C); //前進
#define L OnFwd(OUT_C);Off(OUT_A); //左
#define R OnFwd(OUT_A);Off(OUT_C); //右
task main()
{
SetSensor(SENSOR_1, SENSOR_LIGHT);
SetSensor(SENSOR_3, SENSOR_LIGHT);
int cross = 0;　//両方黒になった回数をカウントする変数
                        // ロータリー開始
while(cross!=1)　//黒黒が1回来たら止める
{
 if(SENSOR_1 < THRESHOLD) {L;}　//左側のセンサーが黒になったら左に曲がる
 if(SENSOR_3 < THRESHOLD) {R;}　//右側のセンサーが黒になったら右に曲がる
 if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD)
  {OnFwd(OUT_A);Wait(90);cross++;}　両方黒になったらcross=cross+1　直進
 if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;} 両方白になったら直進
}
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);
cross = 0;
//
while(cross!=1) //黒黒が1回来たら止める
{
 if(SENSOR_1 < THRESHOLD) {L;}//左側のセンサーが黒になったら左に曲がる
 if(SENSOR_3 < THRESHOLD) {R;}//右側のセンサーが黒になったら右に曲がる
 if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD)
  {OnFwd(OUT_A);Wait(90);cross++;}//cross=cross+1
 if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;}
}
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);　　　　　　　　　　　
cross = 0;
//
while(cross!=1) //黒黒が1回来たら止める
{
 if(SENSOR_1 < THRESHOLD) {L;}//左側のセンサーが黒になったら左に曲がる
 if(SENSOR_3 < THRESHOLD) {R;}//右側のセンサーが黒になったら右に曲がる
 if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD)
  {OnFwd(OUT_A);Wait(90);cross++;}//cross=cross+1
 if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;} 
}
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);
cross = 0;
                                                 //ロータリー終了
OnFwd(OUT_A);Off(OUT_C);Wait(90);
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);
cross = 0;
//
while(cross!=7) //黒黒が7回来たら止める
{
 if(SENSOR_1 < THRESHOLD) {L;}//左側のセンサーが黒になったら左に曲がる
 if(SENSOR_3 < THRESHOLD) {R;}//右側のセンサーが黒になったら右に曲がる
 if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD) {go;cross++;}//cross=cross+1
 if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;}　//近道
}
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);
cross = 0;
                                                  //ロータリー開始
while(cross!=1) //黒黒が1回来たら止める
{
 if(SENSOR_1 < THRESHOLD) {L;}//左側のセンサーが黒になったら左に曲がる
 if(SENSOR_3 < THRESHOLD) {R;}//右側のセンサーが黒になったら右に曲がる
 if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD)
  {OnFwd(OUT_A);Wait(90);cross++;}//cross=cross+1
 if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;} 
}
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);
cross = 0;
//
while(cross!=1)//黒黒が1回来たら止める
{
 if(SENSOR_1 < THRESHOLD) {L;}//左側のセンサーが黒になったら左に曲がる
 if(SENSOR_3 < THRESHOLD) {R;}//右側のセンサーが黒になったら右に曲がる
 if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD)
  {OnFwd(OUT_A);Wait(90);cross++;}//cross=cross+1
 if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;}
}
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);
cross = 0;
//
while(cross!=1) //黒黒が1回来たら止める
{
 if(SENSOR_1 < THRESHOLD) {L;}//左側のセンサーが黒になったら左に曲がる
 if(SENSOR_3 < THRESHOLD) {R;}//右側のセンサーが黒になったら右に曲がる
 if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD)
  {OnFwd(OUT_A);Wait(90);cross++;}//cross=cross+1
 if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;} 
}
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);
cross = 0;
                                                //ロータリー終了
while(cross!=3) //黒黒が3回来たら止める
{
 if(SENSOR_1 < THRESHOLD) {L;}//左側のセンサーが黒になったら左に曲がる
 if(SENSOR_3 < THRESHOLD) {R;}//右側のセンサーが黒になったら右に曲がる
 if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD) {go;cross++;}//cross=cross+1
 if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;}
}
Off(OUT_A+OUT_C);
PlaySound(SOUND_UP);
cross = 0;
//
while(true)
{
 if(SENSOR_1 < THRESHOLD) {Off(OUT_A+OUT_C);}
 if(SENSOR_3 < THRESHOLD) {R;}//右側のセンサーが黒になったら右に曲がる
 if(SENSOR_1 < THRESHOLD && SENSOR_3 < THRESHOLD) {Off(OUT_A+OUT_C);}
 if(SENSOR_1 > THRESHOLD && SENSOR_3 > THRESHOLD) {go;} 　//ゴール
}
}

ロボット紹介†

走りやすいようにタイヤを使用し、本体は前の課題のもものをそのまま使いそこに光センサーを取り付けました。

光センサーは本体から遠いと急なカーブに対応できなかったので結構本体寄りにして急カーブや細かい動きに対応できるようにしました。

コース紹介†

条件をみたしつつできるだけ簡単なコースにしてみたつもりです。

交差点が斜めっていると進みずらいので交差点は両方共できるだけ直交するようにつくりました。
走りやすいようにできるだけ直線を多く取り入れました。
長く作ったりしないで出来だけ短く簡単に作りました。

感想†

プログラムが難しく、できるかどうか不安だったが、どうにか作ることができた。
思ったよりも全然難しくて、とても時間がかかったし大変でした。

コメント†

while(true) のループはいつまでも続くので最後のPlaySoundは実行してくれないはずです。 -- 松本 2011-06-24 (金) 12:52:23

目次

全般

教材・資料

Pybricks
- Move Hub
- Spike関連メモ
EV3用 (第3世代)
- EV3関連メモ
- EV3用入門的ガイド (シェル,python)
NXT用 (第2世代)
RIS用 (第1世代)
Spybotics
- Spyboticsについて

Debian関連

Debian Live

過去の授業

2003年度以前

旧ホームページ

最新の20件

2022-10-14

BricxCC

2022-09-29

2021-12-02

お知らせ

2021-11-29

2021-11-24

ロボティクス入門ゼミ

2021-11-19

2006b/A6/RoBoCoN/program

2021-10-07

DebianLive

2021-09-09

メニュー編集

お知らせの追加

添付ファイル:

15.jpg 341件 [詳細]

13.jpg 187件 [詳細]

12.jpg 424件 [詳細]

IMG_8651.jpg 185件 [詳細]

IMG_7436.jpg 315件 [詳細]

Last-modified: 2011-08-05 (金) 15:54:43