#Basado en position_commander.demo.py
import cflib.crtp
from cflib.crazyflie import Crazyflie
from cflib.crazyflie.syncCrazyflie import SyncCrazyflie
from cflib.positioning.position_hl_commander import PositionHlCommander
import time

# URI to the Crazyflie to connect to
#uri = 'radio://0/80/2M/E7E7E7E7E6'
uri = 'udp://e2a.google.com:443'

def simple_sequence():
    with SyncCrazyflie(uri, cf=Crazyflie(rw_cache='./cache')) as scf:
        with PositionHlCommander(scf) as pc:
            pc.set_default_velocity(0.1)
            pc.go_to(0.0,0.0,1.0)
            time.sleep(5)
            
if __name__ == '__main__':
    cflib.crtp.init_drivers(enable_debug_driver=False)

    simple_sequence()