lemueltra

sensor_b

Apr 13th, 2016
261
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Java 1.31 KB | None | 0 0
  1. package br.follow_line;
  2. import lejos.nxt.*;
  3. public class seguidor implements Runnable{
  4.     private int valor_medio;
  5.     TouchSensor touch_a = new TouchSensor(SensorPort.S2);
  6.     TouchSensor touch_b = new TouchSensor(SensorPort.S3);
  7.     public void run(){
  8.         try {
  9.             Thread.sleep(1000);        
  10.             valor_medio = ((major.branco - major.preto)/2) + major.preto;
  11.            
  12.             do{            
  13.                 if (touch_a.isPressed()){
  14.                     if (major.light.getNormalizedLightValue() < valor_medio){
  15.                         Motor.A.setPower(40);
  16.                         Motor.A.backward();
  17.                         Motor.B.stop();
  18.                         System.out.println("1");
  19.                     }
  20.                     else{
  21.                         Motor.B.setPower(40);
  22.                         Motor.B.backward();
  23.                         Motor.A.stop();
  24.                         System.out.println("1");
  25.                     }
  26.                 }
  27.                 else if (touch_b.isPressed()){
  28.                     if (major.light.getNormalizedLightValue() < valor_medio){
  29.                         Motor.B.setPower(40);
  30.                         Motor.B.backward();
  31.                         Motor.A.stop();    
  32.                         System.out.println("2");
  33.                     }
  34.                     else{
  35.                         Motor.A.setPower(40);
  36.                         Motor.A.backward();
  37.                         Motor.B.stop();
  38.                         System.out.println("2");
  39.                     }
  40.                 }              
  41.                 else{
  42.                     System.out.println("Erro no Controle On/Off");
  43.                 }
  44.             }while(true);
  45.         }
  46.         catch (InterruptedException e) {  
  47.             e.printStackTrace();
  48.         }
  49.     }
  50. }
Advertisement
Add Comment
Please, Sign In to add comment