Added a simple supervisor example

Author: ArisMorgens

examples/supervisor/reading_supervisor.py

@@ -0,0 +1,56 @@
+import time
+
+import cflib.crtp
+from cflib.crazyflie import Crazyflie
+from cflib.crazyflie.syncCrazyflie import SyncCrazyflie
+from cflib.utils import uri_helper
+from cflib.utils.reset_estimator import reset_estimator
+from cflib.utils.supervisor_state import SupervisorState
+
+
+# URI to the Crazyflie to connect to
+uri = uri_helper.uri_from_env(default='radio://0/80/2M/E7E7E7E7E7')
+
+
+def safety_check(sup: SupervisorState):
+    if sup.is_crashed():
+        raise Exception('Crazyflie crashed!')
+    if sup.is_locked():
+        raise Exception('Crazyflie locked!')
+    if sup.is_tumbled():
+        raise Exception('Crazyflie tumbled!')
+
+
+def run_sequence(scf: SyncCrazyflie, sup: SupervisorState):
+    commander = scf.cf.high_level_commander
+
+    try:
+        if sup.can_be_armed():
+            safety_check(sup)
+            scf.cf.platform.send_arming_request(True)
+            time.sleep(1)
+
+        if sup.can_fly():
+            print('The Crazyflie can fly...taking off!')
+            commander.takeoff(1.0, 2.0)
+            time.sleep(3)
+            safety_check(sup)
+        if sup.is_flying():
+            print('The Crazyflie is flying...landing!')
+            commander.land(0.0, 2.0)
+            time.sleep(3)
+            safety_check(sup)
+
+    except Exception as e:
+        print(e)
+
+
+if __name__ == '__main__':
+    cflib.crtp.init_drivers()
+
+    with SyncCrazyflie(uri, cf=Crazyflie(rw_cache='./cache')) as scf:
+        time.sleep(1)
+        supervisor = SupervisorState(scf)
+        reset_estimator(scf)
+        time.sleep(1)
+        run_sequence(scf, supervisor)