2005/C5/あきひろ

task main ()
{
  SetSensor(SENSOR_1, SENSOR_TOUCH);     //左バンパー
  SetSensor(SENSOR_3, SENSOR_TOUCH);     //右バンパー
  while (true) {  
      if (SENSOR_1 == 1)         //左バンパーが壁に接触したとき
        {OnFwd(OUT_A);Off(OUT_C);}    //左タイヤ正回転(壁から離れる)
      else                //ロボットが壁から離れたとき
        {Off(OUT_A);OnFwd(OUT_C);}    //右タイヤ正回転(壁に近づく)
      if(SENSOR_3  == 1)         //右バンパーが壁に接触したとき(壁に正面から接触したら右折)     
        {Off(OUT_A+OUT_C);   
         OnRev(OUT_A+OUT_C);       //後退  
         Wait(10);
         OnFwd(OUT_A);          //右に向く
         Wait(100);
         OnFwd(OUT_A+OUT_C);       //前進
         Wait(220);
         }
                }
}

トップ   編集 凍結 差分 履歴 添付 複製 名前変更 リロード   新規 一覧 検索 最終更新   ヘルプ   最終更新のRSS
Last-modified: 2005-12-14 (水) 18:25:16