2006a/C1/課題３右

2006a/TeamOnly/進行状況C

今回の課題の内容†

　懐中電灯の光を追いかけて進むロボットを製作し、以下の中から２種類以上のプログラムを作成する。

1. 光源を見失った時には曲を演奏しながらぐるっと旋回して光源を探す
2. 光源を見失った時には明るさに比例した周波数の音を出しながら旋回して光源を探す
3. 光源を見失っていないときにはある曲を演奏し、見失った時には別の曲を演奏しながら光源を探す
4. 上記のいずれかに『光源に近づき過ぎると停止する』という機能を追加する

ただし支給されているモータ、光センサ、タッチセンサはいくつ使ってもよい。 　→今回は1と3を選択しました。

• 目次

制作者†

たかくん ほたる サルバカ

ページ製作開始日　６月３０日†

プログラムの概要†

照度が最大の方を向くプログラムについて†

まず、光の強さ（以後照度とする）が最大のところを感知して、その方向に向くプログラムについてである。これは、ロボットが一周する間に、光センサーによって、毎回照度を感知し、より大きい照度をみつけたら、そこでどんどん塗り替えていって、最終的に最大の照度のところを決める。その最大照度の値を変数として記憶する。さらに、その最大照度のところまでの回った時間を記憶して、その値も変数として記憶する。さらにその最大照度のところへ向くために、一周の時間からその最大照度までの時間を引いただけの時間、回る。

光の後を追いかけるプログラムについて†

次に、最大照度のところを向いた後に、その光の後を追っていくプログラムについてである。光センサーを２つ使った。（光センサー１、２）２つの光センサーをまっすぐ前に向けて、まず最初に光の最大のところを読み取るときにセンサー１、２、１＋２のそれぞれについて最大の照度を同時に読み取らせる。これによって、１＋２の値が最大値になったときには、直進する。また、光源がロボットからみて、左に移動したとき、１の照度が、先ほど測定した最大の照度より上昇し、かつ、２の照度が最大の照度より低下しているときには、左に旋回するようにする。これは、光源が左に移動したときには、センサー１の方が強く光があたり、センサー２の方が、弱く光があたるからである。右に旋回するときには、センサー１が最大値より低く、センサー２は、最大値より高くなればよい。また、最後に、、光を見失ったときにまた旋回して光源を探すものである。これは、光源を見失ってから、旋回して、先ほどの最初に測った最大の照度の値のところを見つけたら、もうそこへ向かっていくものである。光を見失ってからまた一回転せずに、最大のところを見つけたらもうそこで向かって行ってしまう。これは、センサー１と２の照度がともに非常に低くなったら（具体的な照度を入力する）旋回するというものである。そうしてから、また最大と同じ照度のところを見つけたら、そこで直進する。 次に、最大照度のところを向いた後に、その光の後を追っていくプログラムについてである。光センサーを２つ使った。（光センサー１、２）２つの光センサーをまっすぐ前に向けて、まず最初に光の最大のところを読み取るときにセンサー１、２、１＋２のそれぞれについて最大の照度を同時に読み取らせる。これによって、１＋２の値が最大値になったときには、直進する。また、光源がロボットからみて、左に移動したとき、１の照度が、先ほど測定した最大の照度より上昇し、かつ、２の照度が最大の照度より低下しているときには、左に旋回するようにする。これは、光源が左に移動したときには、センサー１の方が強く光があたり、センサー２の方が、弱く光があたるからである。右に旋回するときには、センサー１が最大値より低く、センサー２は、最大値より高くなればよい。また、最後に、、光を見失ったときにまた旋回して光源を探すものである。これは、光源を見失ってから、旋回して、先ほどの最初に測った最大の照度の値のところを見つけたら、もうそこへ向かっていくものである。光を見失ってからまた一回転せずに、最大のところを見つけたらもうそこで向かって行ってしまう。これは、センサー１と２の照度がともに非常に低くなったら（具体的な照度を入力する）旋回するというものである。そうしてから、また最大と同じ照度のところを見つけたら、そこで直進する。

音楽を流すプログラムについて†

次に、音楽を流すプログラムについてである。まず、旋回するときに流す音楽はキラキラ星で、まず、周波数をドレミごとに定義する。そして、そのドレミをプログラムでくみ、その流れる長さも設定し、さらにその音が重ならないように、音の長さよりもWaitで長くする。それで作った音楽をtask mainで流していく。音楽を流すプログラムは、それを始めたら、止めるまでずっと続くプログラムである。これは、光を見失った条件のところに、音楽を流し始めるプログラムを入れ、他の直進するときや、左や右に旋回するときの条件のときには、音楽を止めるプログラムを入れる。

課題３の、２つの音楽を流すプログラムについて†

また、課題３についてである。こちらは、旋回するときの音楽とは別に、光についていってるときにも別の音楽を流す。このときには、課題１のときより光についていくときのプログラムを改良した。光源が、ロボットから向かって左に向かったときには、センサー１の照度の方が、センサー２の照度よりも大きくなるときであるとした。また、２つの音楽を流すときのプログラムついてである。旋回するときには、キラキラ星で、光についていってるときには、メリーさんの羊である。これは、２つの音楽の動作をtask play musicとtask play music_2として区別し、stopとstartを駆使してどちらの音楽も同時に流れないようにした。 　 　 　

我が子(ロボ)の成長日記†

我が子は初めは暴れん坊でした

まずスムーズに旋回できるようかなりスリムアップしました

そして光を見つけやすいように光センサーを２つ搭載

プログラム†

光源を見失った時には曲を演奏しながらぐるっと旋回して光源を探す†

#define Do  262   //音程を定義
#define Re  294
#define Mi  330
#define Fa  349
#define So  392
#define La  440

task play_music()   //音楽はキラキラ星
{
   while(true)
   {
   PlayTone(Do,25);Wait(30);
   PlayTone(Do,25);Wait(30);
   PlayTone(So,25);Wait(30);
   PlayTone(So,25);Wait(30);
   PlayTone(La,25);Wait(30);
   PlayTone(La,25);Wait(30);
   PlayTone(So,25);Wait(60);
   PlayTone(Fa,25);Wait(30);
   PlayTone(Fa,25);Wait(30);
   PlayTone(Mi,25);Wait(30);
   PlayTone(Mi,25);Wait(30);
   PlayTone(Re,25);Wait(30);
   PlayTone(Re,25);Wait(30);
   PlayTone(Do,25);Wait(50);
   PlayTone(So,25);Wait(30);
   PlayTone(So,25);Wait(30);
   PlayTone(Fa,25);Wait(30);
   PlayTone(Fa,25);Wait(30);
   PlayTone(Mi,25);Wait(30);
   PlayTone(Mi,25);Wait(30);
   PlayTone(Re,25);Wait(50);
   PlayTone(So,25);Wait(30);
   PlayTone(So,25);Wait(30);
   PlayTone(Fa,25);Wait(30);
   PlayTone(Fa,25);Wait(30);
   PlayTone(Mi,25);Wait(30);
   PlayTone(Mi,25);Wait(30);
   PlayTone(Re,25);Wait(50);
   }
}

#define t 260   //定数tを決める
int light_max;   //変数を定義
int light_max_1;
int light_max_2;
int time_max;

void turn_right(int u)   //右に曲がる
{
   OnFwd(OUT_C);   
   OnRev(OUT_A);
   Wait(u);
   Off(OUT_A+OUT_C);
}

void turn_left(int v)   //左に曲がる
{
   OnFwd(OUT_A);
   OnRev(OUT_C);
   Wait(v);
   Off(OUT_A+OUT_C);   
}

task main()
{
    SetSensor(SENSOR_1,SENSOR_LIGHT);   //センサーの定義
    SetSensor(SENSOR_2,SENSOR_LIGHT);
    stop play_music; 
  
    OnFwd(OUT_C);   //マシンを回転
    OnRev(OUT_A);
  
    light_max=SENSOR_1+SENSOR_2;
    light_max_1=SENSOR_1;
    light_max_2=SENSOR_2;
  
    ClearTimer(0);   //タイマーをクリアーする
  
   while(FastTimer(0)<t)   //以下のプログラムをt以下の時間で無限ループ
   {
      if(SENSOR_1+SENSOR_2>light_max)   //センサー１＋センサー２がライトマックスより大きければ
      {
         light_max=SENSOR_1+SENSOR_2;   //ライトマックスは入れ替わる
         time_max=FastTimer(0);   //時間を覚える
      }
      if(SENSOR_1>light_max_1)   //センサ−１がライトマックス１より大きければ
      {
         light_max_1=SENSOR_1;   //ライトマックス１は入れ替わる
      }
      if(SENSOR_2>light_max_2);   //センサ−２がライトマックス２より大きければ
      {
         light_max_2=SENSOR_2;   //ライトマックス２は入れ替わる
      }
   }
 turn_left(t-time_max);   //一番明るかった所に向く

 while(true)  //以下のプログラムを無限ループ
 {
    while(SENSOR_1+SENSOR_2>light_max-10)   //ライトマックス−１０よりセンサ−１＋センサ−２が大きければ
    {
       OnFwd(OUT_A+OUT_C);   //直進
       stop play_music;
    }
    while(SENSOR_1>SENSOR_2+10)   //センサ−２＋１０よりセンサ−１が大きければ
    {
       turn_left(10);   //左へ
       stop play_music;
    }
    while(SENSOR_1+10<SENSOR_2)   //センサ−１＋１０よりセンサ−２が大きければ
    {
       turn_right(10);   //右へ
       stop play_music;
    }
    while(SENSOR_1<50&&SENSOR_2<50);   //センサ−１が５０以下かつセンサ−２が５０以下ならば
    {
       OnFwd(OUT_A);   //回転して光源を探す
       OnRev(OUT_C);
       start play_music;   //光源を探す間キラキラ星をながす
    }
 }
 stop play_music;
}

光源を見失っていないときにはある曲を演奏し、見失った時には別の曲を演奏しながら光源を探す†

#define Do  262   //音程を定義
#define Re  294
#define Mi  330
#define Fa  349
#define So  392
#define La  440

task play_music_2()   //音楽はメリーさんの羊   
{
   while (true)
   {
       PlayTone(Mi,25); Wait(30);  
       PlayTone(Re, 5); Wait(10);  
       PlayTone(Do,15); Wait(20);
       PlayTone(Re,15); Wait(20);
       PlayTone(Mi,15); Wait(20);
       PlayTone(Mi,15); Wait(20);
       PlayTone(Mi,35); Wait(40);
       PlayTone(Re,15); Wait(20);
       PlayTone(Re,15); Wait(20);
       PlayTone(Re,35); Wait(40);
       PlayTone(Mi,15); Wait(20);
       PlayTone(So,15); Wait(20);
       PlayTone(So,35); Wait(40);
       PlayTone(Mi,25); Wait(30);
       PlayTone(Re, 5); Wait(10);
       PlayTone(Do,15); Wait(20);
       PlayTone(Re,15); Wait(20);
       PlayTone(Mi,15); Wait(20);
       PlayTone(Mi,15); Wait(20);
       PlayTone(Mi,35); Wait(40);
       PlayTone(Re,15); Wait(20);
       PlayTone(Re,15); Wait(20);
       PlayTone(Mi,25); Wait(30);
       PlayTone(Re, 5); Wait(10);
       PlayTone(Do,55); Wait(60);
       Wait(20);
   }
}

task play_music()   //音楽はキラキラ星  
{
  while(true)
  {
      PlayTone(Do,25);Wait(30);
      PlayTone(Do,25);Wait(30);
      PlayTone(So,25);Wait(30);
      PlayTone(So,25);Wait(30);
      PlayTone(La,25);Wait(30);
      PlayTone(La,25);Wait(30);
      PlayTone(So,25);Wait(60);
      PlayTone(Fa,25);Wait(30);
      PlayTone(Fa,25);Wait(30);
      PlayTone(Mi,25);Wait(30);
      PlayTone(Mi,25);Wait(30);
      PlayTone(Re,25);Wait(30);
      PlayTone(Re,25);Wait(30);
      PlayTone(Do,25);Wait(50);
      PlayTone(So,25);Wait(30);
      PlayTone(So,25);Wait(30);
      PlayTone(Fa,25);Wait(30);
      PlayTone(Fa,25);Wait(30);
      PlayTone(Mi,25);Wait(30);
      PlayTone(Mi,25);Wait(30);
      PlayTone(Re,25);Wait(50);
      PlayTone(So,25);Wait(30);
      PlayTone(So,25);Wait(30);
      PlayTone(Fa,25);Wait(30);
      PlayTone(Fa,25);Wait(30);
      PlayTone(Mi,25);Wait(30);
      PlayTone(Mi,25);Wait(30);
      PlayTone(Re,25);Wait(50);
   }
}

#define t 260   //定数tを決める
int light_max;   //変数を定義
int light_max_1;
int light_max_2;
int time_max;

void turn_right(int u)   //右へ曲がる
{
  OnFwd(OUT_C);   
  OnRev(OUT_A);
  Wait(u);
  Off(OUT_A+OUT_C);
} 

void turn_left(int v)   //左へ曲がる
{
  OnFwd(OUT_A);
  OnRev(OUT_C);
  Wait(v);
  Off(OUT_A+OUT_C);   
}

task main()
{
  SetSensor(SENSOR_1,SENSOR_LIGHT);   //センサーの定義
  SetSensor(SENSOR_2,SENSOR_LIGHT);
   
  OnFwd(OUT_C);   //マシンを回転
  OnRev(OUT_A);
  
  light_max=SENSOR_1+SENSOR_2;
  light_max_1=SENSOR_1;
  light_max_2=SENSOR_2;
  
  ClearTimer(0);   //タイマーをクリアーする
  
  while(FastTimer(0)<t)   //以下のプログラムをt以下の時間で無限ループ
  {
     if(SENSOR_1+SENSOR_2>light_max)   //センサ−１＋センサ−２がライトマックスより大きければ
     {
        light_max=SENSOR_1+SENSOR_2;   //ライトマックスは入れ替わる
        time_max=FastTimer(0);   //時間を覚える
     }
     if(SENSOR_1>light_max_1)   //センサ−１がライトマックス１より大きければ
     {
        light_max_1=SENSOR_1;   //ライトマックス１が入れ替わる
     }
     if(SENSOR_2>light_max_2)   //センサ−２がライトマックス２より大きければ
     {
        light_max_2=SENSOR_2;   //ライトマックス２が入れ替わる
     }
  }
 turn_left(t-time_max);   //一番明るかった所に向く

 while(true)   //以下のプログラムを無限ループ
 {
   start play_music_2;   //光を追っている間はメリーさんの羊をながす
   while(SENSOR_1+SENSOR_2>light_max-10)   //ライトマックス−１０よりセンサ−１＋センサ−２が大きければ
   {
      OnFwd(OUT_A+OUT_C);   //直進
      stop play_music;
   }
   while(SENSOR_1>SENSOR_2+10)   //センサ−２＋１０よりセンサ−１が大きければ
   {
      turn_left(10);   //左へ
      stop play_music;
   }
   while(SENSOR_1+10<SENSOR_2)   //センサ−１＋１０よりセンサ−２が大きければ
   {
      turn_right(10);   //右へ
      stop play_music;
   }
   stop play_music_2;
   while(SENSOR_1<50&&SENSOR_2<50);   //センサ−１が５０以下かつセンサ−２が５０以下ならば
   {
       OnFwd(OUT_A);   //回転して光源を探す
       OnRev(OUT_C);
       start play_music;   //光源を探す間キラキラ星をながす
   }
 }
 stop play_music;
}

ロボット・プログラム制作過程での問題点と解決策†

1. 旋回に摩擦の負荷がかかる 　→四輪構造をやめ、二輪だけにし支えを作って三点支点構造にした。支えの摩擦を減らすために曲面を持つパーツを使用。
2. 光の方を向かない 　→ライトセンサーを２つ付け、それぞれについてライトマックスをはからせることにした。
3. 光の方を向くロボットから、光の方についていくロボットを作る 　→そのためには、ロボットが右、左の方向を感知しないといけないと思い、光センサーを２つつけた。そして、それぞれの光センサーについて、（２つの合計についても）照度の最大値を読み取り、それより低くなったかどうかで光源の移動を読み取り、それについていくようにした。これは、最初の光の最大値を読み取るプログラムの課題があったので、そこのからの発想として最大値をそれぞれのセンサーについて調べてそれと比較することとした。
4. 光についていく、その感度をよくする 　→光源が左に移動したときには、センサー１が照度が最大値より上昇し、かつ、センサー２が最大値より低下するという条件として、より、それぞれ、左、右、直進するときの条件を厳しくした。しかし、その感度を上げるために、課題３では、左に向きたいときには、センサー１の方が２より大きいときとした。それで感度は上昇したものの、その条件が、重なってしまって、それによって逆にうまく動いてくれないときもあった。例えば、光を見失ったときには、その条件は、センサー１も２もともに５０以下のときとした。また、左に向かうときには、センサー１の方がセンサー２よりも照度が大きいとした。これにより、センサー１の方が２よりも大きかったとしても、ともに照度が５０よりも低かったときには、どちらの条件にも当てはまってしまう。懐中電灯も、ロボットも全く動かないかなくても、照度はコロコロ変わるものであって、様々な条件に変わってしまう。そこで、その照度の差の条件を大きくした。つまり、センサー２よりも１の方がより大きな照度がない限り、左に動かないなどした。これは、センサー２の照度の値よりも、照度が１０足されたものよりもセンサー１の値が大きいときなどというようにした。
5. プログラム自体も、今回は高度なものとした 　→while(true)として、無限ループとした中に、さらにwhileの条件として何度も繰り返して行うプログラムとした。
6. キラキラ星の音楽をプログラムする 　→キラキラ星の楽譜をインターネット上からもっとこようとしたが、うまく載っているものがなく、図書館にある、楽譜の載った音楽の本を探してそこから使った。
7. 音楽が早すぎてよく何の音楽かが分からない 　→音楽の早さをWaitで遅くした。
8. 音楽が２つ同時に再生した 　→再生させたくない所にはstop play_musicを入れまくった。
9. プログラムが長くなった 　→関数を使う事により幾分短くした。

反省点†

　ロボットの作り始めはテキストをモデルに基本構造を四輪車にした。そしてプログラムを作る過程で旋回時間を調べることになったが本体が回転しなかった。そこで本体を二輪構造に作り直し、そこから本格的にプログラム作りに取りかかったので他のチームに出遅れた。

反省を踏まえてロボコンに活かしたいこと†

　今までの課題をやってきて本体自体の重心や床との摩擦、パーツはめ込みの強さなどが動作に大きく影響することがわかった。

コメント欄†

　コメントをどうぞ

• ようやくタイヤの向きが固定されている四輪構造をあきらめていただくことができてホッとしています。 -- 松本(教員) 2006-07-11 (火) 10:36:53
• 字が小さくて、読みにくいです・・・ -- ゆき(TA) 2006-07-14 (金) 11:53:26
• 読みやすくなりました。ありがとう。ところで、長文もいいのですが、長くなりそうなときは構造化することで、読みやすくなりますよ。段落を分けてみるとか、副見出しをつけるとか。 -- ゆき(TA) 2006-07-20 (木) 11:10:35

目次

全般

• お知らせ
• はじめに
• 授業の概要
• レポート作成
• パーツの収納方法
• 関連リンク (古い)

教材・資料

• Pybricks
  • Move Hub
  • Spike関連メモ
• EV3用 (第3世代)
  • EV3関連メモ
  • EV3用入門的ガイド (シェル,python)
• NXT用 (第2世代)
  • NXT関連メモ
  • NXC入門的ガイド
  • BricxCCのインストール
• RIS用 (第1世代)
  • NQC入門(旧)
  • NQC入門的ガイド
  • RISの修理
• Spybotics
  • Spyboticsについて

Debian関連

• Debian Live

過去の授業

• 2019年度後期
• 2019年度前期
• 2018年度後期
• 2018年度前期
• 2017年度後期
• 2017年度前期
• 2016年度後期
• 2016年度前期
• 2015年度後期
• 2015年度前期
• 2014年度後期
• 2014年度前期
• 2013年度後期
• 2013年度前期
• 2012年度後期
• 2012年度前期
• 2011年度後期
• 2011年度前期
• 2010年度後期
• 2010年度前期
• 2009年度後期
• 2009年度前期
• 2008年度後期
• 2008年度前期
• 2007年度後期
• 2007年度前期
• 2006年度後期
• 2006年度前期
• 2005年度
• 2004年度

2003年度以前

• 旧ホームページ

最新の20件

メニュー編集

お知らせの追加