X-Git-Url: https://git.martlubbers.net/?a=blobdiff_plain;f=dsl%2Fxtend%2Fsrc%2Frobots%2Fmissions%2Fgenerator%2FTaskDSLGenerator.xtend;h=16aa0e6f728ec86b605b8ba85393f60b0518ea28;hb=8ac11d4775c780e307727b0e5dc865cf64517a59;hp=d4f6915b3b3b6d6e1bdaf43549e61ccda8ae7558;hpb=34dae1e7f9c49481d90b3d26978cc5ab52ccc050;p=des2015.git

diff --git a/dsl/xtend/src/robots/missions/generator/TaskDSLGenerator.xtend b/dsl/xtend/src/robots/missions/generator/TaskDSLGenerator.xtend
index d4f6915..16aa0e6 100644
--- a/dsl/xtend/src/robots/missions/generator/TaskDSLGenerator.xtend
+++ b/dsl/xtend/src/robots/missions/generator/TaskDSLGenerator.xtend
@@ -9,6 +9,8 @@ import org.eclipse.xtext.generator.IFileSystemAccess
 import org.eclipse.xtext.generator.IGenerator
 import robots.missions.taskDSL.Behaviour
 import robots.missions.taskDSL.Mission
+import robots.missions.taskDSL.OperatorE
+import robots.missions.taskDSL.StoppingExpression
 import robots.missions.taskDSL.Robot
 
 /**
@@ -22,81 +24,98 @@ class TaskDSLGenerator implements IGenerator {
 		var root = resource.allContents.head as Robot;
 		if(root != null){
 			fsa.generateFile("nl/ru/des/Constants.java", makeConstants(root));
-			//fsa.generateFile("nl/ru/des/Behaviours.java", makeBehaviours(root.behaviour));
-			//fsa.generateFile("nl/ru/des/Missions.java", makeMissions(root.mission));
+			for(Behaviour b : root.behaviour){
+				fsa.generateFile("nl/ru/des/" + b.name + "Behaviour.java", makeBehaviour(b));
+			}
+			fsa.generateFile("nl/ru/des/Missions.java", makeMissions(root.mission));
 		}
 	}
 	
-	def CharSequence makeMissions(EList<Mission> list)'''
+	def CharSequence makeMissions(EList<Mission> mission)'''
 package nl.ru.des;
 
 import java.util.LinkedList;
 
-import lejos.hardware.motor.EV3LargeRegulatedMotor;
 import lejos.robotics.subsumption.Behavior;
-import nl.ru.des.Behaviours;
+import lejos.robotics.RegulatedMotor;
+
+import nl.ru.des.sensors.SensorCollector;
 
 public class Missions{
-	public static LinkedList<Mission> getMissions(SensorCollector sensors, EV3LargeRegulatedMotor rightMotor,
-			EV3LargeRegulatedMotor leftMotor, ColorMemory colors){
+	public static LinkedList<Mission> getMissions(final SensorCollector sensors, RegulatedMotor rightMotor,
+			RegulatedMotor leftMotor, RegulatedMotor measMotor){
 		LinkedList<Mission> missions = new LinkedList<Mission>();
-		«FOR m : list»
+		«FOR m : mission SEPARATOR "));" AFTER "));"»
 		missions.add(new Mission("«m.name»", new Behavior[]{
-			«FOR b : m.behaviours SEPARATOR ","»
-			new Behaviours.«b.name»Behaviour(sensors, rightMotor, leftMotor, colors)
-			«ENDFOR»,
-			new ShutdownBehaviour(sensors, rightMotor, leftMotor, colors){
+			«FOR b : m.behaviours SEPARATOR "," AFTER ","»new «b.name»Behaviour(sensors, rightMotor, leftMotor, measMotor)
+			«ENDFOR»
+			new ShutdownBehaviour(){
 				@Override public boolean takeControl(){
-					return »;
+					return «printExpression(m.se)»;
 				}
 			}}
-		«ENDFOR»));
+		«ENDFOR»
 		return missions;
 	}
 }	
 '''
 	
-	def CharSequence makeBehaviours(EList<Behaviour> list)'''
+	def CharSequence makeBehaviour(Behaviour b)'''
 package nl.ru.des;
 
-import lejos.hardware.motor.EV3LargeRegulatedMotor;
+import lejos.robotics.RegulatedMotor;
+import nl.ru.des.sensors.SensorCollector;
 
-public class Behaviours{
-	«FOR b : list»
-	public static class «b.name»Behaviour extends BasicBehaviour {
-		public «b.name»Behaviour(SensorCollector sensors, EV3LargeRegulatedMotor rightMotor,
-				EV3LargeRegulatedMotor leftMotor, ColorMemory colors){
-			super(sensors, rightMotor, leftMotor, colors);
-		}
-		«IF b.tc != null»
-		@Override public boolean takeControl(){
-			return ;
-		}
-		«ENDIF»
-		
-		@Override public void action(){
-			super.action();
-			«FOR a : b.actions»
-				«IF a.whichMotor != null»
-					«IF a.acc > 0»
-					«a.whichMotor.d.toString()»Motor.setAcceleration(«a.acc»);
-					«a.whichMotor.d.toString()»Motor.setSpeed(«a.spd»);
-					«ENDIF»
-					«a.whichMotor.d.toString()»Motor.«a.dir.d.toString()»();
+public class «b.name»Behaviour extends BasicBehaviour {
+	public «b.name»Behaviour(SensorCollector sensors, RegulatedMotor rightMotor,
+			RegulatedMotor leftMotor,  RegulatedMotor measMotor){
+		super(sensors, rightMotor, leftMotor, measMotor);
+	}
+	«IF b.tc != null»
+	@Override public boolean takeControl(){
+		return «printExpression(b.tc)»;
+	}
+	«ENDIF»
+	
+	@Override public void action(){
+		System.out.println("Start: «b.name»");
+		super.action();
+		«FOR a : b.actions»
+			«IF a.whichMotor != null»
+				«IF a.acc > 0»
+				«a.whichMotor.d.toString()»Motor.setAcceleration(«a.acc»);
+				«a.whichMotor.d.toString()»Motor.setSpeed(«a.spd»);
+				«ENDIF»
+				«a.whichMotor.d.toString()»Motor.«a.moveDir.d.toString()»();
+			«ELSEIF a.time != null»
+			time = System.currentTimeMillis();
+			while(!suppressed«IF a.time.time > 0» && System.currentTimeMillis()-time<«a.time.time»«ENDIF»){
+				Thread.yield();	
+			}
+			«ELSEIF a.turnType != null»
+				«IF a.acc > 0»
+					leftMotor.setAcceleration(«a.acc»);
+					leftMotor.setSpeed(«a.spd»);
+					rightMotor.setAcceleration(«a.acc»);
+					rightMotor.setSpeed(«a.spd»);
+				«ENDIF»
+				«IF a.turnType.turnDir != null»
+					«a.turnType.turnDir.d.toString()»Turn(«a.turnType.degrees»);
 				«ELSE»
-				time = System.currentTimeMillis();
-				while(!suppressed«IF a.time.time > 0» && System.currentTimeMillis()-time>«a.time.time»«ENDIF»){
-					Thread.yield();	
-				}
+					turnRandom(«a.turnType.start», «a.turnType.end»);
 				«ENDIF»
-			«ENDFOR»
-			reset();
-		}
+			«ELSEIF a.rl != null»
+			measure«a.rl.d.toString()»();
+			«ELSE»
+			if(!suppressed){
+				sensors.saveVar("«a.varName.toString()»");
+			}
+			«ENDIF»
+		«ENDFOR»
+		System.out.print("Stop: «b.name»");
 	}
-	«ENDFOR»
 }
 	'''
-
 	
 	def CharSequence makeConstants(Robot robot)'''
 package nl.ru.des;
@@ -106,4 +125,28 @@ public class Constants{
 	public final static int acceleration = «robot.acc»;
 }'''
 	
+	def CharSequence printExpression(StoppingExpression e)'''
+	«IF e.scond != null»
+		«IF e.scond.varName != null»
+		sensors.collected("«e.scond.varName.toString()»")
+		«ELSEIF e.scond.touch != null»
+		sensors.«e.scond.touch.d.toString()»Touch()
+		«ELSEIF e.scond.light != null»
+		sensors.«e.scond.light.d.toString()»Light()
+		«ELSEIF e.scond.dist != null»
+		sensors.«e.scond.dist.d.toString()»Distance()
+		«ELSEIF e.scond.color != null»
+		sensors.color() == «e.scond.color.d.ordinal»
+		«ELSE»
+		false
+		«ENDIF»
+	«ELSEIF e.negscond != null»
+		!(«printExpression(e.negscond)»)
+	«ELSE»
+		«IF e.op.d.equals(OperatorE.AND)»
+			«FOR ex : e.s BEFORE "(" SEPARATOR "&&" AFTER ")"»«printExpression(ex)»«ENDFOR»
+		«ELSE»
+			«FOR ex : e.s BEFORE "(" SEPARATOR "||" AFTER ")"»«printExpression(ex)»«ENDFOR»
+		«ENDIF»
+	«ENDIF»'''
 }
\ No newline at end of file