目次

課題2

2019b-mission2.jpeg

A地点を出発し、次のような経路を黒い線に沿って動くロボットを作成する。

経路

  1. A地点から出発
  2. J
  3. H(直進)
  4. I(ボールを掴んでUターン)
  5. H(右折)
  6. G(一時停止の後、直進)
  7. D(右折)
  8. E、F通過
  9. G(一時停止の後、直進)
  10. C(一時停止の後、左折)
  11. B(一時停止)
  12. A地点に入る(ゴール)

ロボットの説明

超音波センサでボールを認識し、モーターにつけられたボール囲うための枠を下げ、ボールを囲ってそのままボールを転がして運ぶようにした。

Robo.jpeg

ボールに反応しやすいように超音波センサはななめにとりつけた。水平や垂直だとうまくボールを認識してくれなかった。

Robo2.jpeg

プログラムの説明

必要な数値や基本的な動きの定義。

#define BLACK 37
#define GRAY_BLACK 50
#define GRAY_WHITE 60
#define WHITE 66
#define left1 OnFwd(OUT_B,30);OnRev(OUT_C,30);
#define left0 OnFwd(OUT_B,30);Off(OUT_C);
#define go OnFwd(OUT_BC,30);
#define right0 OnFwd(OUT_C,30);Off(OUT_B);
#define right1 OnFwd(OUT_C,30);OnRev(OUT_B,30);
#define pause Wait(1000);
#define u_turn OnFwd(OUT_B,50);OnRev(OUT_C,70);Wait(1000);Float(OUT_C)

ラインの右側をトレースする。

void follow_line_r()
{
SetSensorLight(S3);
long t0=CurrentTick();
while(CurrentTick()-t0<120){
if(SENSOR_3<BLACK){
right1;
}else if(SENSOR_3<GRAY_BLACK){
right0; t0=CurrentTick();
}else if(SENSOR_3<GRAY_WHITE){
go; t0=CurrentTick();
}else if(SENSOR_3<WHITE){
left0; t0=CurrentTick();
}else{
left1;t0=CurrentTick();
}
}
Off(OUT_BC);
}

ラインの左側をトレースする。

void follow_line_l()
{
SetSensorLight(S3);
long t0=CurrentTick();
while(CurrentTick()-t0<80){
if(SENSOR_3<BLACK){
left1;
}else if(SENSOR_3<GRAY_BLACK){
left0; t0=CurrentTick();
}else if(SENSOR_3<GRAY_WHITE){
go; t0=CurrentTick();
}else if(SENSOR_3<WHITE){
right0; t0=CurrentTick();
}else{
right1;t0=CurrentTick();
}
}
Off(OUT_BC);
}

JからHまでの曲線のトレース。曲線と交差点の区別がうまくいかなかったので、JからHまでの曲線のトレースは別の関数にした。

void follow_line_curve()
{
SetSensorLight(S3);
long t1;
t1=CurrentTick();
while(CurrentTick()-t1<15000){
if(SENSOR_3<BLACK){
left1;
}else if(SENSOR_3<GRAY_BLACK){
left0; 
}else if(SENSOR_3<GRAY_WHITE){
go; 
}else if(SENSOR_3<WHITE){
right0; 
}else{
right1;
}
}
Off(OUT_BC);
}
}

交差点を渡る。左トレースと右トレースでそれぞれ関数を作った。

void cross_line_l()
{
right0;
Wait(700);
go;
Wait(500);
Off(OUT_BC);
}
void cross_line_r()
{
go;
Wait(400);
Off(OUT_BC);
}

左折

void turn_left()
{
left0;
Wait(700);
left1;
Wait(1200);
Off(OUT_BC);
}

右折

void turn_right()
{
right0;
Wait(500);
right1;
Wait(900);
Off(OUT_BC);
}

ボールを掴みUターンする。

void fetch_ball()
{
SetSensorLowspeed(S2);
while(SensorUS(S2)>=10){
go;
}
Off(OUT_BC);
Wait(1000);
RotateMotor(OUT_A,30,-60);
u_turn;
go;
Wait(1000);
}

メインのプログラム

task main()
{
go; Wait(500);    //A地点を出発
follow_line_curve(); follow_line_l();   //J→H 
cross_line_l();   //H→I  
fetch_ball();   //ボールをつかんでUターン
follow_line_r();   //I→H
turn_right();   //Hを右折
follow_line_r();   //H→G
pause;   //Gで一時停止
cross_line_r(); follow_line_r();   //G→D
turn_right(); follow_line_r();   //D→E
turn_right();  follow_line_r();   //E→F
turn_right(); follow_line_r();   //F→G
pause;   //Gで一時停止
cross_line_r();  follow_line_r();   //G→C
pause;   //Cで一時停止
turn_left(); follow_line_l();   //C→B
pause;   //Bで一時停止
cross_line_l(); go; Wait(500);   //A地点に入る 
}

まとめ

曲線と交差点の区別がなかなかうまくいかなかった。3回に1回は思うようには動いてくれなかった。センサの位置などを工夫する事で、プログラミングは少しは楽になったとは思う。前回の課題が上手くいかなかったので今回はなんとか上手くいってよかった。だんだんとプログラミングが楽しくなってきた。次の課題も頑張りたい。


添付ファイル: fileRobo3.jpeg 1件 [詳細] fileRobo2.jpeg 6件 [詳細] fileRobo.jpeg 6件 [詳細] file2019b-mission2.jpeg 11件 [詳細]

トップ   編集 凍結 差分 バックアップ 添付 複製 名前変更 リロード   新規 一覧 検索 最終更新   ヘルプ   最終更新のRSS
Last-modified: 2020-02-15 (土) 20:42:23