# -*- coding: utf-8 -*- from vidro import Vidro, ViconStreamer from position_controller import PositionController import sys, math, time import socket, struct, threading import numpy as np import Adafruit_BBIO.ADC as ADC import logging ############################### #Setup of vidro and controller# ############################### vidro = Vidro(False, 1) flight_ready = vidro.connect_vicon() vidro.connect_mavlink() controller = PositionController(vidro) start_time = time.time() #Load gains controller.update_gains() #################### # Controller Values# #################### take_off_alt = 1000 # Pos Commands alt_com = 0