pilot = interp.query(time, 'pilot')
act = interp.query(time, 'act')
vn = filt['vn']
ve = filt['ve']
vd = filt['vd']
psix = filt['psix']
psiy = filt['psiy']
yaw_rad = math.atan2(psiy, psix)
pitch_rad = filt['the']
roll_rad = filt['phi']
if not correction.yaw_interp is None:
yaw_rad += correction.yaw_interp(time)
if not correction.pitch_interp is None:
pitch_rad += correction.pitch_interp(time)
if not correction.roll_interp is None:
roll_rad += correction.roll_interp(time)
lat_deg = filt['lat']*r2d
lon_deg = filt['lon']*r2d
#altitude_m = air['alt_true']
altitude_m = filt['alt']
if filt_alt == None:
filt_alt = altitude_m
else:
filt_alt = 0.95 * filt_alt + 0.05 * altitude_m
if 'airspeed' in air:
airspeed_kt = air['airspeed']
else:
airspeed_kt = 0.0
if 'wind_dir' in air:
wind_deg = air['wind_dir']
wind_kt = air['wind_speed']
counter += 1
if args.start_time and time < args.start_time:
continue
vn = interp.filter_vn(time)
ve = interp.filter_ve(time)
vd = interp.filter_vd(time)
#yaw_rad = interp.filter_yaw(time)*d2r
psix = interp.filter_psix(time)
psiy = interp.filter_psiy(time)
yaw_rad = math.atan2(psiy, psix)
pitch_rad = interp.filter_the(time)
roll_rad = interp.filter_phi(time)
if args.correction:
yaw_rad += correction.yaw_interp(time)
pitch_rad += correction.pitch_interp(time)
roll_rad += correction.roll_interp(time)
lat_deg = interp.filter_lat(time) * r2d
lon_deg = interp.filter_lon(time) * r2d
#altitude_m = float(interp.air_true_alt(time))
altitude_m = interp.filter_alt(time)
if filt_alt == None:
filt_alt = altitude_m
else:
filt_alt = 0.95 * filt_alt + 0.05 * altitude_m
if interp.air_speed:
airspeed_kt = interp.air_speed(time)
else:
airspeed_kt = 0.0
if interp.air_wind_dir:
wind_deg = interp.air_wind_dir(time)
wind_kt = interp.air_wind_speed(time)