import nav_eigen_mag
import nav_openloop
import MadgwickAHRS
parser = argparse.ArgumentParser(description='nav filter')
parser.add_argument('--flight', help='load specified aura flight log')
parser.add_argument('--aura-flight', help='load specified aura flight log')
parser.add_argument('--umn-flight', help='load specified .mat flight log')
parser.add_argument('--sentera-flight', help='load specified sentera flight log')
parser.add_argument('--sentera2-flight', help='load specified sentera2 flight log')
args = parser.parse_args()
# This could be an important parameter to pay attention to:
gps_latency = 0.4 # seconds
filter_ref = nav_eigen_mag.filter()
filter_opt = nav_openloop.filter()
def run_filter(filter, imu_data, gps_data, filter_data, config=None):
data_dict = data_store.data_store()
errors = []
# Using while loop starting at k (set to kstart) and going to end
# of .mat file
gps_index = 0
filter_index = 0
new_gps = 0
if config and config['call_init']:
filter_init = False
else:
filter_init = True
import os
import csv
import numpy as np
from matplotlib import pyplot as plt
import navpy
# filter interfaces
import nav_eigen
import nav_eigen_mag
import nav_openloop
#import MadgwickAHRS
filter1 = nav_eigen.filter()
#filter1 = nav_mag.filter()
#filter1 = nav_eigen.filter()
filter2 = nav_eigen_mag.filter()
#filter2 = nav_openloop.filter()
#filter2 = MadgwickAHRS.filter()
r2d = 180.0 / math.pi
mps2kt = 1.94384
def run_filter(filter, data, call_init=True, start_time=None, end_time=None):
# for convenience ...
imu_data = data['imu']
gps_data = data['gps']
if 'air' in data:
air_data = data['air']
else:
air_data = []
filter_data = data['filter']
import os
import csv
import numpy as np
from matplotlib import pyplot as plt
import navpy
# filter interfaces
import nav_eigen
import nav_eigen_mag
import nav_openloop
#import MadgwickAHRS
filter1 = nav_eigen.filter()
#filter1 = nav_mag.filter()
#filter1 = nav_eigen.filter()
filter2 = nav_eigen_mag.filter()
#filter2 = nav_openloop.filter()
#filter2 = MadgwickAHRS.filter()
r2d = 180.0 / math.pi
mps2kt = 1.94384
def run_filter(filter, data, call_init=True, start_time=None, end_time=None):
# for convenience ...
imu_data = data['imu']
gps_data = data['gps']
if 'air' in data:
air_data = data['air']
else:
air_data = []
filter_data = data['filter']
#import MadgwickAHRS
parser = argparse.ArgumentParser(description='nav filter')
parser.add_argument('--flight', help='load specified aura flight log')
parser.add_argument('--aura-flight', help='load specified aura flight log')
parser.add_argument('--px4-sdlog2', help='load specified px4 sdlog2 (csv) flight log')
parser.add_argument('--px4-ulog', help='load specified px4 ulog (csv) base path')
parser.add_argument('--umn-flight', help='load specified .mat flight log')
parser.add_argument('--sentera-flight', help='load specified sentera flight log')
parser.add_argument('--sentera2-flight', help='load specified sentera2 flight log')
args = parser.parse_args()
# This could be an important parameter to pay attention to:
gps_latency = 0.4 # seconds
filter_ref = nav_eigen_mag.filter()
filter_opt = nav_openloop.filter()
def run_filter(filter, imu_data, gps_data, filter_data, config=None):
data_dict = data_store.data_store()
errors = []
# Using while loop starting at k (set to kstart) and going to end
# of .mat file
gps_index = 0
filter_index = 0
new_gps = 0
if config and config['call_init']:
filter_init = False
else:
filter_init = True
