Beispiel #1
0
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
Beispiel #2
0
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']
Beispiel #3
0
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']
Beispiel #4
0
#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