Differences

This shows you the differences between two versions of the page.

--- marvin:lab8 [2008/11/07 13:10] – sohn
+++ marvin:lab8 [2008/11/14 08:50] (current) – rieper
@@ Line 8: / Line 8: @@
 ====Plan====
-  * Modify code by Ole Caprani(([[http://legolab.daimi.au.dk/DigitalControl.dir/NXT/Lesson8.dir/]])) to work with the our own physical implementation of Marvin.
+  * Modify code by Ole Caprani(([[http://legolab.daimi.au.dk/DigitalControl.dir/NXT/Lesson8.dir/]])) to work with our own physical implementation of Marvin.
     * Test individual behaviors seperately and re-calibrate constants.
   * Make modular priority system.
-  * Investegate the functionality of java threads in order to implement a "Drive towards light" behavior as seen in lab session 7 (([[marvin:lab7]]))
+  * Investigate the functionality of java threads in order to implement a "Drive towards light" behavior as seen in lab session 7 (([[marvin:lab7]]))
 ====Execution====
-We modified the code to be more modular. This was not part of the exercise, but it made it a lot easier to test individual modules. Below follows  the modifications made.
+We modified the code to be more modular. This was not part of the exercise, but it made it a lot easier to test individual modules. Below follows the modifications made.
-  * The constant tooCloseThreshold was initially set to be 20 cm, but this was not enough to take into account our modified Marvin which has a plate seperating the two lightsensors. There this constant was changed to 35 instead.
-  * The constants in the thread RandonDrive.java has been change to accomdate more action, less waiting. We wanted Marvin to move longere before there were the tread ended. This caused Marvin to be more "exploring."
+{{marvin:lab8-2.jpg?300}}
+  * The constant ''tooCloseThreshold'' was initially set to be 20 cm, but this was not enough to take into account our modified Marvin which has a plate separating the two light sensors. Therefore this constant was changed to 35 instead.
+  * The constants in the thread ''RandomDrive.java'' has been changed to accommodate more action, less waiting. We wanted Marvin to move longer before the tread ended. This caused Marvin to be more "exploring."
+**Video of Marvin running with default code**\\
+[[http://www.youtube.com/v/OuSbJ5-chXI|{{marvin:lab8-1.jpg}}]]\\
 ===RandomDrive===
-Prints an f on the screen to show the direction of movement. The thread drives forward with different random numbers between 50 and 100 on each motor. This means that Marvin not nessesarily (infact not likkely) will drive straight ahead. It will do this between 1 and 3 seconds. Then print s on the screen to indicate a stop and wait between 0.5 and 1 second. All these intervals are computed using a random function from Math library.
+Prints an "f" (forward) on the screen to show the direction of movement. The thread drives forward with different random numbers between 50 and 100 on each motor. This means that Marvin not necessarily (in fact not likely) will drive straight ahead. It will do this between 1 and 3 seconds. Then print "s" on the screen to indicate a stop and wait between 0.5 and 1 second. All these intervals are computed using a random function from Math library.
 ===AvoidFront===
-Implemented using a sonic sensor. Prints a b on the screen to indecate a backwards motion, and set full power to both motors and do this for 1 second to get a away from the obstacle. Afterwards Marvin stops both motors, and sets right motor to full power to make a left turn. Marvin does this for 0.8 seconds, and it seems this corresponds to a 90 degree turn to the left. This thread shows a f while this happens. Lastly i shows a s en stops for 0.5 seconds.
+Implemented using a sonic sensor. Prints a "b" on the screen to indicate a backwards motion, and set full power to both motors and do this for 1 second to get a away from the obstacle. Afterwards Marvin stops both motors, and sets right motor to full power to make a left turn. Marvin does this for 0.8 seconds, and it seems to correspond to a 90 degree turn to the left. This thread shows a "f" while this happens. Lastly Marvin shows an "s" and stops for 0.5 seconds.
 ===PlaySound===
-This thread waits for 10 seconds, then stops and plays a sound while printing an s on the screen.
+This thread waits for 10 seconds, then stops and plays a sound while printing an "s" on the screen.
 ====Modular Priority System====
-Bent writes this part
+The priority handling was in the initial code created by handing pointers to all lower priority behaviour to each behaviour, as shown in the code below:
+<code java>
+rd = new RandomDrive("Drive",1);
+af = new AvoidFront ("Avoid",2,rd);
+ps = new PlaySounds ("Play ",3,af,rd);
+</code>
+This however makes shuffling of the priorities, as well as making the introduction of new behaviours a very tedious task. We therefore rewrote the priority system to make it more modular and flexible.\\
+Below is the new structure:
+<code java>
+ArrayList behaviors = new ArrayList();
+RandomDrive rd;
+AvoidFront af;
+PlaySounds ps;
+DriveTowardsLight dl;
+rd = new RandomDrive("Drive", behaviors); behaviors.add(rd);
+dl = new DriveTowardsLight("Light ", behaviors); behaviors.add(dl);
+af = new AvoidFront("Avoid", behaviors); behaviors.add(af);
+ps = new PlaySounds("Play ", behaviors); behaviors.add(ps);
+</code>
+The idea is to use an array of Behavior objects containing all lower priority Behaviors in each Behavior.\\
+this array is copied and stored in the constructor of each Behavior, and can then be iterated whenever suppression of the lower levels are needed.
+<code java>
+private ArrayList behaviors;
+public Behavior(String name, ArrayList behaviors)
+{
+  .
+  .
+  .
+  // Clone the Behavior list.
+  this.behaviors = new ArrayList();
+  for(int i = 0; i < behaviors.size(); i++) {
+    Behavior b = (Behavior)behaviors.get(i);
+    this.behaviors.add(b);
+  }
+}
+public void suppressLower()
+{
+  for(int i = 0; i < behaviors.size(); i++) {
+    Behavior b = (Behavior)behaviors.get(i);
+    b.setSuppress(true);
+  }
+}
+</code>
+The code in its entirety can be found in the ''Behavior.java'' file in the source tarball(({{:marvin:07112008.tar.gz}})).
 ====Java Thread====
 The ''Behavior'' class extends ''Thread'' which makes it run as a thread in the JVM. The thread is configured to run as //daemon// which makes it automatically terminate together with the main thread(([[http://java.sun.com/j2se/1.4.2/docs/api/java/lang/Thread.html#setDaemon(boolean)]])).
+====Threaded implementation of "Driving Towards Light"====
+The ''DriveTowardsLight'' class was implemented based on the code from [[marvin:lab7]].\\
+The wanted behaviour is the following:
+  * suppress lower behaviours
+  * read light values
+  * assign modified light values as motor power (l1 -> m2, l2 -> m1).
+  * unsuppress lower behaviours
+Here is the most important code from the class:
+<code java>
+private LightSensor l1;
+private LightSensor l2;
+private int offset = 60;
+public DriveTowardsLight(String name, ArrayList behaviors)
+{
+  ...
+  l1 = new LightSensor(SensorPort.S2);
+  l2 = new LightSensor(SensorPort.S3);
+  l1.setFloodlight(false);
+  l2.setFloodlight(false);
+}
-**Video and pictures**\\
+public void run()
-[[http://www.youtube.com/v/OuSbJ5-chXI|{{marvin:lab8-1.jpg}}]]\\
+{
-{{marvin:lab8-2.jpg?300}}
+  while (true)
+  {
+    // Read value from light sensors
+    int val1 = l1.readValue() + offset;
+    int val2 = l2.readValue() + offset;
+    suppressLower();
+    forward(val2, val1);
+    delay(500);
+    unsuppressLower();
+}
+</code>
+This code however would take over entirely the control of the car since it is active all the time.\\
+We therefore introduced a light threshold to make the car search for light, only when there is some light to search for.\\
+the code for that is shown below:
+<code java>
+private int threshold = 80;
+public void run()
+{
+  .
+  .
+  .
+  if(val1 > threshold || val2 > threshold) {
+    suppressLower();
+    forward(val2, val1);
+    delay(500);
+    unsuppressLower();
+  }
+}
+</code>
+The code in its entirety can be found in the ''DriveTowardsLight.java'' file in the source tarball(({{:marvin:07112008.tar.gz}})).
 **Video for "Drive towards light test"**\\
 [[http://www.youtube.com/v/6TijOeIbigk|{{marvin:lab8-3.jpg}}]]
+====Conclusion====
+The layered behavior model seems to work very well for the implementation of an autonomous robot. We believe that with an added push sensor Marvin would be able to navigate in any room avoiding any obstacles and find the exit with lights.