legolabo/Parallel.java~ at master · bitsteller/legolabo · GitHub

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
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
import lejos.nxt.*;
import lejos.nxt.addon.*;
public class Parallel implements Runnable {

	private ColorSensor cs;
	private int tNo;


	public void run() {
		while(!Button.ENTER.isPressed()){
			LCD.clearDisplay();
		 	if(tNo == 1) {
				LCD.drawString("Wert1: " + cs.getColorNumber() , 0, 0);
			} else if (tNo == 2) {
				LCD.drawString("" + cs.getColor()[0] + cs.getColor()[1] + cs.getColor()[2]);
			}
			try {
				Thread.sleep(200);
			}
			catch(InterruptedException e) {
			}
		}
	}

	public static void kalibrieren(ColorSensor c1, ColorSensor c2) {

		// BlackBalance

		System.out.println("auf Schwarz stellen und Enter");

		Button.ENTER.waitForPress();
		c1.initBlackLevel();
		c2.initBlackLevel();

		LCD.clear();
		System.out.println("Kalibriert bitte Enter");
		Button.ENTER.waitForPress();

		// Clearen

		LCD.clear();

		// WhiteBalance

		System.out.println("auf Weiss stellen und Enter");

		Button.ENTER.waitForPress();
		c1.initWhiteBalance();
		c2.initWhiteBalance();

		LCD.clear();
		System.out.println("Kalibriert bitte Enter");
		Button.ENTER.waitForPress();

	}

	public Parallel(ColorSensor cs, int tNo){
		this.cs = cs;
		this.tNo = tNo;
	}

	public static void main(String[] args){

		ColorSensor c1 = new ColorSensor(SensorPort.S2);
		ColorSensor c2 = new ColorSensor(SensorPort.S3);

		kalibrieren(c1,c2);

		Thread t1 = new Thread(new Parallel(c1,1));
		Thread t2 = new Thread(new Parallel(c2,2));

		t1.start();
		t2.start();

		System.out.println("Wollen sie beenden?");
		Button.ENTER.waitForPress();
	}
}