Advertisement
Guest User

bla

a guest
Jul 6th, 2015
197
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Java 1.30 KB | None | 0 0
  1. import lejos.hardware.motor.Motor;
  2. import lejos.hardware.motor.NXTRegulatedMotor;
  3. import lejos.hardware.sensor.NXTLightSensor;
  4. import lejos.robotics.SampleProvider;
  5.  
  6.  
  7. public class numberofdegrees {
  8.     public NXTLightSensor sensor;
  9.     public numberofdegrees(NXTLightSensor s){
  10.         this.sensor = s;
  11.     }
  12.  
  13.  
  14.     public boolean find_path () {
  15.         NXTRegulatedMotor arm = Motor.D;
  16.         int middle_positon = 0;
  17.         int minpos = middle_positon - 80;
  18.         int maxpos = middle_positon + 80;
  19.         double pad_ambient = 0.42; // waarde tussen 1 en 0
  20.         int armspeed = 200;
  21.         boolean klaar = false;
  22.         arm.setSpeed(armspeed);
  23.         SampleProvider sp = sensor.getRedMode();
  24.         float[] sample = new float[sp.sampleSize()];
  25.         arm.forward();// TODO forward of backward?
  26.         while (!(klaar || arm.getTachoCount() >= maxpos) ){
  27.             sp.fetchSample(sample, 0);
  28.             System.out.println(sample[0]);
  29.             if (sample[0] > pad_ambient ) {
  30.                 arm.stop();
  31.                 klaar = true;
  32.             }
  33.         }
  34.         if (!klaar)
  35.             arm.backward();
  36.         while (!(klaar|| arm.getTachoCount() <= minpos)){
  37.             sp.fetchSample(sample, 0);
  38.             System.out.println(sample[0]);
  39.             if (sample[0] > pad_ambient ) {
  40.                 arm.stop();
  41.                 klaar = true;
  42.             }
  43.         }
  44.         arm.stop();
  45.         if (arm.getTachoCount() <= minpos)
  46.             arm.rotateTo(middle_positon);
  47.         System.out.println("juhgfced");
  48.  
  49.         return false;
  50.     }
  51.  
  52. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement