X-Git-Url: https://git.martlubbers.net/?a=blobdiff_plain;ds=sidebyside;f=dsl%2Fruntime%2Fsrc%2Fnl%2Fru%2Fdes%2FMarster.java;h=83bc18405152781832cb79b0eac6d4c8ea25bfcd;hb=8880a95aedaf51c028818910b64f85472d96c14e;hp=6fc32e8fdfb7d13335b078fddc102eee6e69b0d6;hpb=426ca40778af548128b5d5f37705fffcf1cc9c7b;p=des2015.git

diff --git a/dsl/runtime/src/nl/ru/des/Marster.java b/dsl/runtime/src/nl/ru/des/Marster.java
index 6fc32e8..83bc184 100644
--- a/dsl/runtime/src/nl/ru/des/Marster.java
+++ b/dsl/runtime/src/nl/ru/des/Marster.java
@@ -1,25 +1,34 @@
 package nl.ru.des;
 
-import lejos.hardware.Button;
+import java.io.File;
+import java.io.FileOutputStream;
+import java.io.IOException;
+import java.io.InputStream;
+import java.util.LinkedList;
+import java.util.Random;
+
+import lejos.hardware.Sound;
 import lejos.hardware.ev3.EV3;
 import lejos.hardware.ev3.LocalEV3;
 import lejos.hardware.lcd.Font;
 import lejos.hardware.lcd.TextLCD;
 import lejos.hardware.motor.EV3LargeRegulatedMotor;
+import lejos.hardware.motor.EV3MediumRegulatedMotor;
 import lejos.hardware.port.MotorPort;
 import lejos.hardware.sensor.EV3ColorSensor;
 import lejos.hardware.sensor.EV3GyroSensor;
 import lejos.hardware.sensor.EV3TouchSensor;
 import lejos.hardware.sensor.EV3UltrasonicSensor;
 import lejos.hardware.sensor.NXTLightSensor;
+import lejos.robotics.RegulatedMotor;
 import lejos.robotics.SampleProvider;
-import lejos.robotics.subsumption.Arbitrator;
 import nl.ru.des.sensors.BTController;
 import nl.ru.des.sensors.RemoteSensors;
 import nl.ru.des.sensors.SensorCollector;
 
 public class Marster {
 	public static Arbitrator arb;
+	public static Random random;
 	
 	@SuppressWarnings("resource")
 	public static void main(String[] args) {
@@ -34,6 +43,7 @@ public class Marster {
 
 		if(brick.getName().equalsIgnoreCase("Rover6") || brick.getName().equalsIgnoreCase("Rover8")){
 			LCDPrinter.print("Starting as a slave...");
+			LCDPrinter.print("My name is " + brick.getName());
 			LCDPrinter.print("Loading touch sensors...");
 			SampleProvider leftTouch = new EV3TouchSensor(brick.getPort("S1")).getTouchMode();
 			SampleProvider rightTouch = new EV3TouchSensor(brick.getPort("S2")).getTouchMode();
@@ -45,23 +55,36 @@ public class Marster {
 			SampleProvider color = new EV3ColorSensor(brick.getPort("S4")).getColorIDMode();
 			RemoteSensors rs = new RemoteSensors(leftTouch, rightTouch, frontUltra, color);
 			
-			LCDPrinter.print("Start BT... Press any key to commence");
-			Button.waitForAnyEvent();
 			BTController.startSlave();
 			rs.start(BTController.buf);
 		} else {
+//			try {
+//				InputStream inp = Marster.class.getResourceAsStream("nl/ru/des/sound/rick.wav");
+//				FileOutputStream out = new FileOutputStream("rick.wav");
+//				byte buffer[] = new byte[2048];
+//				while(inp.read(buffer)>0){
+//					out.write(buffer);
+//				}
+//				inp.close();
+//				out.close();
+//			} catch (IOException e) {
+//				e.printStackTrace();
+//			}
+			String slave = brick.getName().equalsIgnoreCase("Rover5") ? "Rover6" : "Rover8";
 			LCDPrinter.print("Starting as as master...");
+			LCDPrinter.print("My name is " + brick.getName());
+			LCDPrinter.print("Going to connect to: " + slave);
 			LCDPrinter.print("Loading motors...");
-			EV3LargeRegulatedMotor rightMotor = new EV3LargeRegulatedMotor(MotorPort.A);
-			EV3LargeRegulatedMotor leftMotor = new EV3LargeRegulatedMotor(MotorPort.B);
-			EV3LargeRegulatedMotor measMotor = new EV3LargeRegulatedMotor(MotorPort.C);
-//			leftMotor.setSpeed(Constants.speed);
-//			rightMotor.setSpeed(Constants.speed);
-//			measMotor.setSpeed(100);
-//			rightMotor.setAcceleration(Constants.acceleration);
-//			leftMotor.setAcceleration(Constants.acceleration);
-//			measMotor.setAcceleration(100);
-			
+			RegulatedMotor rightMotor = new EV3LargeRegulatedMotor(MotorPort.A);
+			RegulatedMotor leftMotor = new EV3LargeRegulatedMotor(MotorPort.B);
+			RegulatedMotor measMotor = new EV3MediumRegulatedMotor(MotorPort.C);
+			leftMotor.setSpeed(Constants.speed);
+			rightMotor.setSpeed(Constants.speed);
+			measMotor.setSpeed(50);
+			rightMotor.setAcceleration(Constants.acceleration);
+			leftMotor.setAcceleration(Constants.acceleration);
+			measMotor.setAcceleration(100);
+						
 			LCDPrinter.print("Loading touch sensors...");
 			SampleProvider leftLight = new NXTLightSensor(brick.getPort("S1")).getRedMode();
 			SampleProvider rightLight = new NXTLightSensor(brick.getPort("S2")).getRedMode();
@@ -70,20 +93,20 @@ public class Marster {
 			SampleProvider backUltra = new EV3UltrasonicSensor(brick.getPort("S3")).getDistanceMode();
 			
 			LCDPrinter.print("Loading gyro sensor...");
-			SampleProvider gyro = new EV3GyroSensor(brick.getPort("S4")).getAngleAndRateMode();
+			SensorCollector sc = new SensorCollector(backUltra, leftLight, rightLight, new EV3GyroSensor(brick.getPort("S4")));
 
-			LCDPrinter.print("Start BT... Press any key to commence");
-			Button.waitForAnyEvent();
-			BTController.startMaster(brick.getName() == "Rover5" ? "Rover6" : "Rover8", new SensorCollector(backUltra, leftLight, rightLight, gyro));
+			BTController.startMaster(slave, sc);
 			LCDPrinter.print("Finished loading");
-			Button.waitForAnyPress();
-//			Arbitrator a;
-//			LinkedList<Mission> missions = Missions.getMissions(sensors, rightMotor, leftMotor, colorMemory);
-//			for(Mission m : missions){
-//				LCDPrinter.print("Start " + m.name + " mission...");
-//				a = new Arbitrator(m.behaviours);
-//				a.start();
-//			}
+			LinkedList<Mission> missions = Missions.getMissions(sc, rightMotor, leftMotor, measMotor);
+			random = new Random();
+			for(Mission m : missions){
+				LCDPrinter.print("Start " + m.name + " mission...");
+				arb = new Arbitrator(m.behaviours);
+				sc.reset();
+				arb.start();
+				LCDPrinter.print(m.name + " finished!!1one!");
+			}
+//			Sound.playSample(new File("rick.wav"));
 		}
 	}
 }
\ No newline at end of file