![[PukiWiki]](image/robotics-logo-small.jpg "[PukiWiki]"){kind=logo}
#contents
*課題３:懐中電灯に向かってブロックを投げるロボットの制作 [#rfd5163d]
以下の動きをするプログラムを作る。
その１、全方向から懐中電灯の方向を探しだし、懐中電灯に向かってブロックを投げる。（懐中電灯は動かさない。）
その２、懐中電灯をゆっくり動かしたとき懐中電灯に向かって進み、懐中電灯の動きを止めるとブロックを投げる。
その３、懐中電灯をゆっくり動かしたとき懐中電灯に向かって進み、懐中電灯の動きを止めると50cmの距離まで近づいてブロックを投げる。
**メンバー [#qb4d7279]
今回は、小鉢と小次郎で制作します。
**使用するロボットについて [#e16a611b]
＜条件＞
使用できるモータは２つまでとする。
#ref(2008a/A4/課題３左/robo-left２.jpg,75%,全体像)
↑ロボットの全体像
#ref(2008a/A4/課題３左/robo-left.jpg,75%,全体像その２)
↑ロボットの全体像その２
#ref(2008a/A4/課題３左/gia-left.jpg,100%,ギア)
↑ギアの部分
#ref(2008a/A4/課題３左/stop-left.jpg,100%,ギアのストッパー)
↑ギアのストッパーの部分
*プログラムについて [#s6a177fb]
**その１ [#f1bddf0f]
#define THRESHOLD 65 //閾値
task main()
{
SetSensor(SENSOR_1,SENSOR_LIGHT); //センサー1を光センサーに定義する
SetSensor(SENSOR_3,SENSOR_LIGHT); //センサー3を光センサーに定義する
SetPower(OUT_A+OUT_C,7); //AとCのモーターの出力を7にする
while((SENSOR_1 < THRESHOLD) || (SENSOR_3 < THRESHOLD)) { //センサー1か3が受ける光が閾値より弱ければ実行
OnFwd(OUT_C); //時計回りに回転
Off(OUT_A);
}
Off(OUT_C);
OnFwd(OUT_A); Wait(100); //両方とも受ける光が閾値より強くなったらブロックを投げる
Off(OUT_A);
}
**その２ [#sb4f76b1]
#define THRESHOLD 65 //閾値
#define RUN_TIME 25 //RUN_TIMEを2、5秒に定義する
task main()
{
SetSensor(SENSOR_1,SENSOR_LIGHT); //センサー1を光センサーに定義する
SetSensor(SENSOR_3,SENSOR_LIGHT); //センサー3を光センサーに定義する
SetPower(OUT_A+OUT_C,7); //AとCのモーターの出力を７にする
ClearTimer(0); //タイマーをクリアする
while((SENSOR_1 < THRESHOLD) || (SENSOR_3 < THRESHOLD) || (Timer(0) <= RUN_TIME)) { //光が閾値より弱くタイマーが2、5秒以下ならば実行
if ((SENSOR_1 > THRESHOLD) && (SENSOR_3 > THRESHOLD)) { //センサー1と3が受ける光が閾値より強ければ前進
OnRev(OUT_C); Wait(15);
OnFwd(OUT_C); Wait(15);
}
if ((SENSOR_1 > THRESHOLD) && (SENSOR_3 < THRESHOLD)) { //センサー3が受ける光が暗くなったら左折
ClearTimer(0); //タイマーをクリアする
OnRev(OUT_C);
Off(OUT_A);
}
if ((SENSOR_1 < THRESHOLD) && (SENSOR_3 > THRESHOLD)) { //センサ−3が受ける光が暗くなったら右折
ClearTimer(0); //タイマーをクリアする
OnFwd(OUT_C);
Off(OUT_A);
}
if ((SENSOR_1 < THRESHOLD) && (SENSOR_3 < THRESHOLD)) { //光がなければ時計回りに回転
ClearTimer(0); //タイマーをクリアする
OnFwd(OUT_C);
Off(OUT_A);
}
}
Off(OUT_C);
OnRev(OUT_A); Wait(50); //前進を2、5秒以上続けたらブロックを投げる
OnFwd(OUT_A); Wait(50);
Off(OUT_A);
}
**その3 [#e38dea65]
#define THRESHOLD 65 //閾値
#define RUN_TIME 25 //RUN_TIMEを2、5秒に定義する
task main()
{
SetSensor(SENSOR_1,SENSOR_LIGHT); //センサー1を光センサーに定義する
SetSensor(SENSOR_3,SENSOR_LIGHT); //センサー3を光センサーに定義する
SetPower(OUT_A+OUT_C,7); //AとCのモーターの出力を７にする
ClearTimer(0); //タイマーをクリアする
while((SENSOR_1 < THRESHOLD) || (SENSOR_3 < THRESHOLD) || (Timer(0) <= RUN_TIME)) { //光が閾値より弱くタイマーが2、5秒以下ならば実行
if ((SENSOR_1 > THRESHOLD) && (SENSOR_3 > THRESHOLD)) { //センサー1と3が受ける光が閾値より強ければ前進
OnRev(OUT_C); Wait(15);
OnFwd(OUT_C); Wait(15);
}
if ((SENSOR_1 > THRESHOLD) && (SENSOR_3 < THRESHOLD)) { //センサー3が受ける光が暗くなったら左折
ClearTimer(0); //タイマーをクリアする
OnRev(OUT_C);
Off(OUT_A);
}
if ((SENSOR_1 < THRESHOLD) && (SENSOR_3 > THRESHOLD)) { //センサ−3が受ける光が暗くなったら右折
ClearTimer(0); //タイマーをクリアする
OnFwd(OUT_C);
Off(OUT_A);
}
if ((SENSOR_1 < THRESHOLD) && (SENSOR_3 < THRESHOLD)) { //光がなければ時計回りに回転
ClearTimer(0); //タイマーをクリアする
OnFwd(OUT_C);
Off(OUT_A);
}
}
Off(OUT_C);
if(SENSOR_2>LIGHT65&&SENSOR_3>LIGHT65)
{ //50センチ手前にきたら止まってホイールを投げる
Off(OUT_A);
OnFwd(OUT_C);
Wait(20);
Off(OUT_A+OUT_C);
}
*制作してみての感想 [#tfc3c8b0]
ものを投げる際に床にたたきつけるようになってしまい、遠くへ飛ばすためロボットを改良するのに苦労しました。
***コメントお願いします [#ucc60da5]
- モノを投げる際、ホースなどの多少弾力性のある部品を使うことで遠くまで飛ばせるようになると思います。 -- [[松本]] &new{2008-07-31 (木) 08:22:38};
#comment
課題1では相対的に最も明るい方向を探せるプログラムにしてください。I
