[[2005/MemberOnly/進行状況B]]

*ライントレース:モーター二つ [#n0de13ae]
#define THRESHOLD 40  

task main ()
{
    SetPower(OUT_A+OUT_C,1);     :モーターの力をセーブ
    SetSensor(SENSOR_1, SENSOR_LIGHT);   
    SetSensor(SENSOR_3, SENSOR_LIGHT);
    while (true) {
        if (SENSOR_1 < THRESHOLD) {   :左側のセンサーが線上に重
            OnFwd(OUT_C);              なったら、右側のモーター
            Off(OUT_A);                のみ動かす
        } else {                       それ以外は直進          
            OnFwd(OUT_A+OUT_C);
        }
        if (SENSOR_3 < THRESHOLD) {   :右側のセンサーが線上に重
            OnFwd(OUT_A);              なったら、左側のモーター
            Off(OUT_C);                のみ動かす
        } else {                       それ以外は直進          
            OnFwd(OUT_A+OUT_C);
        }
    }
}


トップ   新規 一覧 検索 最終更新   ヘルプ   最終更新のRSS