added config and apogee detection loop

master
IzzyBrand 2017-12-21 13:55:27 -05:00
rodzic 83be44f04c
commit cc08fcc4b4
3 zmienionych plików z 41 dodań i 1 usunięć

BIN
.DS_Store vendored 100644

Plik binarny nie jest wyświetlany.

Wyświetl plik

@ -1,5 +1,41 @@
from dronekit import connect, VehicleMode, APIException
from pymavlink import mavutil
from time import time
from config import *
from helpers import *
import sys
import time
import argparse
###############################################################################
# Connect to pixhawk
###############################################################################
vehicle = None
try:
vehicle = connect(PORT, baud=115200, wait_ready=True)
except Exception as e:
print e
print 'Failed to connect to pixhawk. exiting.'
sys.exit(1)
###############################################################################
# Ascent
###############################################################################
prev_time_below_burn_alt = time()
while True:
alt = vehicle.location.global_relate_frame.alt
if alt < BURN_ALTITUDE: prev_time_below_burn_alt = time()
else:
time_above = time() - prev_time_below_burn_alt
print 'Above {}m for {} seconds'.format(BURN_ALTITUDE, time_above)
if time_above > BURN_TIME_ABOVE:
break
###############################################################################
# Burn
###############################################################################
###############################################################################
# Descent
###############################################################################

4
config.py 100644
Wyświetl plik

@ -0,0 +1,4 @@
PORT = '/dev/ttyUSB0'
BURN_ALTITUDE = 20000
BURN_TIME_ABOVE = 20