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 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