Program Robotika

 PROGRAM SENSOR ULTRASONIC

 void maju() 

{

    //robot jalan unlimited

   OnFwdSync(OUT_BC, 75, 0);

   //menunggu selama jarak benda > 30 cm

   while( SensorUS(S4) > 30 ) ;

   Off(OUT_BC);

}

task main ()

{

   //aktifkan sensor ultrasonic

   SetSensorLowspeed(S4);

   maju();

   //belok kanan

   RotateMotor(OUT_C, 50, 300);

   RotateMotor(OUT_BC, 25, 100);

   //aktifkan sensor ultrasonic

   SetSensorLowspeed(S4);

   maju();

   RotateMotor(OUT_B, 50, 300);

   RotateMotor(OUT_BC, 25, 100);

   //aktifkan sensor ultrasonic

   SetSensorLowspeed(S4);

   maju();

   RotateMotor(OUT_C, 50, 310);

   RotateMotor(OUT_BC, 25, 100);

   //aktifkan sensor ultrasonic

   SetSensorLowspeed(S4);

   maju();

}

 PROGRAM SENSOR CAHAYA (LIGHT SENSOR)

task main ()

{

   //aktifkan sensor cahaya - light sensor

   SetSensorLight(S3);

  

   garis = 0;

   //looping forever

   while(1)

   {

      //jika ketemu garis hitam

      if( Sensor(S3) < 35 )

      {

         //tahan selama masih ketemu hitam

         while( Sensor(S3) < 35 );

         garis = garis + 1 ;

        

         if( garis == 3 )

         {

            Off(OUT_BC);

            break;

         }

      }

      else

      {

         OnFwd(OUT_BC, 75);

      }

   }     //akhir looping

  

   //tampilkan jumlah garis di LCD

   NumOut(12, LCD_LINE1, garis);

  

   //tunggu selama 2 detik

   Wait(2000);

  

}