#!/usr/bin/env python3

import asyncio
from mavsdk import System

async def run():
    
    print("Code Initialized---")

    drone = System()
    await drone.connect(system_address="serial:///dev/ttyUSB1")

    print("Waiting for drone to connect...")
    async for state in drone.core.connection_state():
        if state.is_connected:
            print(f"Drone discovered!")
            break
            
    async for position in drone.telemetry.position():
        print(position)

if __name__ == "__main__":
    loop = asyncio.get_event_loop()
    loop.run_until_complete(run())