Advertisement
AndyGrawell

Java EV3 issue #001

Apr 21st, 2017
67
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Java 2.84 KB | None | 0 0
  1. import lejos.hardware.Button;
  2. import lejos.hardware.motor.EV3LargeRegulatedMotor;
  3. import lejos.hardware.motor.EV3MediumRegulatedMotor;
  4. import lejos.hardware.port.MotorPort;
  5. import lejos.hardware.port.SensorPort;
  6. import lejos.hardware.sensor.EV3TouchSensor;
  7. import lejos.hardware.sensor.EV3ColorSensor;
  8. import lejos.hardware.sensor.EV3GyroSensor;
  9. import lejos.hardware.sensor.EV3UltrasonicSensor;
  10. import lejos.robotics.RegulatedMotor;
  11. import lejos.robotics.SampleProvider;
  12.  
  13. public class Main {// global variables are initialized here:
  14.     static RegulatedMotor EV3_MOTOR_LEFT;
  15.     static RegulatedMotor EV3_MOTOR_RIGHT;
  16.     static RegulatedMotor EV3_MOTOR_ARM;
  17.    
  18.     static EV3TouchSensor EV3_SENSOR_TOUCH;
  19.     static EV3GyroSensor EV3_SENSOR_GYRO;
  20.     static EV3ColorSensor EV3_SENSOR_COLOR;
  21.     static EV3UltrasonicSensor EV3_SENSOR_ULTRASONIC;
  22.    
  23.     static SampleProvider sampleProvider;
  24.     static float[] sample;
  25.    
  26.     static float val;
  27.    
  28.  
  29.     public Main() {
  30.         EV3_SENSOR_TOUCH = new EV3TouchSensor(SensorPort.S1);
  31.         EV3_SENSOR_TOUCH.getTouchMode();
  32.         EV3_SENSOR_GYRO = new EV3GyroSensor(SensorPort.S2);
  33.         EV3_SENSOR_GYRO.getAngleMode();
  34.         EV3_SENSOR_COLOR = new EV3ColorSensor(SensorPort.S3);
  35.         EV3_SENSOR_COLOR.getRedMode();
  36.         EV3_SENSOR_ULTRASONIC = new EV3UltrasonicSensor(SensorPort.S4);
  37.         EV3_SENSOR_ULTRASONIC.getDistanceMode();
  38.        
  39.         EV3_MOTOR_LEFT = new EV3LargeRegulatedMotor(MotorPort.A);
  40.         EV3_MOTOR_RIGHT = new EV3MediumRegulatedMotor(MotorPort.D);
  41.         EV3_MOTOR_ARM = new EV3LargeRegulatedMotor(MotorPort.B);
  42.        
  43.         sample = new float[1];
  44.     }
  45.    
  46.     public static void main(String[] args) {
  47.        
  48.         while (Button.ESCAPE.isUp()) { // Game loop
  49.            
  50.             val = get_gyroSensor_value();
  51.             print_val(val);
  52.        
  53.         }
  54.        
  55.         close();
  56.        
  57.     }
  58.    
  59.     public static void print_String(String string) {
  60.        
  61.         System.out.println(string);
  62.        
  63.     }
  64.    
  65.     public static void print_val(float val) {
  66.        
  67.         System.out.println(val);
  68.        
  69.     }
  70.    
  71.     public static float get_touchSensor_value() {
  72.        
  73.         EV3_SENSOR_TOUCH.fetchSample(sample, 0);
  74.         float gyroSensor_value = sample[0];
  75.         return gyroSensor_value;
  76.        
  77.     }
  78.    
  79.     public static float get_gyroSensor_value() {
  80.        
  81.         EV3_SENSOR_GYRO.fetchSample(sample, 0);
  82.         float gyroSensor_value = sample[0];
  83.         return gyroSensor_value;
  84.        
  85.     }
  86.    
  87.     public static float get_colorSensor_value() {
  88.        
  89.         EV3_SENSOR_COLOR.fetchSample(sample, 0);
  90.         float colorSensor_value = sample[0];
  91.         return colorSensor_value;
  92.        
  93.     }
  94.    
  95.     public static float get_ultrasonicSensor_value() {
  96.        
  97.         EV3_SENSOR_ULTRASONIC.fetchSample(sample, 0);
  98.         float ultrasonicSensor_value = sample[0];
  99.         return ultrasonicSensor_value;
  100.        
  101.     }
  102.    
  103.     public static void close() {
  104.  
  105.         EV3_SENSOR_TOUCH.close();
  106.         EV3_SENSOR_GYRO.close();
  107.         EV3_SENSOR_COLOR.close();
  108.         EV3_SENSOR_ULTRASONIC.close();
  109.        
  110.         EV3_MOTOR_LEFT.close();
  111.         EV3_MOTOR_RIGHT.close();
  112.         EV3_MOTOR_ARM.close();
  113.        
  114.     }
  115.  
  116. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement