Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- import logging
- import sys
- import time
- from threading import Event
- import cflib.crtp
- from cflib.crazyflie import Crazyflie
- from cflib.crazyflie.syncCrazyflie import SyncCrazyflie
- from cflib.positioning.motion_commander import MotionCommander
- from cflib.utils import uri_helper
- URI = uri_helper.uri_from_env(default='radio://0/80/2M/E7E7E7E7E7')
- DEFAULT_HEIGHT = 0.5
- deck_attached_event = Event()
- logging.basicConfig(level=logging.ERROR)
- def take_off_simple(scf):
- with MotionCommander(scf, default_height=DEFAULT_HEIGHT) as mc:
- time.sleep(3)
- mc.stop()
- def param_deck_flow(name, value_str):
- ...
- if __name__ == '__main__':
- cflib.crtp.init_drivers()
- with SyncCrazyflie(URI, cf=Crazyflie(rw_cache='./cache')) as scf:
- scf.cf.param.add_update_callback(group='deck', name='bcDWM1000',cb=param_deck_flow)
- time.sleep(1)
- if not deck_attached_event.wait(timeout=5):
- print('No flow deck detected!')
- sys.exit(1)
- #take_off_simple(scf)
Add Comment
Please, Sign In to add comment