tweaks for RC demo

buzz_scripts/include/act/states.bzz

@@ -175,7 +175,7 @@ function goinghome() {
 		if(math.vec2.length(m_navigation) < GOTODIST_TOL){ # reached destination
 				BVMSTATE = AUTO_LAUNCH_STATE
 		} else {
-			m_navigation = LimitSpeed(m_navigation, 3.0)
+			m_navigation = LimitSpeed(m_navigation, 1.0)
 			#m_navigation = LCA(m_navigation)
 			goto_abs(m_navigation.x, m_navigation.y, cur_goal.altitude - pose.position.altitude, 0.0)
 		}

buzz_scripts/include/utils/takeoff_heights.bzz

@@ -1,11 +1,11 @@
 takeoff_heights ={
     .0 = 0.0,
-    .1 = 32.0,
-    .2 = 28.0,
-    .3 = 24.0,
-    .4 = 20.0,
+    .1 = 8.0,
+    .2 = 10.0,
+    .3 = 12.0,
+    .4 = 14.0,
     .5 = 16.0,
-    .6 = 12.0,
+    .6 = 18.0,
     .9 = 8.0,
     .11 = 6.0,
     .14 = 9.0,

buzz_scripts/main.bzz

@@ -12,7 +12,7 @@ include "utils/takeoff_heights.bzz"
 
 #State launched after takeoff
 
-AUTO_LAUNCH_STATE = "YOLO_DEMO"
+AUTO_LAUNCH_STATE = "IDLE"
 LAND_AFTER_BARRIER_EXPIRE = 1 # if set to be 1 , the robots will land after barrier expire; if set to be 0, the robots will carry on to AUTO_LAUNCH_STATE.
 
 #####
@@ -39,7 +39,7 @@ function init() {
 	nei_cmd_listen()
 
     # Starting state: TURNEDOFF to wait for user input.
-	BVMSTATE = "LAUNCH"
+	BVMSTATE = "TURNEDOFF"
 }
 
 # Executed at each time step.