 (defn connect! [drone]
   (reset! (:socket drone) (network/make-datagram-socket (:port drone)))
   (navdata/start-navdata-stream @(:navdata-stream drone))
+  (command drone :ctrl 5 0)
+  (command drone :navdata-demo true)
   (let [thread-pool (util/make-sched-thread-pool 1)]
     (reset! (:thread-pool drone) thread-pool)
     (reset! (:command-executor drone)


(defn queue-command [drone command]
  (dosync
   (alter (:command-queue drone) conj command)))


(defn pop-commands [drone]

    ;;(video/start-video "192.168.1.1")
    (command drone :ref {:emergency true})
    (Thread/sleep 1000)
    ;;(command drone :flat-trim)
    (Thread/sleep 100000)
    ;;(do-led-animation drone :blink-green-red 3 4000)
    ;;(do-led-animation drone :fire 0.5 4000)
