/
USSensorMultipleDemo.java
42 lines (27 loc) · 1.16 KB
/
USSensorMultipleDemo.java
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
package examples.sensors.ev3;
import ev3dev.sensors.ev3.EV3UltrasonicSensor;
import lejos.hardware.port.SensorPort;
import lejos.robotics.SampleProvider;
import lejos.utility.Delay;
import org.slf4j.Logger;
import org.slf4j.LoggerFactory;
public class USSensorMultipleDemo {
public static Logger LOGGER = LoggerFactory.getLogger(USSensorMultipleDemo.class);
public static void main(final String[] args) {
EV3UltrasonicSensor us1 = new EV3UltrasonicSensor(SensorPort.S1);
EV3UltrasonicSensor us2 = new EV3UltrasonicSensor(SensorPort.S2);
final SampleProvider sp = us1.getListenMode();
final SampleProvider sp2 = us2.getDistanceMode();
int distanceValue = 0;
final int iteration_threshold = 100;
for(int i = 0; i <= iteration_threshold; i++) {
float [] sample2 = new float[sp2.sampleSize()];
sp2.fetchSample(sample2, 0);
float [] sample = new float[sp.sampleSize()];
sp.fetchSample(sample, 0);
distanceValue = (int) sample[0];
LOGGER.info("Iteration: {}, Listen: {}", i, distanceValue);
Delay.msDelay(500);
}
}
}