# Importando bibliotecas necessárias
import socket
import time

# Atributos padrão segundo documentação
host = ''
port = 9000
locaddr = (host,port) 

# Criando um socket UDP e conectando ao drone
sock = socket.socket(socket.AF_INET, socket.SOCK_DGRAM)
tello_address = ('192.168.10.1', 8889)
ans = sock.bind(locaddr)
print(1, ans)

# Função para enviar mensagem
def enviar(mensagem):
    try:
        sock.sendto(mensagem.encode(encoding="utf-8"), tello_address)
        print("Enviando comando: " + mensagem)
    except Exception as e:
        print("Erro de envio: " + str(e))

# Função para receber mensagem
def receber():
    try:
        resposta, end_ip  = sock.recvfrom(128)
        print("Resposta recebida: " + resposta.decode(encoding="utf-8") + " do endereço ip " + str(end_ip))
    except Exception as e:
        print("Erro ao receber: " + str(e))

enviar("command") #Inicia procedimento de envio de comandos
time.sleep(5) #Espera 5 segundos

enviar("takeoff") #Decolagem
time.sleep(5) #Espera 5 segundos

enviar("up 50") #Sobe 50cm
time.sleep(5) #Espera 5 segundos

enviar("down 50") #Desce 50cm
time.sleep(5) #Espera 5 segundos

enviar("land") #Pouso
time.sleep(5) #Espera 5 segundos

sock.close() #Encerramento do socket de comunicação