def __init__(self):
super().__init__()
# Traffic is the toplevel trafficarrays object
self.setroot(self)
self.ntraf = 0
self.cond = Condition() # Conditional commands list
self.wind = WindSim()
self.turbulence = Turbulence()
self.translvl = 5000.*ft # [m] Default transition level
with self.settrafarrays():
# Aircraft Info
self.id = [] # identifier (string)
self.type = [] # aircaft type (string)
# Positions
self.lat = np.array([]) # latitude [deg]
self.lon = np.array([]) # longitude [deg]
self.distflown = np.array([]) # distance travelled [m]
self.alt = np.array([]) # altitude [m]
self.hdg = np.array([]) # traffic heading [deg]
self.trk = np.array([]) # track angle [deg]
# Velocities
self.tas = np.array([]) # true airspeed [m/s]
self.gs = np.array([]) # ground speed [m/s]
self.gsnorth = np.array([]) # ground speed [m/s]
self.gseast = np.array([]) # ground speed [m/s]
self.cas = np.array([]) # calibrated airspeed [m/s]
self.M = np.array([]) # mach number
self.vs = np.array([]) # vertical speed [m/s]
# Atmosphere
self.p = np.array([]) # air pressure [N/m2]
self.rho = np.array([]) # air density [kg/m3]
self.Temp = np.array([]) # air temperature [K]
self.dtemp = np.array([]) # delta t for non-ISA conditions
# Wind speeds
self.windnorth = np.array([]) # wind speed north component a/c pos [m/s]
self.windeast = np.array([]) # wind speed east component a/c pos [m/s]
# Traffic autopilot settings
self.selspd = np.array([]) # selected spd(CAS or Mach) [m/s or -]
self.aptas = np.array([]) # just for initializing
self.selalt = np.array([]) # selected alt[m]
self.selvs = np.array([]) # selected vertical speed [m/s]
# Whether to perform LNAV and VNAV
self.swlnav = np.array([], dtype=np.bool)
self.swvnav = np.array([], dtype=np.bool)
self.swvnavspd = np.array([], dtype=np.bool)
# Flight Models
self.cd = StateBased()
self.cr = ConflictResolution()
self.ap = Autopilot()
self.aporasas = APorASAS()
self.adsb = ADSB()
self.trails = Trails()
self.actwp = ActiveWaypoint()
self.perf = OpenAP()
# Group Logic
self.groups = TrafficGroups()
# Traffic autopilot data
self.apvsdef = np.array([]) # [m/s]default vertical speed of autopilot
self.aphi = np.array([]) # [rad] bank angle setting of autopilot
self.ax = np.array([]) # [m/s2] absolute value of longitudinal accelleration
self.bank = np.array([]) # nominal bank angle, [radians]
self.swhdgsel = np.array([], dtype=np.bool) # determines whether aircraft is turning
# Traffic autothrottle settings
self.swats = np.array([], dtype=np.bool) # Switch indicating whether autothrottle system is on/off
self.thr = np.array([]) # Thottle seeting (0.0-1.0), negative = non-valid/auto
# Display information on label
self.label = [] # Text and bitmap of traffic label
# Miscallaneous
self.coslat = np.array([]) # Cosine of latitude for computations
self.eps = np.array([]) # Small nonzero numbers
self.work = np.array([]) # Work done throughout the flight
# Default bank angles per flight phase
self.bphase = np.deg2rad(np.array([15, 35, 35, 35, 15, 45]))
def update():
global recording, prevconfpairs, confframe, delframe, resos, reso_index, ntrafframe, first_ntrafframe, first_confframe, locframe, first_locframe, first_delframe, first_logger, headings, densities, heading_index, density_index, reso, superfirst, i
stack.stack('FF')
if superfirst:
superfirst = False
stack.stack('PLUGIN MVPSPD')
stack.stack('PLUGIN MVPSPDFTR')
stack.stack('PLUGIN MVPVREL')
stack.stack('PLUGIN MVPVRELFTR')
stack.stack('ASAS ON')
stack.stack('CDMETHOD CStateBased')
stack.stack('RESO '+resos[reso_index])
stack.stack('PCALL '+'Wouter_MTM/'+str(headings[heading_index])+'_'+str(densities[density_index])+'_'+str(i)+'.SCN')
stack.stack('FF')
if traf.ntraf > 0 and not recording: # Voor low density case.
recording = True
else:
pass
tlist_id = [x for x in traf.id if x[0] == 'T']
tlist_idx = traf.id2idx(tlist_id)
if first_ntrafframe:
ntrafframe = np.array([sim.simt, traf.ntraf])
first_ntrafframe = False
else:
ntrafframe = np.vstack((ntrafframe, np.array([sim.simt, traf.ntraf])))
if first_locframe:
locframe = np.array([sim.simt, traf.lat, traf.lon])
first_locframe = False
else:
if sim.simt % 5*60 < 1:
locframe = np.vstack((locframe, np.array([sim.simt, traf.lat, traf.lon])))
else:
pass
if recording: # Omgekeerd Statement, de not moet eigenlijk weg.
confpairs, lospairs, inconf, tcpamax, qdr, dist, dcpa, tcpa, tLOS = \
StateBased.detect(StateBased, traf, traf, bs.traf.cd.rpz, bs.traf.cd.hpz, bs.traf.cd.dtlookahead)
#newgscapped = ConflictResolution.resolve(traf.asas,traf)
if len([x for x in confpairs if x not in prevconfpairs]) > 0:
newcomers = [confpairs.index(i) for i in confpairs if i not in prevconfpairs]
for n in newcomers:
confname = confpairs[n]
ac1 = confname[0]
ac2 = confname[1]
ac1idx = traf.id2idx(ac1)
ac2idx = traf.id2idx(ac2)
bearing = qdr[n]
distance = dist[n]
distancecpa = dcpa[n]
timecpa = tcpa[n]
timeLOS = tLOS[n]
initialtas = traf.tas[ac1idx]
initialhdg = traf.hdg[ac1idx]
initialtasi = traf.tas[ac2idx]
initialhdgi = traf.hdg[ac2idx]
latitude = traf.lat[ac1idx]
longitude = traf.lon[ac1idx]
latitudei = traf.lat[ac2idx]
longitudei = traf.lon[ac2idx]
if first_confframe:
confframe = np.array([sim.simt, confname, ac1idx, ac1, bearing, distance, distancecpa, timecpa, timeLOS, initialtas, initialhdg, initialtasi, initialhdgi, latitude, longitude, latitudei, longitudei])
first_confframe = False
else:
confframe = np.vstack((confframe, np.array([sim.simt, confname, ac1idx, ac1, bearing, distance, distancecpa, timecpa, timeLOS, initialtas, initialhdg, initialtasi, initialhdgi, latitude, longitude, latitudei, longitudei])))
prevconfpairs = confpairs
if sim.simt > 3.5*3600 and not first_confframe and not first_delframe: # Moet 4 ofzo zijn
if not os.path.exists('/BSData2/Dens'+str(densities[density_index])+'/Head'+str(headings[heading_index])):
os.makedirs('/BSData2/Dens'+str(densities[density_index])+'/Head'+str(headings[heading_index]), exist_ok=True)
#pd.DataFrame(confframe).to_csv(str(headings[heading_index])+'_'+str(densities[density_index])+'_'+str(i)+'_'+reso+'_ResultsDF.csv', sep=';')
pd.DataFrame(confframe).to_csv('/BSData2/Dens'+str(densities[density_index])+'/Head'+str(headings[heading_index])+'/'+str(i)+'-'+resos[reso_index]+'-confframe.csv' ,sep=';')
#pd.DataFrame(delframe).to_csv(str(headings[heading_index])+'_'+str(densities[density_index])+'_'+str(i)+'_'+reso+'_Results-DelsDF.csv', sep=';')
pd.DataFrame(delframe).to_csv('/BSData2/Dens'+str(densities[density_index])+'/Head'+str(headings[heading_index])+'/'+str(i)+'-'+resos[reso_index]+'-delframe.csv' ,sep=';')
#pd.DataFrame(ntrafframe).to_csv(str(headings[heading_index])+'_'+str(densities[density_index])+'_'+str(i)+'_'+reso+'_Results-ntrafDF.csv', sep=';')
pd.DataFrame(ntrafframe).to_csv('/BSData2/Dens'+str(densities[density_index])+'/Head'+str(headings[heading_index])+'/'+str(i)+'-'+resos[reso_index]+'-ntrafframe.csv' ,sep=';')
#pd.DataFrame(locframe).to_csv(str(headings[heading_index])+'_'+str(densities[density_index])+'_'+str(i)+'_'+reso+'_Results-locsDF.csv', sep=';')
pd.DataFrame(locframe).to_csv('/BSData2/Dens'+str(densities[density_index])+'/Head'+str(headings[heading_index])+'/'+str(i)+'-'+resos[reso_index]+'-locframe.csv' ,sep=';')
#stack.stack('HOLD')
stack.stack('RESET')
reso_index += 1
c = False
if reso_index > (len(resos) - 1):
reso_index = 0
i += 1
if i > 10: #10
i = 1
heading_index += 1
if heading_index > 9: #9
heading_index = 0
density_index += 1
if density_index > 0: #9
stack.stack('HOLD')
print('complete')
c = True
if not c:
stack.stack('CDMETHOD CStateBased')
stack.stack('RESO '+resos[reso_index])
stack.stack('PCALL '+'Wouter_MTM/'+str(headings[heading_index])+'_'+str(densities[density_index])+'_'+str(i)+'.SCN')
stack.stack('FF')
else:
stack.stack('HOLD')
first_confframe = True
first_delframe = True
first_ntrafframe = True
recording = False
for aircraft in traf.id:
if traf.actwp.lon[traf.id2idx(aircraft)] > 10:
if first_delframe:
delframe = np.array([sim.simt, aircraft, traf.lat[traf.id2idx(aircraft)], traf.lon[traf.id2idx(aircraft)], traf.distflown[traf.id2idx(aircraft)]])
first_delframe = False
else:
delframe = np.vstack((delframe, np.array([sim.simt, aircraft, traf.lat[traf.id2idx(aircraft)], traf.lon[traf.id2idx(aircraft)], traf.distflown[traf.id2idx(aircraft)]])))
traf.delete(traf.id2idx(aircraft))
else:
pass
class Traffic(Entity):
"""
Traffic class definition : Traffic data
Methods:
Traffic() : constructor
reset() : Reset traffic database w.r.t a/c data
create(acid,actype,aclat,aclon,achdg,acalt,acspd) : create aircraft
delete(acid) : delete an aircraft from traffic data
deletall() : delete all traffic
update(sim) : do a numerical integration step
id2idx(name) : return index in traffic database of given call sign
engchange(i,engtype) : change engine type of an aircraft
setnoise(A) : Add turbulence
Members: see create
Created by : Jacco M. Hoekstra
"""
def __init__(self):
super().__init__()
# Traffic is the toplevel trafficarrays object
self.setroot(self)
self.ntraf = 0
self.cond = Condition() # Conditional commands list
self.wind = WindSim()
self.turbulence = Turbulence()
self.translvl = 5000.*ft # [m] Default transition level
with self.settrafarrays():
# Aircraft Info
self.id = [] # identifier (string)
self.type = [] # aircaft type (string)
# Positions
self.lat = np.array([]) # latitude [deg]
self.lon = np.array([]) # longitude [deg]
self.distflown = np.array([]) # distance travelled [m]
self.alt = np.array([]) # altitude [m]
self.hdg = np.array([]) # traffic heading [deg]
self.trk = np.array([]) # track angle [deg]
# Velocities
self.tas = np.array([]) # true airspeed [m/s]
self.gs = np.array([]) # ground speed [m/s]
self.gsnorth = np.array([]) # ground speed [m/s]
self.gseast = np.array([]) # ground speed [m/s]
self.cas = np.array([]) # calibrated airspeed [m/s]
self.M = np.array([]) # mach number
self.vs = np.array([]) # vertical speed [m/s]
# Atmosphere
self.p = np.array([]) # air pressure [N/m2]
self.rho = np.array([]) # air density [kg/m3]
self.Temp = np.array([]) # air temperature [K]
self.dtemp = np.array([]) # delta t for non-ISA conditions
# Wind speeds
self.windnorth = np.array([]) # wind speed north component a/c pos [m/s]
self.windeast = np.array([]) # wind speed east component a/c pos [m/s]
# Traffic autopilot settings
self.selspd = np.array([]) # selected spd(CAS or Mach) [m/s or -]
self.aptas = np.array([]) # just for initializing
self.selalt = np.array([]) # selected alt[m]
self.selvs = np.array([]) # selected vertical speed [m/s]
# Whether to perform LNAV and VNAV
self.swlnav = np.array([], dtype=np.bool)
self.swvnav = np.array([], dtype=np.bool)
self.swvnavspd = np.array([], dtype=np.bool)
# Flight Models
self.cd = StateBased()
self.cr = ConflictResolution()
self.ap = Autopilot()
self.aporasas = APorASAS()
self.adsb = ADSB()
self.trails = Trails()
self.actwp = ActiveWaypoint()
self.perf = OpenAP()
# Group Logic
self.groups = TrafficGroups()
# Traffic autopilot data
self.apvsdef = np.array([]) # [m/s]default vertical speed of autopilot
self.aphi = np.array([]) # [rad] bank angle setting of autopilot
self.ax = np.array([]) # [m/s2] absolute value of longitudinal accelleration
self.bank = np.array([]) # nominal bank angle, [radians]
self.swhdgsel = np.array([], dtype=np.bool) # determines whether aircraft is turning
# Traffic autothrottle settings
self.swats = np.array([], dtype=np.bool) # Switch indicating whether autothrottle system is on/off
self.thr = np.array([]) # Thottle seeting (0.0-1.0), negative = non-valid/auto
# Display information on label
self.label = [] # Text and bitmap of traffic label
# Miscallaneous
self.coslat = np.array([]) # Cosine of latitude for computations
self.eps = np.array([]) # Small nonzero numbers
self.work = np.array([]) # Work done throughout the flight
# Default bank angles per flight phase
self.bphase = np.deg2rad(np.array([15, 35, 35, 35, 15, 45]))
def reset(self):
''' Clear all traffic data upon simulation reset. '''
# Some child reset functions depend on a correct value of self.ntraf
self.ntraf = 0
# This ensures that the traffic arrays (which size is dynamic)
# are all reset as well, so all lat,lon,sdp etc but also objects adsb
super().reset()
# reset performance model
self.perf.reset()
# Reset models
self.wind.clear()
# Build new modules for turbulence
self.turbulence.reset()
# Noise (turbulence, ADBS-transmission noise, ADSB-truncated effect)
self.setnoise(False)
# Reset transition level to default value
self.translvl = 5000.*ft
def mcre(self, n, actype="b744", acalt=None, acspd=None, dest=None):
""" Create one or more random aircraft in a specified area """
area = bs.scr.getviewbounds()
# Generate random callsigns
idtmp = chr(randint(65, 90)) + chr(randint(65, 90)) + '{:>05}'
acid = [idtmp.format(i) for i in range(n)]
# Generate random positions
aclat = np.random.rand(n) * (area[1] - area[0]) + area[0]
aclon = np.random.rand(n) * (area[3] - area[2]) + area[2]
achdg = np.random.randint(1, 360, n)
acalt = acalt or np.random.randint(2000, 39000, n) * ft
acspd = acspd or np.random.randint(250, 450, n) * kts
self.cre(acid, actype, aclat, aclon, achdg, acalt, acspd)
# SAVEIC: save cre command when filled in
# Special provision in case SAVEIC is on: then save individual CRE commands
# Names of aircraft (acid) need to be recorded for saved future commands
# And positions need to be the same in case of *MCRE"
for i in range(n):
bs.stack.savecmd("CRE", " ".join(["CRE", acid[i], actype,
str(aclat[i]), str(aclon[i]),
str(int(round(achdg[i]))),
str(int(round(acalt[i]/ft))),
str(int(round(acspd[i]/kts)))]))
def cre(self, acid, actype, aclat, aclon, achdg=None, acalt=0, acspd=0):
""" Create one or more aircraft. """
# Determine number of aircraft to create from array length of acid
n = 1 if isinstance(acid, str) else len(acid)
if isinstance(acid, str):
# Check if not already exist
if self.id.count(acid.upper()) > 0:
return False, acid + " already exists." # already exists do nothing
acid = n * [acid]
# Adjust the size of all traffic arrays
super().create(n)
self.ntraf += n
if isinstance(aclat, (float, int)):
aclat = np.array(n * [aclat])
if isinstance(aclon, (float, int)):
aclon = np.array(n * [aclon])
# Limit longitude to [-180.0, 180.0]
aclon[aclon > 180.0] -= 360.0
aclon[aclon < -180.0] += 360.0
achdg = refdata.hdg if achdg is None else achdg
# Aircraft Info
self.id[-n:] = acid
self.type[-n:] = actype
# Positions
self.lat[-n:] = aclat
self.lon[-n:] = aclon
self.alt[-n:] = acalt
self.hdg[-n:] = achdg
self.trk[-n:] = achdg
# Velocities
self.tas[-n:], self.cas[-n:], self.M[-n:] = vcasormach(acspd, acalt)
self.gs[-n:] = self.tas[-n:]
hdgrad = np.radians(achdg)
self.gsnorth[-n:] = self.tas[-n:] * np.cos(hdgrad)
self.gseast[-n:] = self.tas[-n:] * np.sin(hdgrad)
# Atmosphere
self.p[-n:], self.rho[-n:], self.Temp[-n:] = vatmos(acalt)
# Wind
if self.wind.winddim > 0:
applywind = self.alt[-n:]> 50.*ft
self.windnorth[-n:], self.windeast[-n:] = self.wind.getdata(self.lat[-n:], self.lon[-n:], self.alt[-n:])
self.gsnorth[-n:] = self.gsnorth[-n:] + self.windnorth[-n:]*applywind
self.gseast[-n:] = self.gseast[-n:] + self.windeast[-n:]*applywind
self.trk[-n:] = np.logical_not(applywind)*achdg + \
applywind*np.degrees(np.arctan2(self.gseast[-n:], self.gsnorth[-n:]))
self.gs[-n:] = np.sqrt(self.gsnorth[-n:]**2 + self.gseast[-n:]**2)
else:
self.windnorth[-n:] = 0.0
self.windeast[-n:] = 0.0
# Traffic performance data
#(temporarily default values)
self.apvsdef[-n:] = 1500. * fpm # default vertical speed of autopilot
self.aphi[-n:] = 0. # bank angle output of autopilot (optional)
self.ax[-n:] = kts # absolute value of longitudinal accelleration
self.bank[-n:] = np.radians(25.)
# Traffic autopilot settings
self.selspd[-n:] = self.cas[-n:]
self.aptas[-n:] = self.tas[-n:]
self.selalt[-n:] = self.alt[-n:]
# Display information on label
self.label[-n:] = n*[['', '', '', 0]]
# Miscallaneous
self.coslat[-n:] = np.cos(np.radians(aclat)) # Cosine of latitude for flat-earth aproximations
self.eps[-n:] = 0.01
# Finally call create for child TrafficArrays. This only needs to be done
# manually in Traffic.
self.create_children(n)
def creconfs(self, acid, actype, targetidx, dpsi, cpa, tlosh, dH=None, tlosv=None, spd=None):
latref = self.lat[targetidx] # deg
lonref = self.lon[targetidx] # deg
altref = self.alt[targetidx] # m
trkref = radians(self.trk[targetidx])
gsref = self.gs[targetidx] # m/s
vsref = self.vs[targetidx] # m/s
cpa = cpa * nm
pzr = bs.settings.asas_pzr * nm
pzh = bs.settings.asas_pzh * ft
trk = trkref + radians(dpsi)
gs = gsref if spd is None else spd
if dH is None:
acalt = altref
acvs = 0.0
else:
acalt = altref + dH
tlosv = tlosh if tlosv is None else tlosv
acvs = vsref - np.sign(dH) * (abs(dH) - pzh) / tlosv
# Horizontal relative velocity vector
gsn, gse = gs * cos(trk), gs * sin(trk)
vreln, vrele = gsref * cos(trkref) - gsn, gsref * sin(trkref) - gse
# Relative velocity magnitude
vrel = sqrt(vreln * vreln + vrele * vrele)
# Relative travel distance to closest point of approach
drelcpa = tlosh * vrel + (0 if cpa > pzr else sqrt(pzr * pzr - cpa * cpa))
# Initial intruder distance
dist = sqrt(drelcpa * drelcpa + cpa * cpa)
# Rotation matrix diagonal and cross elements for distance vector
rd = drelcpa / dist
rx = cpa / dist
# Rotate relative velocity vector to obtain intruder bearing
brn = degrees(atan2(-rx * vreln + rd * vrele,
rd * vreln + rx * vrele))
# Calculate intruder lat/lon
aclat, aclon = geo.kwikpos(latref, lonref, brn, dist / nm)
# convert groundspeed to CAS, and track to heading
wn, we = self.wind.getdata(aclat, aclon, acalt)
tasn, tase = gsn - wn, gse - we
acspd = tas2cas(sqrt(tasn * tasn + tase * tase), acalt)
achdg = degrees(atan2(tase, tasn))
# Create and, when necessary, set vertical speed
self.cre(acid, actype,aclat, aclon, achdg, acalt, acspd)
self.ap.selaltcmd(len(self.lat) - 1, altref, acvs)
self.vs[-1] = acvs
def delete(self, idx):
"""Delete an aircraft"""
# If this is a multiple delete, sort first for list delete
# (which will use list in reverse order to avoid index confusion)
if isinstance(idx, Collection):
idx = np.sort(idx)
# Call the actual delete function
super().delete(idx)
# Update number of aircraft
self.ntraf = len(self.lat)
return True
def update(self):
# Update only if there is traffic ---------------------
if self.ntraf == 0:
return
#---------- Atmosphere --------------------------------
self.p, self.rho, self.Temp = vatmos(self.alt)
#---------- ADSB Update -------------------------------
self.adsb.update()
#---------- Fly the Aircraft --------------------------
self.ap.update() # Autopilot logic
self.update_asas() # Airborne Separation Assurance
self.aporasas.update() # Decide to use autopilot or ASAS for commands
#---------- Performance Update ------------------------
self.perf.update()
#---------- Limit commanded speeds based on performance ------------------------------
self.aporasas.tas, self.aporasas.vs, self.aporasas.alt = \
self.perf.limits(self.aporasas.tas, self.aporasas.vs,
self.aporasas.alt, self.ax)
#---------- Kinematics --------------------------------
self.update_airspeed()
self.update_groundspeed()
self.update_pos()
#---------- Simulate Turbulence -----------------------
self.turbulence.update()
# Check whether new traffic state triggers conditional commands
self.cond.update()
#---------- Aftermath ---------------------------------
self.trails.update()
@timed_function(name='asas', dt=bs.settings.asas_dt, manual=True)
def update_asas(self):
# Conflict detection and resolution
self.cd.update(self, self)
self.cr.update(self.cd, self, self)
def update_airspeed(self):
# Compute horizontal acceleration
delta_spd = self.aporasas.tas - self.tas
ax = self.perf.acceleration()
need_ax = np.abs(delta_spd) > np.abs(bs.sim.simdt * ax)
self.ax = need_ax * np.sign(delta_spd) * ax
# Update velocities
self.tas = np.where(need_ax, self.tas + self.ax * bs.sim.simdt, self.aporasas.tas)
self.cas = vtas2cas(self.tas, self.alt)
self.M = vtas2mach(self.tas, self.alt)
# Turning
turnrate = np.degrees(g0 * np.tan(np.where(self.aphi>self.eps,self.aphi,self.bank) \
/ np.maximum(self.tas, self.eps)))
delhdg = (self.aporasas.hdg - self.hdg + 180) % 360 - 180 # [deg]
self.swhdgsel = np.abs(delhdg) > np.abs(bs.sim.simdt * turnrate)
# Update heading
self.hdg = np.where(self.swhdgsel,
self.hdg + bs.sim.simdt * turnrate * np.sign(delhdg), self.aporasas.hdg) % 360.0
# Update vertical speed
delta_alt = self.aporasas.alt - self.alt
self.swaltsel = np.abs(delta_alt) > np.maximum(
10 * ft, np.abs(2 * np.abs(bs.sim.simdt * self.vs)))
target_vs = self.swaltsel * np.sign(delta_alt) * np.abs(self.aporasas.vs)
delta_vs = target_vs - self.vs
# print(delta_vs / fpm)
need_az = np.abs(delta_vs) > 300 * fpm # small threshold
self.az = need_az * np.sign(delta_vs) * (300 * fpm) # fixed vertical acc approx 1.6 m/s^2
self.vs = np.where(need_az, self.vs+self.az*bs.sim.simdt, target_vs)
self.vs = np.where(np.isfinite(self.vs), self.vs, 0) # fix vs nan issue
def update_groundspeed(self):
# Compute ground speed and track from heading, airspeed and wind
if self.wind.winddim == 0: # no wind
self.gsnorth = self.tas * np.cos(np.radians(self.hdg))
self.gseast = self.tas * np.sin(np.radians(self.hdg))
self.gs = self.tas
self.trk = self.hdg
self.windnorth[:], self.windeast[:] = 0.0,0.0
else:
applywind = self.alt>50.*ft # Only apply wind when airborne
vnwnd,vewnd = self.wind.getdata(self.lat, self.lon, self.alt)
self.windnorth[:], self.windeast[:] = vnwnd,vewnd
self.gsnorth = self.tas * np.cos(np.radians(self.hdg)) + self.windnorth*applywind
self.gseast = self.tas * np.sin(np.radians(self.hdg)) + self.windeast*applywind
self.gs = np.logical_not(applywind)*self.tas + \
applywind*np.sqrt(self.gsnorth**2 + self.gseast**2)
self.trk = np.logical_not(applywind)*self.hdg + \
applywind*np.degrees(np.arctan2(self.gseast, self.gsnorth)) % 360.
self.work += (self.perf.thrust * bs.sim.simdt * np.sqrt(self.gs * self.gs + self.vs * self.vs))
def update_pos(self):
# Update position
self.alt = np.where(self.swaltsel, np.round(self.alt + self.vs * bs.sim.simdt, 6), self.aporasas.alt)
self.lat = self.lat + np.degrees(bs.sim.simdt * self.gsnorth / Rearth)
self.coslat = np.cos(np.deg2rad(self.lat))
self.lon = self.lon + np.degrees(bs.sim.simdt * self.gseast / self.coslat / Rearth)
self.distflown += self.gs * bs.sim.simdt
def id2idx(self, acid):
"""Find index of aircraft id"""
if not isinstance(acid, str):
# id2idx is called for multiple id's
# Fast way of finding indices of all ACID's in a given list
tmp = dict((v, i) for i, v in enumerate(self.id))
return [tmp.get(acidi, -1) for acidi in acid]
else:
# Catch last created id (* or # symbol)
if acid in ('#', '*'):
return self.ntraf - 1
try:
return self.id.index(acid.upper())
except:
return -1
def setnoise(self, noise=None):
"""Noise (turbulence, ADBS-transmission noise, ADSB-truncated effect)"""
if noise is None:
return True, "Noise is currently " + ("on" if self.turbulence.active else "off")
self.turbulence.setnoise(noise)
self.adsb.setnoise(noise)
return True
def engchange(self, acid, engid):
"""Change of engines"""
self.perf.engchange(acid, engid)
return
def move(self, idx, lat, lon, alt=None, hdg=None, casmach=None, vspd=None):
self.lat[idx] = lat
self.lon[idx] = lon
if alt is not None:
self.alt[idx] = alt
self.selalt[idx] = alt
if hdg is not None:
self.hdg[idx] = hdg
self.ap.trk[idx] = hdg
if casmach is not None:
self.tas[idx], self.selspd[idx], _ = vcasormach(casmach, alt)
if vspd is not None:
self.vs[idx] = vspd
self.swvnav[idx] = False
def nom(self, idx):
""" Reset acceleration back to nominal (1 kt/s^2): NOM acid """
self.ax[idx] = kts #[m/s2]
def poscommand(self, idxorwp):# Show info on aircraft(int) or waypoint or airport (str)
"""POS command: Show info or an aircraft, airport, waypoint or navaid"""
# Aircraft index
if type(idxorwp)==int and idxorwp >= 0:
idx = idxorwp
acid = self.id[idx]
actype = self.type[idx]
latlon = latlon2txt(self.lat[idx], self.lon[idx])
alt = round(self.alt[idx] / ft)
hdg = round(self.hdg[idx])
trk = round(self.trk[idx])
cas = round(self.cas[idx] / kts)
tas = round(self.tas[idx] / kts)
gs = round(self.gs[idx]/kts)
M = self.M[idx]
VS = round(self.vs[idx]/ft*60.)
route = self.ap.route[idx]
# Position report
lines = "Info on %s %s index = %d\n" %(acid, actype, idx) \
+ "Pos: "+latlon+ "\n" \
+ "Hdg: %03d Trk: %03d\n" %(hdg, trk) \
+ "Alt: %d ft V/S: %d fpm\n" %(alt,VS) \
+ "CAS/TAS/GS: %d/%d/%d kts M: %.3f\n"%(cas,tas,gs,M)
# FMS AP modes
if self.swlnav[idx] and route.nwp > 0 and route.iactwp >= 0:
if self.swvnav[idx]:
if self.swvnavspd[idx]:
lines = lines + "VNAV (incl.VNAVSPD), "
else:
lines = lines + "VNAV (NOT VNAVSPD), "
lines += "LNAV to " + route.wpname[route.iactwp] + "\n"
# Flight info: Destination and origin
if self.ap.orig[idx] != "" or self.ap.dest[idx] != "":
lines = lines + "Flying"
if self.ap.orig[idx] != "":
lines = lines + " from " + self.ap.orig[idx]
if self.ap.dest[idx] != "":
lines = lines + " to " + self.ap.dest[idx]
# Show a/c info and highlight route of aircraft in radar window
# and pan to a/c (to show route)
bs.scr.showroute(acid)
return True, lines
# Waypoint: airport, navaid or fix
else:
wp = idxorwp.upper()
# Reference position for finding nearest
reflat, reflon = bs.scr.getviewctr()
lines = "Info on "+wp+":\n"
# First try airports (most used and shorter, hence faster list)
iap = bs.navdb.getaptidx(wp)
if iap>=0:
aptypes = ["large","medium","small"]
lines = lines + bs.navdb.aptname[iap]+"\n" \
+ "is a "+ aptypes[max(-1,bs.navdb.aptype[iap]-1)] \
+" airport at:\n" \
+ latlon2txt(bs.navdb.aptlat[iap], \
bs.navdb.aptlon[iap]) + "\n" \
+ "Elevation: " \
+ str(int(round(bs.navdb.aptelev[iap]/ft))) \
+ " ft \n"
# Show country name
try:
ico = bs.navdb.cocode2.index(bs.navdb.aptco[iap].upper())
lines = lines + "in "+bs.navdb.coname[ico]+" ("+ \
bs.navdb.aptco[iap]+")"
except:
ico = -1
lines = lines + "Country code: "+bs.navdb.aptco[iap]
try:
runways = bs.navdb.rwythresholds[bs.navdb.aptid[iap]].keys()
if runways:
lines = lines + "\nRunways: " + ", ".join(runways)
except KeyError:
pass
# Not found as airport, try waypoints & navaids
else:
iwps = bs.navdb.getwpindices(wp,reflat,reflon)
if iwps[0]>=0:
typetxt = ""
desctxt = ""
lastdesc = "XXXXXXXX"
for i in iwps:
# One line type text
if typetxt == "":
typetxt = typetxt+bs.navdb.wptype[i]
else:
typetxt = typetxt+" and "+bs.navdb.wptype[i]
# Description: multi-line
samedesc = bs.navdb.wpdesc[i]==lastdesc
if desctxt == "":
desctxt = desctxt +bs.navdb.wpdesc[i]
lastdesc = bs.navdb.wpdesc[i]
elif not samedesc:
desctxt = desctxt +"\n"+bs.navdb.wpdesc[i]
lastdesc = bs.navdb.wpdesc[i]
# Navaid: frequency
if bs.navdb.wptype[i] in ["VOR","DME","TACAN"] and not samedesc:
desctxt = desctxt + " "+ str(bs.navdb.wpfreq[i])+" MHz"
elif bs.navdb.wptype[i]=="NDB" and not samedesc:
desctxt = desctxt+ " " + str(bs.navdb.wpfreq[i])+" kHz"
iwp = iwps[0]
# Basic info
lines = lines + wp +" is a "+ typetxt \
+ " at\n"\
+ latlon2txt(bs.navdb.wplat[iwp], \
bs.navdb.wplon[iwp])
# Navaids have description
if len(desctxt)>0:
lines = lines+ "\n" + desctxt
# VOR give variation
if bs.navdb.wptype[iwp]=="VOR":
lines = lines + "\nVariation: "+ \
str(bs.navdb.wpvar[iwp])+" deg"
# How many others?
nother = bs.navdb.wpid.count(wp)-len(iwps)
if nother>0:
verb = ["is ","are "][min(1,max(0,nother-1))]
lines = lines +"\nThere "+verb + str(nother) +\
" other waypoint(s) also named " + wp
# In which airways?
connect = bs.navdb.listconnections(wp, \
bs.navdb.wplat[iwp],
bs.navdb.wplon[iwp])
if len(connect)>0:
awset = set([])
for c in connect:
awset.add(c[0])
lines = lines+"\nAirways: "+"-".join(awset)
# Try airway id
else: # airway
awid = wp
airway = bs.navdb.listairway(awid)
if len(airway)>0:
lines = ""
for segment in airway:
lines = lines+"Airway "+ awid + ": " + \
" - ".join(segment)+"\n"
lines = lines[:-1] # cut off final newline
else:
return False,idxorwp+" not found as a/c, airport, navaid or waypoint"
# Show what we found on airport and navaid/waypoint
return True, lines
def airwaycmd(self, key):
''' Show conections of a waypoint or airway. '''
reflat, reflon = bs.scr.getviewctr()
if bs.navdb.awid.count(key) > 0:
return self.poscommand(key)
# Find connecting airway legs
wpid = key
iwp = bs.navdb.getwpidx(wpid,reflat,reflon)
if iwp < 0:
return False,key + " not found."
wplat = bs.navdb.wplat[iwp]
wplon = bs.navdb.wplon[iwp]
connect = bs.navdb.listconnections(key, wplat, wplon)
if connect:
lines = ""
for c in connect:
if len(c)>=2:
# Add airway, direction, waypoint
lines = lines+ c[0]+": to "+c[1]+"\n"
return True, lines[:-1] # exclude final newline
return False, f"No airway legs found for {key}"
def settrans(self, alt=-999.):
""" Set or show transition level"""
# in case a valid value is ginve set it
if alt > -900.:
if alt > 0.:
self.translvl = alt
return True
return False,"Transition level needs to be ft/FL and larger than zero"
# In case no value is given, show it
tlvl = int(round(self.translvl/ft))
return True, f"Transition level = {tlvl}/FL{int(round(tlvl/100.))}"
def setbanklim(self, idx, bankangle=None):
''' Set bank limit for given aircraft. '''
if bankangle:
self.bank[idx] = np.radians(bankangle) # [rad]
return True
return True, f"Banklimit of {self.id[idx]} is {int(np.degrees(self.bank[idx]))} deg"
def setthrottle(self,idx,throttle=""):
"""Set throttle to given value or AUTO, meaning autothrottle on (default)"""
if throttle:
if throttle in ('AUTO', 'OFF'): # throttle mode off, ATS on
self.swats[idx] = True # Autothrottle on
self.thr[idx] = -999. # Set to invalid
elif throttle == "IDLE":
self.swats[idx] = False
self.thr[idx] = 0.0
else:
# Check for percent unit
if throttle.count("%")==1:
throttle= throttle.replace("%","")
factor = 0.01
else:
factor = 1.0
# Remaining option is that it is a float, so try conversion
try:
x = factor*float(throttle)
except:
return False,"THR invalid argument "+throttle
# Check whether value makes sense
if x<0.0 or x>1.0:
return False, "THR invalid value " + throttle +". Needs to be [0.0 , 1.0]"
# Valid value, set throttle and disable autothrottle
self.swats[idx] = False
self.thr[idx] = x
return True
if self.swats[idx]:
return True,"ATS of "+self.id[idx]+" is ON"
return True, "ATS of " + self.id[idx] + " is OFF. THR is "+str(self.thr[idx])