2019a/Member/gacchan/Mission3 の履歴ソース(No.3)

履歴一覧
差分を表示
現在との差分を表示
2019a/Member/gacchan/Mission3 へ行く。
- 1 (2019-08-13 (火) 07:08:10)
- 2 (2019-08-13 (火) 09:08:27)
- 3 (2019-08-13 (火) 13:20:35)
#contents
*課題３ [#i7bb9d12]
今回の課題については[[2019a/Mission3]]の通りである。

&ref(./2019a-mission3-2.png,50%);

私たちは以下のルートで走行し、ボールを運搬するプログラムを作成することにした。

A'(出発) → K' → L'(ボール①をつかむ) → K' → J'(ボール①運搬完了) → K' → M' → N' → N → B → M → K → L(ボール②をつかむ) → K → J(ボール②を容器に入れる。容器を持ち上げる。) → C → B → N → C' → I' (ボール②③④運搬完了)
*ロボットの構造 [#r33d348f]
**ロボット全体について [#i6e6edad]
&ref(./unnamed.jpg,20%);

今回のロボットは２台のNXTを通信してプログラムを制御するので、「２台のNXTを別々に制御する」または「２台のNXTを一体化させてロボットを作る」という２つの方針が考えられるが私たちは、２台のNXTを一体化させてロボットを作った。また、容器内のボールをつかむのは難しいと考えたので、ボールの入った容器ごと持ち上げ、ちゃぶ台返しのようにして容器内のボールを運搬することにした。その際、容器内のボールがどうしてもロボットに降りかかってしまうので、ロボットの上に坂を付け、ボールをロボットの上で転がすことで容器内のボールを運搬させることにした。
ボール①②をつかむアームと容器をつかむアームの計２つのアームを作った。
**ボールをつかむアーム [#zf3e8572]
&ref(./IMG_2712.jpeg,20%);

モーターを２つ使用した。１つはボールをつかみ、もう１つは上下に動かす役割をしている。
**容器をつかむアーム [#b5b9756c]
&ref(./IMG_2713.jpeg,20%);

ボールをつかむアームと同じ機構である。容器を落とさないためにアームにタイヤを計４つ付けた。
**ロボットに取り付けた坂 [#y9f7be16]
&ref(./IMG_2708.jpeg,20%);

アームを持ち上げたときの最高点にちょうど坂がくるようにした。
**光センサー [#rec52c42]
&ref(./IMG_2710.jpeg,20%);

写真にあるように光センサーを２つ使用した。
*プログラム [#ve457ea5]
**ライントレース [#rc18d139]
&ref(./hikari.png,50%);

上図のように線を２つの光センサーで挟んだ。

&ref(./hikari2.png,50%);


光センサーは図のような値をとった。この３つの値に、３８と５３の間の４５と５３と６８のの間の６０を加えて、光センサーの値を５段階に分けた。

課題２と同様に１つの光センサーを用いて下図のように光センサーの取る値とロボットの動きを対応させた。

&ref(./hikari3.png,50%);

ただし、交差点では２つの光センサーが３８となるので、２つ光センサーが一定の時間３８となったときに止まるようにした。また、この時間を変化させることで下図のような場所でも止まれるようにした。

&ref(./hikari4.png,50%);

**define [#f77fd09f]
***光センサーの取る値 [#qbf2e711]
 #define BLACKS 38
 #define BLACK 45
 #define THRESHOLD 53
 #define WHITE 60
 #define WHITES 68
***光センサーに対応した動き [#ya1e3ee1]
 #define left_s OnFwd(OUT_A,60);OnRev(OUT_B,60);
 #define left OnFwd(OUT_A,60);Off(OUT_B);
 #define right_s OnFwd(OUT_B,60);OnRev(OUT_A,90);
 #define right OnFwd(OUT_B,60);Off(OUT_A);
 #define forward OnFwd(OUT_AB,60);
***その他define [#y1f5da39]
 #define CONN 1
 #define SIGNALON1 10 
 #define SIGNALOFF1 11
 #define SIGNALON2 20 
 #define SIGNALOFF2 21
 #define SIGNALON3 30
 #define SIGNALOFF3 31
 #define HALF 1900
 #define QUARTER 950
**サブルーチン [#gd0e715d]
 sub follow_line_left()
 {
    SetSensorLight(S1);
    SetSensorLight(S2);
   
    long t0=0,t1=0,stop_time=3;
 
    while(t1-t0<stop_time){
        if((SENSOR_1<BLACKS)&&(SENSOR_2<BLACKS)){
            t0=CurrentTick();
            forward;
            until((SENSOR_1<THRESHOLD)&&(SENSOR_2<THRESHOLD));
            t1=CurrentTick();
        }else if(SENSOR_1<BLACKS){
            left_s;
        }else if(SENSOR_1<BLACK){
            left;
        }else if(SENSOR_1<THRESHOLD){
            forward;     
        }else if(SENSOR_1<WHITE){
            right;
        }else if(SENSOR_1<WHITES){
            right_s;
        }
     }
     Off(OUT_AB);
     Wait(1000);
 }

 sub follow_line_right()
 {
    SetSensorLight(S1);
    SetSensorLight(S2);
   
    long t0=0,t1=0,stop_time=3;
 
    while(t1-t0<stop_time){
        if((SENSOR_1<BLACKS)&&(SENSOR_2<BLACKS)){
            t0=CurrentTick();
            forward;
            until((SENSOR_1<THRESHOLD)&&(SENSOR_2<THRESHOLD));
            t1=CurrentTick();
        }else if(SENSOR_2<BLACKS){
            right_s;
        }else if(SENSOR_2<BLACK){
            right;
        }else if(SENSOR_2<THRESHOLD){
            forward;     
        }else if(SENSOR_2<WHITE){
            left;
        }else if(SENSOR_2<WHITES){
            left_s;
         }
     }
     Off(OUT_AB);
     Wait(1000);
 }

 sub follow_line_leftT()
 {
    SetSensorLight(S1);
    SetSensorLight(S2);
   
    long t0=0,t1=0,stop_time=1;
 
    while(t1-t0<stop_time){
        if((SENSOR_1<BLACKS)&&(SENSOR_2<BLACKS)){
            t0=CurrentTick();
            forward;
            until((SENSOR_1<THRESHOLD)&&(SENSOR_2<THRESHOLD));
            t1=CurrentTick();
        }else if(SENSOR_1<BLACKS){
            left_s;
        }else if(SENSOR_1<BLACK){
            left;
        }else if(SENSOR_1<THRESHOLD){
            forward;     
        }else if(SENSOR_1<WHITE){
            right;
        }else if(SENSOR_1<WHITES){
            right_s;
        }
     }
     Off(OUT_AB);
     Wait(1000);
 }

 sub follow_line_rightT()
 {
    SetSensorLight(S1);
    SetSensorLight(S2);
   
    long t0=0,t1=0,stop_time=1;
 
    while(t1-t0<stop_time){
        if((SENSOR_1<BLACKS)&&(SENSOR_2<BLACKS)){
            t0=CurrentTick();
            forward;
            until((SENSOR_1<THRESHOLD)&&(SENSOR_2<THRESHOLD));
            t1=CurrentTick();
        }else if(SENSOR_2<BLACKS){
            right_s;
        }else if(SENSOR_2<BLACK){
            right;
        }else if(SENSOR_2<THRESHOLD){
            forward;     
        }else if(SENSOR_2<WHITE){
            left;
        }else if(SENSOR_2<WHITES){
            left_s;
         }
     }
     Off(OUT_AB);
     Wait(1000);
 }