Updated TestPorts to do some simple flying.

jointheleague · Jan 12, 2018 · 919962a · 919962a
1 parent d1545d0
commit 919962a
Showing 1 changed file with 17 additions and 3 deletions.
diff --git a/src/main/java/org/jointheleague/jcodrone/TestPorts.java b/src/main/java/org/jointheleague/jcodrone/TestPorts.java
@@ -10,15 +10,29 @@ public static void main(String argx[]) {
             Thread.sleep(2000);
             drone.flyDirect(new DirectControl((byte) 0, (byte) 0, (byte) 0, (byte) 0));
             Thread.sleep(200);
-//            drone.sendCommandWait(CommandType.FLIGHT_EVENT, FlightEvent.TAKEOFF.value());
+            drone.takeoff();
             Thread.sleep(2000);
-            LightMode mode = new LightModeBuilder().setColor("BLUE").setInterval(5).setMode(LightModeDrone.ARM_HOLD).build();
+            for (int i = 0; i < 3; i++) {
+                LightMode mode = new LightModeBuilder().setColor("BLUE").setInterval(5).setMode(LightModeDrone.EYE_HOLD).build();
+                drone.lightMode(mode);
+                Thread.sleep(100);
+                drone.flyDirect(new DirectControl((byte) 0, (byte) 0, (byte) 55, 30));
+                Thread.sleep(2000);
+                mode = new LightModeBuilder().setColor("RED").setInterval(5).setMode(LightModeDrone.EYE_HOLD).build();
+                drone.lightMode(mode);
+                Thread.sleep(100);
+                drone.flyDirect(new DirectControl((byte) 0, (byte) 0, (byte) -55, -20));
+                Thread.sleep(2000);
+            }
+            drone.flyDirect(new DirectControl((byte) 0, (byte) 0, (byte) 0, (byte) 0));
+            Thread.sleep(200);
+            LightMode mode = new LightModeBuilder().setColor("BLUE").setInterval(5).setMode(LightModeDrone.EYE_HOLD).build();
             drone.lightMode(mode);
             Thread.sleep(1000);
             mode = new LightModeBuilder().setColor("green").setInterval(200).setMode(LightModeDrone.EYE_DIMMING).build();
             drone.lightMode(mode);
             Thread.sleep(3000);
-//            drone.sendCommandWait(CommandType.FLIGHT_EVENT, FlightEvent.LANDING.value());
+            drone.land();
             Thread.sleep(1000);
         } catch (Exception e) {
             e.printStackTrace();