def buildDeparturePhase(self):
'''
this function manages the departure phases with a ground run and a climb ramp
'''
print(self.className +
' ============== build the departure ground run =========== ')
self.finalRoute = GroundRunLeg(runway=self.departureRunway,
aircraft=self.aircraft,
airport=self.departureAirport)
distanceToLastFixMeters = self.computeDistanceToLastFixMeters(
currentPosition=self.departureAirport, fixListIndex=0)
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters(
)
elapsedTimeSeconds = 0.0
self.finalRoute.buildDepartureGroundRun(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=elapsedTimeSeconds,
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters)
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters(
)
#print '==================== end of ground run ==================== '
initialWayPoint = self.finalRoute.getLastVertex().getWeight()
distanceToFirstFixNautics = initialWayPoint.getDistanceMetersTo(
self.getFirstWayPoint()) * Meter2NauticalMiles
#print '==================== Initial Climb Ramp ==================== '
climbRamp = ClimbRamp(initialWayPoint=initialWayPoint,
runway=self.departureRunway,
aircraft=self.aircraft,
departureAirport=self.departureAirport)
''' climb ramp of 5.0 nautics is not possible if first fix placed in between '''
climbRampLengthNautics = min(distanceToFirstFixNautics / 2.0, 5.0)
climbRamp.buildClimbRamp(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=initialWayPoint.getElapsedTimeSeconds(),
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters,
climbRampLengthNautics=climbRampLengthNautics)
self.finalRoute.addGraph(climbRamp)
#print '============= initial condition for the route ================='
initialWayPoint = self.finalRoute.getLastVertex().getWeight()
lastLeg = self.finalRoute.getLastEdge()
initialHeadingDegrees = lastLeg.getBearingTailHeadDegrees()
print(self.className +
': last leg orientation= {0:.2f} degrees'.format(
initialHeadingDegrees))
#'''============= add way point in the fix list =============== '''
self.insert(position='begin', wayPoint=initialWayPoint)
#print self.className + ': fix list= {0}'.format(self.fixList)
return initialHeadingDegrees, initialWayPoint
def buildDeparturePhase(self):
"""
this function manages the departure phases with a ground run and a climb ramp
"""
print self.className + " ============== build the departure ground run =========== "
self.finalRoute = GroundRunLeg(
runway=self.departureRunway, aircraft=self.aircraft, airport=self.departureAirport
)
distanceToLastFixMeters = self.computeDistanceToLastFixMeters(
currentPosition=self.departureAirport, fixListIndex=0
)
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters()
elapsedTimeSeconds = 0.0
self.finalRoute.buildDepartureGroundRun(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=elapsedTimeSeconds,
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters,
)
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters()
# print '==================== end of ground run ==================== '
initialWayPoint = self.finalRoute.getLastVertex().getWeight()
distanceToFirstFixNautics = initialWayPoint.getDistanceMetersTo(self.getFirstWayPoint()) * Meter2NauticalMiles
# print '==================== Initial Climb Ramp ==================== '
climbRamp = ClimbRamp(
initialWayPoint=initialWayPoint,
runway=self.departureRunway,
aircraft=self.aircraft,
departureAirport=self.departureAirport,
)
""" climb ramp of 5.0 nautics is not possible is first fix in between """
climbRampLengthNautics = min(distanceToFirstFixNautics / 2.0, 5.0)
climbRamp.buildClimbRamp(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=initialWayPoint.getElapsedTimeSeconds(),
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters,
climbRampLengthNautics=climbRampLengthNautics,
)
self.finalRoute.addGraph(climbRamp)
# print '============= initial condition for the route ================='
initialWayPoint = self.finalRoute.getLastVertex().getWeight()
lastLeg = self.finalRoute.getLastEdge()
initialHeadingDegrees = lastLeg.getBearingTailHeadDegrees()
print self.className + ": last leg orientation= {0:.2f} degrees".format(initialHeadingDegrees)
#'''============= add way point in the fix list =============== '''
self.insert(position="begin", wayPoint=initialWayPoint)
# print self.className + ': fix list= {0}'.format(self.fixList)
return initialHeadingDegrees, initialWayPoint
def buildArrivalPhase(self, initialHeadingDegrees):
print(
self.className +
': initial heading= {0:.2f} degrees'.format(initialHeadingDegrees))
print(self.className +
'==================== add last turn ==================== ')
if self.isDomestic() or self.isInBound():
endOfLastGreatCircleWayPoint = self.finalRoute.getLastVertex(
).getWeight()
finalHeadingDegrees = self.arrivalRunway.getTrueHeadingDegrees()
finalHeadingDegrees = math.fmod(finalHeadingDegrees + 180.0, 360.0)
print(self.className +
': runway final heading= {0:.2f} degrees'.format(
finalHeadingDegrees))
turnLeg = TurnLeg(
initialWayPoint=endOfLastGreatCircleWayPoint,
#finalWayPoint = self.firstGlideSlopeWayPoint,
finalWayPoint=self.touchDownWayPoint,
initialHeadingDegrees=initialHeadingDegrees,
aircraft=self.aircraft,
reverse=False)
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters(
)
distanceToLastFixMeters = self.computeDistanceToLastFixMeters(
currentPosition=endOfLastGreatCircleWayPoint,
fixListIndex=self.flightListIndex)
distanceToLastFixMeters = distanceStillToFlyMeters
''' for the last turn => final heading towards the runway orientation '''
deltaTimeSeconds = 0.1
turnLeg.buildTurnLeg(
deltaTimeSeconds=deltaTimeSeconds,
elapsedTimeSeconds=endOfLastGreatCircleWayPoint.
getElapsedTimeSeconds(),
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters,
finalHeadingDegrees=finalHeadingDegrees,
lastTurn=True,
bankAngleDegrees=5.0,
arrivalRunway=self.arrivalRunway)
self.finalRoute.addGraph(turnLeg)
endOfTurnLegWayPoint = self.finalRoute.getLastVertex().getWeight()
''' ============= use touch-down way-point to compute distance to fly ============='''
distanceStillToFlyMeters = endOfTurnLegWayPoint.getDistanceMetersTo(
self.touchDownWayPoint)
print(self.className +
': distance still to fly= {0:.2f} nautics'.format(
distanceStillToFlyMeters * Meter2NauticalMiles))
#print '==================== add descent slope ================= '
descentGlideSlope = DescentGlideSlope(
runway=self.arrivalRunway,
aircraft=self.aircraft,
arrivalAirport=self.arrivalAirport,
descentGlideSlopeDegrees=3.0)
flownDistanceMeters = self.finalRoute.getLengthMeters()
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters(
)
distanceToLastFixMeters = self.computeDistanceToLastFixMeters(
currentPosition=endOfTurnLegWayPoint,
fixListIndex=self.flightListIndex)
distanceToLastFixMeters = distanceStillToFlyMeters
descentGlideSlope.buildGlideSlope(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=endOfTurnLegWayPoint.getElapsedTimeSeconds(
),
initialWayPoint=endOfTurnLegWayPoint,
flownDistanceMeters=flownDistanceMeters,
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters)
self.finalRoute.addGraph(descentGlideSlope)
endOfDescentGlideSlope = self.finalRoute.getLastVertex().getWeight(
)
#print '================= add arrival ground run ================'
arrivalGroundRun = GroundRunLeg(runway=self.arrivalRunway,
aircraft=self.aircraft,
airport=self.arrivalAirport)
arrivalGroundRun.buildArrivalGroundRun(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=endOfDescentGlideSlope.
getElapsedTimeSeconds(),
initialWayPoint=endOfDescentGlideSlope)
self.finalRoute.addGraph(arrivalGroundRun)
def buildSimulatedArrivalPhase(self):
print(
self.className +
'=========== add final turn, descent and ground run ==================='
)
arrivalGroundRun = GroundRunLeg(runway=self.arrivalRunway,
aircraft=self.aircraft,
airport=self.arrivalAirport)
self.touchDownWayPoint = arrivalGroundRun.computeTouchDownWayPoint()
# add touch down to constraint list
self.constraintsList.append(
ArrivalRunWayTouchDownConstraint(self.touchDownWayPoint))
print(self.touchDownWayPoint)
''' distance from last fix to touch down '''
distanceToLastFixNautics = self.touchDownWayPoint.getDistanceMetersTo(
self.getLastWayPoint()) * Meter2NauticalMiles
print(
self.className +
'===================== final 3 degrees descending glide slope ================'
)
descentGlideSlope = DescentGlideSlope(
runway=self.arrivalRunway,
aircraft=self.aircraft,
arrivalAirport=self.arrivalAirport,
descentGlideSlopeDegrees=3.0)
''' if there is a fix nearer to 5 nautics of the touch-down then limit size of simulated glide slope '''
descentGlideSlopeSizeNautics = min(distanceToLastFixNautics / 2.0, 5.0)
''' build simulated glide slope '''
descentGlideSlope.buildSimulatedGlideSlope(
descentGlideSlopeSizeNautics)
self.firstGlideSlopeWayPoint = descentGlideSlope.getVertex(
v=0).getWeight()
print(self.className + ': top of arrival glide slope= {0}'.format(
self.firstGlideSlopeWayPoint))
print(
self.className +
' ================= need a turn leg to find the junction point the last way-point in the fix list to the top of the final glide slope'
)
'''
initial heading is the orientation of the run-way
'''
lastFixListWayPoint = self.wayPointsDict[self.fixList[-1]]
initialHeadingDegrees = self.arrivalRunway.getTrueHeadingDegrees()
print("=====> arrival runway - true heading degrees = {0}".format(
initialHeadingDegrees))
lastTurnLeg = TurnLeg(initialWayPoint=self.firstGlideSlopeWayPoint,
finalWayPoint=lastFixListWayPoint,
initialHeadingDegrees=initialHeadingDegrees,
aircraft=self.aircraft,
reverse=True)
lastTurnLeg.buildNewSimulatedArrivalTurnLeg(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=0.0,
distanceStillToFlyMeters=0.0,
simulatedAltitudeSeaLevelMeters=self.firstGlideSlopeWayPoint.
getAltitudeMeanSeaLevelMeters(),
flightPathAngleDegrees=3.0,
bankAngleDegrees=5.0)
descentGlideSlope.addGraph(lastTurnLeg)
#print self.className + ': compute arrival phase length= {0:.2f} meters'.format(descentGlideSlope.getLengthMeters())
#descentGlideSlope.createXlsxOutputFile()
#descentGlideSlope.createKmlOutputFile()
''' prepare next step '''
beginOfLastTurnLeg = lastTurnLeg.getVertex(v=0).getWeight()
print(self.className +
': begin of last turn= {0}'.format(beginOfLastTurnLeg))
''' add to constraint list '''
self.constraintsList.append(
TargetApproachConstraint(beginOfLastTurnLeg))
''' add the three last way-points in the fix list '''
self.insert(position='end', wayPoint=beginOfLastTurnLeg)
''' update the length of the flight path '''
self.distanceFromApproachToTouchDownMeters = descentGlideSlope.getLengthMeters(
)
self.flightLengthMeters = self.computeLengthMeters(
) + descentGlideSlope.getLengthMeters()
print(self.className +
': updated flight path length= {0:.2f} nautics'.format(
self.flightLengthMeters * Meter2NauticalMiles))
''' target approach fix is equal to the begin of the SIMULATED last turn leg '''
self.aircraft.setTargetApproachWayPoint(beginOfLastTurnLeg)
self.aircraft.setArrivalRunwayTouchDownWayPoint(self.touchDownWayPoint)
print(self.className + ': fix list= {0}'.format(self.fixList))
def test_TurnLeg(self):
print '==================== Turn Leg ==================== ' + time.strftime(
"%c")
atmosphere = Atmosphere()
earth = Earth()
acBd = BadaAircraftDatabase()
aircraftICAOcode = 'A320'
assert acBd.read()
assert acBd.aircraftExists(aircraftICAOcode)
assert acBd.aircraftPerformanceFileExists(aircraftICAOcode)
print '==================== aircraft found ==================== ' + time.strftime(
"%c")
aircraft = BadaAircraft(
ICAOcode=aircraftICAOcode,
aircraftFullName=acBd.getAircraftFullName(aircraftICAOcode),
badaPerformanceFilePath=acBd.getAircraftPerformanceFile(
aircraftICAOcode),
atmosphere=atmosphere,
earth=earth)
aircraft.dump()
print '==================== Get Airport ==================== ' + time.strftime(
"%c")
airportsDB = AirportsDatabase()
assert airportsDB.read()
print '==================== Get Arrival Airport ==================== ' + time.strftime(
"%c")
Lisbonne = airportsDB.getAirportFromICAOCode('LPPT')
print Lisbonne
print '==================== find the run-ways ==================== ' + time.strftime(
"%c")
runWaysDatabase = RunWayDataBase()
if runWaysDatabase.read():
print 'runways DB correctly read'
print '==================== take off run-way ==================== ' + time.strftime(
"%c")
arrivalRunway = runWaysDatabase.getFilteredRunWays(
airportICAOcode='LPPT', runwayName='')
print arrivalRunway
print '==================== Ground run ==================== ' + time.strftime(
"%c")
groundRun = GroundRunLeg(runway=arrivalRunway,
aircraft=aircraft,
airport=Lisbonne)
touchDownWayPoint = groundRun.computeTouchDownWayPoint()
print touchDownWayPoint
groundRun.buildDepartureGroundRun(deltaTimeSeconds=1.0,
elapsedTimeSeconds=0.0,
distanceStillToFlyMeters=0.0,
distanceToLastFixMeters=0.0)
print '==================== Climb Ramp ==================== ' + time.strftime(
"%c")
initialWayPoint = groundRun.getLastVertex().getWeight()
descentGlideSlope = DescentGlideSlope(runway=arrivalRunway,
aircraft=aircraft,
arrivalAirport=Lisbonne,
descentGlideSlopeDegrees=3.0)
''' if there is a fix nearer to 5 nautics of the touch-down then limit size of simulated glide slope '''
descentGlideSlope.buildSimulatedGlideSlope(
descentGlideSlopeSizeNautics=5.0)
descentGlideSlope.createKmlOutputFile()
firstGlideSlopeWayPoint = descentGlideSlope.getVertex(v=0).getWeight()
print '==================== Climb Ramp ==================== ' + time.strftime(
"%c")
initialWayPoint = groundRun.getLastVertex().getWeight()
print ' ================== turn leg end =============== '
wayPointsDb = WayPointsDatabase()
assert (wayPointsDb.read())
Exona = wayPointsDb.getWayPoint('EXONA')
Rosal = wayPointsDb.getWayPoint('ROSAL')
print Rosal.getBearingDegreesTo(Exona)
initialHeadingDegrees = arrivalRunway.getTrueHeadingDegrees()
lastTurnLeg = TurnLeg(initialWayPoint=firstGlideSlopeWayPoint,
finalWayPoint=Exona,
initialHeadingDegrees=initialHeadingDegrees,
aircraft=aircraft,
reverse=True)
deltaTimeSeconds = 1.0
lastTurnLeg.buildNewSimulatedArrivalTurnLeg(
deltaTimeSeconds=deltaTimeSeconds,
elapsedTimeSeconds=0.0,
distanceStillToFlyMeters=0.0,
simulatedAltitudeSeaLevelMeters=firstGlideSlopeWayPoint.
getAltitudeMeanSeaLevelMeters(),
flightPathAngleDegrees=3.0)
lastTurnLeg.createKmlOutputFile()
descentGlideSlope.addGraph(lastTurnLeg)
#descentGlideSlope.createXlsxOutputFile()
descentGlideSlope.createKmlOutputFile()
print ' ================== turn leg end =============== '
def test_ClimbRamp(self):
atmosphere = Atmosphere()
earth = Earth()
print '==================== Three Degrees climb slope ==================== '+ time.strftime("%c")
acBd = BadaAircraftDatabase()
aircraftICAOcode = 'A320'
if acBd.read():
if ( acBd.aircraftExists(aircraftICAOcode)
and acBd.aircraftPerformanceFileExists(aircraftICAOcode)):
print '==================== aircraft found ==================== '+ time.strftime("%c")
aircraft = BadaAircraft(
ICAOcode = aircraftICAOcode,
aircraftFullName = acBd.getAircraftFullName(aircraftICAOcode),
badaPerformanceFilePath = acBd.getAircraftPerformanceFile(aircraftICAOcode),
atmosphere = atmosphere,
earth = earth)
aircraft.dump()
assert not(aircraft is None)
print '==================== get Charles Gaulle airport ==================== '+ time.strftime("%c")
airportsDB = AirportsDatabase()
assert(airportsDB.read())
CharlesDeGaulle = airportsDB.getAirportFromICAOCode('LFPG')
print CharlesDeGaulle
assert not(aircraft is None)
aircraft.setTargetCruiseFlightLevel(RequestedFlightLevel = 390,
departureAirportAltitudeMSLmeters = CharlesDeGaulle.getAltitudeMeanSeaLevelMeters())
print '==================== Three Degrees climb slope==================== '+ time.strftime("%c")
runWaysDatabase = RunWayDataBase()
if runWaysDatabase.read():
print 'runways DB correctly read'
runway = runWaysDatabase.getFilteredRunWays('LFPG')
print runway
print '==================== Ground Run ==================== '+ time.strftime("%c")
groundRun = GroundRunLeg(runway=runway,
aircraft=aircraft,
airport=CharlesDeGaulle)
groundRun.buildDepartureGroundRun(deltaTimeSeconds = 0.1,
elapsedTimeSeconds = 0.0,
distanceStillToFlyMeters = 100000.0,
distanceToLastFixMeters = 100000.0)
print '==================== Three Degrees climb slope==================== '+ time.strftime("%c")
initialVertex = groundRun.getVertex(groundRun.getNumberOfVertices()-1)
initialWayPoint = initialVertex.getWeight()
climbRamp = ClimbRamp(initialWayPoint = initialWayPoint,
runway=runway,
aircraft=aircraft,
departureAirport=CharlesDeGaulle)
climbRamp.buildClimbRamp(deltaTimeSeconds = 0.1,
elapsedTimeSeconds = 0.0,
distanceStillToFlyMeters = 100000.0,
distanceToLastFixMeters = 100000.0,
climbRampLengthNautics = 5.0 )
groundRun.addGraph(climbRamp)
groundRun.createKmlOutputFile()
print "=========== ThreeDegreesGlideSlope end =========== " + time.strftime("%c")
def test_One(self):
print('=========== main start ==================')
aircraftICAOcode = 'A320'
atmosphere = Atmosphere()
assert (not (atmosphere is None))
earth = Earth()
assert (not (earth is None))
acBd = BadaAircraftDatabase()
assert acBd.read()
if (acBd.aircraftExists(aircraftICAOcode)
and acBd.aircraftPerformanceFileExists(aircraftICAOcode)):
aircraft = BadaAircraft(
ICAOcode=aircraftICAOcode,
aircraftFullName=acBd.getAircraftFullName(aircraftICAOcode),
badaPerformanceFilePath=acBd.getAircraftPerformanceFile(
aircraftICAOcode),
atmosphere=atmosphere,
earth=earth)
aircraft.dump()
else:
raise ValueError(': aircraft not found= ' + aircraftICAOcode)
assert not (aircraft is None)
print('================ load airports =================')
airportsDB = AirportsDatabase()
assert (airportsDB.read())
adepIcaoCode = 'LFML'
departureAirport = airportsDB.getAirportFromICAOCode(adepIcaoCode)
print(': departure airport= ' + str(departureAirport))
assert not (departureAirport is None)
print('================ load runways =================')
runWaysDatabase = RunWayDataBase()
assert (runWaysDatabase.read())
print('==================== take off run-way ==================== ')
departureRunway = runWaysDatabase.getFilteredRunWays(adepIcaoCode)
print(
'=========== minimum and maximum aircraft mass ==================')
minMassKg = aircraft.getMinimumMassKilograms()
print('aircraft minimum mass: ' + str(minMassKg) + ' kilograms')
maxMassKg = aircraft.getMaximumMassKilograms()
print('aircraft maximum mass: ' + str(maxMassKg) + ' kilograms')
deltaMass = maxMassKg - minMassKg
massKg = 39000.0
while (massKg < maxMassKg):
massKg += 1000.0
print(
'==================== set aircraft reference mass ==================== '
)
aircraft = BadaAircraft(
ICAOcode=aircraftICAOcode,
aircraftFullName=acBd.getAircraftFullName(aircraftICAOcode),
badaPerformanceFilePath=acBd.getAircraftPerformanceFile(
aircraftICAOcode),
atmosphere=atmosphere,
earth=earth)
aircraft.setTargetCruiseFlightLevel(
310, departureAirport.getFieldElevationAboveSeaLevelMeters())
print(
'==================== aircraft reference mass ==================== '
)
print('aircraft reference mass= ' + str(massKg) + ' Kilograms')
aircraft.setAircraftMassKilograms(massKg)
print(
'==================== begin of ground run ==================== '
)
groundRunLeg = GroundRunLeg(runway=departureRunway,
aircraft=aircraft,
airport=departureAirport)
groundRunLeg.buildDepartureGroundRun(
deltaTimeSeconds=0.1,
elapsedTimeSeconds=0.0,
distanceStillToFlyMeters=500000.0,
distanceToLastFixMeters=500000.0)
groundRunLeg.computeLengthMeters()
#groundRunLeg.createXlsxOutputFile()
print(
'==================== end of ground run ==================== ')
initialWayPoint = groundRunLeg.getLastVertex().getWeight()
print(
'==================== dump aircraft speed profile ==================== '
)
aircraft.createStateVectorOutputFile(aircraftICAOcode + "-Mass-" +
str(massKg))
print('=========== main end ==================')
print ( '==================== aircraft found ==================== '+ time.strftime("%c") )
aircraft = BadaAircraft(aircraftICAOcode,
acBd.getAircraftPerformanceFile(aircraftICAOcode),
atmosphere,
earth)
print ( '==========================' )
print ( runway )
airportIcaoCode = runway.getAirportICAOcode()
airport = airportsDB.getAirportFromICAOCode(airportIcaoCode)
print ( '==========================' )
print ( airport )
print ( '==================== ground run ==================== '+ time.strftime("%c") )
groundRun = GroundRunLeg(runway=runway,
aircraft=aircraft,
airport=airport)
groundRun.buildDepartureGroundRun()
initialWayPoint = groundRun.getLastVertex().getWeight()
climbRamp = ClimbRamp(initialWayPoint=initialWayPoint,
runway=runway,
aircraft=aircraft,
departureAirport=airport)
climbRamp.buildClimbRamp()
groundRun.addGraph(climbRamp)
groundRun.createKmlOutputFile()
def buildArrivalPhase(self, initialHeadingDegrees):
print self.className + "==================== add last turn ==================== "
if self.isDomestic() or self.isInBound():
endOfLastGreatCircleWayPoint = self.finalRoute.getLastVertex().getWeight()
finalHeadingDegrees = self.arrivalRunway.getTrueHeadingDegrees()
finalHeadingDegrees = math.fmod(finalHeadingDegrees + 180.0, 360.0)
print self.className + ": runway final heading= {0:.2f} degrees".format(finalHeadingDegrees)
turnLeg = TurnLeg(
initialWayPoint=endOfLastGreatCircleWayPoint,
# finalWayPoint = self.firstGlideSlopeWayPoint,
finalWayPoint=self.touchDownWayPoint,
initialHeadingDegrees=initialHeadingDegrees,
aircraft=self.aircraft,
reverse=False,
)
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters()
distanceToLastFixMeters = self.computeDistanceToLastFixMeters(
currentPosition=endOfLastGreatCircleWayPoint, fixListIndex=self.flightListIndex
)
distanceToLastFixMeters = distanceStillToFlyMeters
""" for the last turn => final heading towards the runway orientation """
deltaTimeSeconds = 0.1
turnLeg.buildTurnLeg(
deltaTimeSeconds=deltaTimeSeconds,
elapsedTimeSeconds=endOfLastGreatCircleWayPoint.getElapsedTimeSeconds(),
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters,
finalHeadingDegrees=finalHeadingDegrees,
lastTurn=True,
bankAngleDegrees=5.0,
)
self.finalRoute.addGraph(turnLeg)
endOfTurnLegWayPoint = self.finalRoute.getLastVertex().getWeight()
""" ============= use touch-down way-point to compute distance to fly ============="""
distanceStillToFlyMeters = endOfTurnLegWayPoint.getDistanceMetersTo(self.touchDownWayPoint)
print self.className + ": distance still to fly= {0:.2f} nautics".format(
distanceStillToFlyMeters * Meter2NauticalMiles
)
# print '==================== add descent slope ================= '
descentGlideSlope = DescentGlideSlope(
runway=self.arrivalRunway,
aircraft=self.aircraft,
arrivalAirport=self.arrivalAirport,
descentGlideSlopeDegrees=3.0,
)
flownDistanceMeters = self.finalRoute.getLengthMeters()
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters()
distanceToLastFixMeters = self.computeDistanceToLastFixMeters(
currentPosition=endOfTurnLegWayPoint, fixListIndex=self.flightListIndex
)
distanceToLastFixMeters = distanceStillToFlyMeters
descentGlideSlope.buildGlideSlope(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=endOfTurnLegWayPoint.getElapsedTimeSeconds(),
initialWayPoint=endOfTurnLegWayPoint,
flownDistanceMeters=flownDistanceMeters,
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters,
)
self.finalRoute.addGraph(descentGlideSlope)
endOfDescentGlideSlope = self.finalRoute.getLastVertex().getWeight()
# print '================= add arrival ground run ================'
arrivalGroundRun = GroundRunLeg(
runway=self.arrivalRunway, aircraft=self.aircraft, airport=self.arrivalAirport
)
arrivalGroundRun.buildArrivalGroundRun(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=endOfDescentGlideSlope.getElapsedTimeSeconds(),
initialWayPoint=endOfDescentGlideSlope,
)
self.finalRoute.addGraph(arrivalGroundRun)
def buildSimulatedArrivalPhase(self):
print self.className + "=========== add final turn, descent and ground run ==================="
arrivalGroundRun = GroundRunLeg(runway=self.arrivalRunway, aircraft=self.aircraft, airport=self.arrivalAirport)
self.touchDownWayPoint = arrivalGroundRun.computeTouchDownWayPoint()
print self.touchDownWayPoint
""" distance from last fix to touch down """
distanceToLastFixNautics = (
self.touchDownWayPoint.getDistanceMetersTo(self.getLastWayPoint()) * Meter2NauticalMiles
)
print self.className + "===================== final 3 degrees descending glide slope ================"
descentGlideSlope = DescentGlideSlope(
runway=self.arrivalRunway,
aircraft=self.aircraft,
arrivalAirport=self.arrivalAirport,
descentGlideSlopeDegrees=3.0,
)
""" if there is a fix nearer to 5 nautics of the touch-down then limit size of simulated glide slope """
descentGlideSlopeSizeNautics = min(distanceToLastFixNautics / 2.0, 5.0)
""" build simulated glide slope """
descentGlideSlope.buildSimulatedGlideSlope(descentGlideSlopeSizeNautics)
self.firstGlideSlopeWayPoint = descentGlideSlope.getVertex(v=0).getWeight()
print self.className + ": top of arrival glide slope= {0}".format(self.firstGlideSlopeWayPoint)
print self.className + " ================= need a turn leg to find the junction point the last way-point in the fix list to the top of the final glide slope"
"""
initial heading is the orientation of the run-way
"""
lastFixListWayPoint = self.wayPointsDict[self.fixList[-1]]
initialHeadingDegrees = self.arrivalRunway.getTrueHeadingDegrees()
lastTurnLeg = TurnLeg(
initialWayPoint=self.firstGlideSlopeWayPoint,
finalWayPoint=lastFixListWayPoint,
initialHeadingDegrees=initialHeadingDegrees,
aircraft=self.aircraft,
reverse=True,
)
lastTurnLeg.buildNewSimulatedArrivalTurnLeg(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=0.0,
distanceStillToFlyMeters=0.0,
simulatedAltitudeSeaLevelMeters=self.firstGlideSlopeWayPoint.getAltitudeMeanSeaLevelMeters(),
flightPathAngleDegrees=3.0,
bankAngleDegrees=5.0,
)
descentGlideSlope.addGraph(lastTurnLeg)
# print self.className + ': compute arrival phase length= {0:.2f} meters'.format(descentGlideSlope.getLengthMeters())
# descentGlideSlope.createXlsxOutputFile()
# descentGlideSlope.createKmlOutputFile()
""" prepare next step """
beginOfLastTurnLeg = lastTurnLeg.getVertex(v=0).getWeight()
print self.className + ": begin of last turn= {0}".format(beginOfLastTurnLeg)
""" add the three last way-points in the fix list """
self.insert(position="end", wayPoint=beginOfLastTurnLeg)
""" update the length of the flight path """
self.distanceFromApproachToTouchDownMeters = descentGlideSlope.getLengthMeters()
self.flightLengthMeters = self.computeLengthMeters() + descentGlideSlope.getLengthMeters()
print self.className + ": updated flight path length= {0:.2f} nautics".format(
self.flightLengthMeters * Meter2NauticalMiles
)
""" target approach fix is equal to the begin of the SIMULATED last turn leg """
self.aircraft.setTargetApproachWayPoint(beginOfLastTurnLeg)
self.aircraft.setArrivalRunwayTouchDownWayPoint(self.touchDownWayPoint)
print self.className + ": fix list= {0}".format(self.fixList)
def test_TurnLeg(self):
print '==================== Turn Leg ==================== '+ time.strftime("%c")
atmosphere = Atmosphere()
earth = Earth()
acBd = BadaAircraftDatabase()
aircraftICAOcode = 'A320'
assert acBd.read()
assert acBd.aircraftExists(aircraftICAOcode)
assert acBd.aircraftPerformanceFileExists(aircraftICAOcode)
print '==================== aircraft found ==================== '+ time.strftime("%c")
aircraft = BadaAircraft(ICAOcode = aircraftICAOcode,
aircraftFullName = acBd.getAircraftFullName(aircraftICAOcode),
badaPerformanceFilePath = acBd.getAircraftPerformanceFile(aircraftICAOcode),
atmosphere = atmosphere,
earth = earth)
aircraft.dump()
print '==================== Get Airport ==================== '+ time.strftime("%c")
airportsDB = AirportsDatabase()
assert airportsDB.read()
print '==================== Get Arrival Airport ==================== '+ time.strftime("%c")
Lisbonne = airportsDB.getAirportFromICAOCode('LPPT')
print Lisbonne
print '==================== find the run-ways ==================== '+ time.strftime("%c")
runWaysDatabase = RunWayDataBase()
if runWaysDatabase.read():
print 'runways DB correctly read'
print '==================== take off run-way ==================== '+ time.strftime("%c")
arrivalRunway = runWaysDatabase.getFilteredRunWays(
airportICAOcode = 'LPPT',
runwayName = '')
print arrivalRunway
print '==================== Ground run ==================== '+ time.strftime("%c")
groundRun = GroundRunLeg(runway = arrivalRunway,
aircraft = aircraft,
airport = Lisbonne)
touchDownWayPoint = groundRun.computeTouchDownWayPoint()
print touchDownWayPoint
groundRun.buildDepartureGroundRun(deltaTimeSeconds = 1.0,
elapsedTimeSeconds = 0.0,
distanceStillToFlyMeters = 0.0,
distanceToLastFixMeters = 0.0)
print '==================== Climb Ramp ==================== '+ time.strftime("%c")
initialWayPoint = groundRun.getLastVertex().getWeight()
descentGlideSlope = DescentGlideSlope( runway = arrivalRunway,
aircraft = aircraft,
arrivalAirport = Lisbonne ,
descentGlideSlopeDegrees = 3.0)
''' if there is a fix nearer to 5 nautics of the touch-down then limit size of simulated glide slope '''
descentGlideSlope.buildSimulatedGlideSlope(descentGlideSlopeSizeNautics = 5.0)
descentGlideSlope.createKmlOutputFile()
firstGlideSlopeWayPoint = descentGlideSlope.getVertex(v=0).getWeight()
print '==================== Climb Ramp ==================== '+ time.strftime("%c")
initialWayPoint = groundRun.getLastVertex().getWeight()
print ' ================== turn leg end =============== '
wayPointsDb = WayPointsDatabase()
assert (wayPointsDb.read())
Exona = wayPointsDb.getWayPoint('EXONA')
Rosal = wayPointsDb.getWayPoint('ROSAL')
print Rosal.getBearingDegreesTo(Exona)
initialHeadingDegrees = arrivalRunway.getTrueHeadingDegrees()
lastTurnLeg = TurnLeg( initialWayPoint = firstGlideSlopeWayPoint,
finalWayPoint = Exona,
initialHeadingDegrees = initialHeadingDegrees,
aircraft = aircraft,
reverse = True)
deltaTimeSeconds = 1.0
lastTurnLeg.buildNewSimulatedArrivalTurnLeg(deltaTimeSeconds = deltaTimeSeconds,
elapsedTimeSeconds = 0.0,
distanceStillToFlyMeters = 0.0,
simulatedAltitudeSeaLevelMeters = firstGlideSlopeWayPoint.getAltitudeMeanSeaLevelMeters(),
flightPathAngleDegrees = 3.0)
lastTurnLeg.createKmlOutputFile()
descentGlideSlope.addGraph(lastTurnLeg)
#descentGlideSlope.createXlsxOutputFile()
descentGlideSlope.createKmlOutputFile()
print ' ================== turn leg end =============== '
assert runWaysDB.read()
arrivalRunway = runWaysDB.getFilteredRunWays(
arrivalAirportCode, 'Landing', aircraft.WakeTurbulenceCategory)
print(arrivalRunway)
aircraft.setArrivalAirportElevationMeters(
arrivalAirport.getFieldElevationAboveSeaLevelMeters())
CAS = aircraft.computeLandingStallSpeedCasKnots()
TAS = cas2tas(
cas=CAS,
altitude=arrivalAirport.getFieldElevationAboveSeaLevelMeters(),
temp='std',
speed_units='kt',
alt_units='m',
temp_units=default_temp_units,
)
aircraft.initStateVector(elapsedTimeSeconds=0.0,
trueAirSpeedMetersSecond=TAS,
altitudeMeanSeaLevelMeters=arrivalAirport.
getFieldElevationAboveSeaLevelMeters(),
deltaDistanceFlownMeters=0.0)
aircraft.setLandingConfiguration(0.0)
groundRun = GroundRunLeg(runway=arrivalRunway,
aircraft=aircraft,
airport=arrivalAirport)
groundRun.buildArrivalGroundRun(0.0)
groundRun.createXlsxOutputFile()
groundRun.createKmlOutputFile()
def test_One(self):
print('==================== departure airport ==================== ' +
time.strftime("%c"))
airportsDB = AirportsDatabase()
assert (airportsDB.read())
CharlesDeGaulle = airportsDB.getAirportFromICAOCode('LFPG')
print(CharlesDeGaulle)
print('==================== arrival airport ==================== ' +
time.strftime("%c"))
MarseilleMarignane = airportsDB.getAirportFromICAOCode('LFML')
print(MarseilleMarignane)
print('==================== Great Circle ==================== ' +
time.strftime("%c"))
self.aircraft.setCurrentAltitudeSeaLevelMeters(
elapsedTimeSeconds=0.0,
altitudeMeanSeaLevelMeters=0.0,
lastAltitudeMeanSeaLevelMeters=0.0,
targetCruiseAltitudeMslMeters=10000.0)
self.aircraft.initStateVector(
elapsedTimeSeconds=0.0,
trueAirSpeedMetersSecond=70.0,
airportFieldElevationAboveSeaLevelMeters=152.0)
self.aircraft.setTargetCruiseFlightLevel(
RequestedFlightLevel=310, departureAirportAltitudeMSLmeters=152.0)
print('==================== runways database ==================== ' +
time.strftime("%c"))
runWaysDatabase = RunWayDataBase()
assert runWaysDatabase.read()
arrivalRunway = runWaysDatabase.getFilteredRunWays(
airportICAOcode='LFML', runwayName='')
print('==================== Compute touch down ==================== ' +
time.strftime("%c"))
arrivalGroundRun = GroundRunLeg(runway=arrivalRunway,
aircraft=self.aircraft,
airport=MarseilleMarignane)
touchDownWayPoint = arrivalGroundRun.computeTouchDownWayPoint()
self.aircraft.setArrivalRunwayTouchDownWayPoint(touchDownWayPoint)
print("=========== simulated descent glide slope =========== " +
time.strftime("%c"))
threeDegreesGlideSlope = DescentGlideSlope(
runway=arrivalRunway,
aircraft=self.aircraft,
arrivalAirport=MarseilleMarignane)
threeDegreesGlideSlope.buildSimulatedGlideSlope(
descentGlideSlopeSizeNautics=5.0)
approachWayPoint = threeDegreesGlideSlope.getLastVertex().getWeight()
self.aircraft.setTargetApproachWayPoint(approachWayPoint)
print('==================== Great Circle ==================== ' +
time.strftime("%c"))
greatCircle = GreatCircleRoute(initialWayPoint=CharlesDeGaulle,
finalWayPoint=approachWayPoint,
aircraft=self.aircraft)
distanceStillToFlyMeters = CharlesDeGaulle.getDistanceMetersTo(
approachWayPoint)
greatCircle.computeGreatCircle(
deltaTimeSeconds=1.0,
elapsedTimeSeconds=0.0,
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceStillToFlyMeters)
print('main great circle length= ' +
str(greatCircle.computeLengthMeters()) + ' meters')
greatCircle.createKmlOutputFile()
greatCircle.createXlsxOutputFile()
class FlightPath(FlightPlan):
flightPlan = None
aircraftICAOcode = ''
def __init__(self,
route,
aircraftICAOcode='A320',
RequestedFlightLevel=330.0,
cruiseMach=0.8,
takeOffMassKilograms=62000.0):
self.className = self.__class__.__name__
''' init mother class '''
FlightPlan.__init__(self, route)
''' first bad and incomplete flight length '''
''' missing last turn and glide slope '''
self.flightLengthMeters = self.computeLengthMeters()
self.aircraftICAOcode = aircraftICAOcode
self.aircraft = None
self.getAircraft()
assert isinstance(self.aircraft,
BadaAircraft) and not (self.aircraft is None)
self.aircraft.setAircraftMassKilograms(takeOffMassKilograms)
assert RequestedFlightLevel >= 15.0 and RequestedFlightLevel <= 450.0
self.aircraft.setTargetCruiseFlightLevel(
RequestedFlightLevel=RequestedFlightLevel,
departureAirportAltitudeMSLmeters=self.getDepartureAirport(
).getFieldElevationAboveSeaLevelMeters())
self.aircraft.setTargetCruiseMach(cruiseMachNumber=cruiseMach)
self.arrivalAirport = self.getArrivalAirport()
if (self.arrivalAirport is None):
print(self.className +
': there is no arrival airport => flight is out-bound !!!')
#assert isinstance(self.arrivalAirport, Airport) and not(self.arrivalAirport is None)
self.departureAirport = self.getDepartureAirport()
assert isinstance(self.departureAirport,
Airport) and not (self.departureAirport is None)
def getAircraft(self):
print(self.className +
': ================ get aircraft =================')
atmosphere = Atmosphere()
earth = Earth()
acBd = BadaAircraftDatabase()
assert acBd.read()
if (acBd.aircraftExists(self.aircraftICAOcode)
and acBd.aircraftPerformanceFileExists(self.aircraftICAOcode)):
print(self.className + ': performance file= {0}'.format(
acBd.getAircraftPerformanceFile(self.aircraftICAOcode)))
self.aircraft = BadaAircraft(
ICAOcode=self.aircraftICAOcode,
aircraftFullName=acBd.getAircraftFullName(
self.aircraftICAOcode),
badaPerformanceFilePath=acBd.getAircraftPerformanceFile(
self.aircraftICAOcode),
atmosphere=atmosphere,
earth=earth)
self.aircraft.dump()
else:
raise ValueError(self.className + ': aircraft not found= ' +
self.aircraftICAOcode)
def printPassedWayPoint(self, finalWayPoint):
minutes, seconds = divmod(finalWayPoint.getElapsedTimeSeconds(), 60)
distanceFlownNautics = self.finalRoute.getLengthMeters(
) * Meter2NauticalMiles
strMsg = ': passing way-point: {0} - alt= {1:.2f} meters - alt= {2:.2f} feet - already flown distance= {3:.2f} nautics'.format(
finalWayPoint.getName(),
finalWayPoint.getAltitudeMeanSeaLevelMeters(),
finalWayPoint.getAltitudeMeanSeaLevelMeters() * Meter2Feet,
distanceFlownNautics)
elapsedTimeSeconds = finalWayPoint.getElapsedTimeSeconds()
if elapsedTimeSeconds >= 60.0 and elapsedTimeSeconds < 3600.0:
minutes, seconds = divmod(elapsedTimeSeconds, 60)
strMsg += ' - real time = {0:.2f} seconds - {1:.2f} minutes {2:.2f} seconds'.format(
elapsedTimeSeconds, minutes, seconds)
else:
minutes, seconds = divmod(elapsedTimeSeconds, 60)
hours, minutes = divmod(minutes, 60)
strMsg += ' - real time = {0:.2f} seconds - {1:.2f} hours {2:.2f} minutes {3:.2f} seconds'.format(
elapsedTimeSeconds, hours, minutes, seconds)
print(self.className + strMsg)
def turnAndFly(self, tailWayPoint, headWayPoint, initialHeadingDegrees,
headWayPointIndex):
'''
execute a turn to align true heading and then fly a great circle
'''
print(
' ================== one Turn Leg for each fix in the list =============== '
)
turnLeg = TurnLeg(initialWayPoint=tailWayPoint,
finalWayPoint=headWayPoint,
initialHeadingDegrees=initialHeadingDegrees,
aircraft=self.aircraft,
reverse=False)
distanceToLastFixMeters = self.computeDistanceToLastFixMeters(
currentPosition=tailWayPoint, fixListIndex=headWayPointIndex)
print(self.className +
': distance to last fix= {0:.2f} nautics'.format(
distanceToLastFixMeters * Meter2NauticalMiles))
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters(
)
print(self.className + ': still to fly= {0:.2f} nautics'.format(
distanceStillToFlyMeters * Meter2NauticalMiles))
endOfSimulation = turnLeg.buildTurnLeg(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=tailWayPoint.getElapsedTimeSeconds(),
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters)
self.finalRoute.addGraph(turnLeg)
if (endOfSimulation == False):
print(
' ==================== end of turn leg ==================== ')
endOfTurnLegWayPoint = self.finalRoute.getLastVertex().getWeight()
lastLeg = self.finalRoute.getLastEdge()
print(self.className +
': end of turn orientation= {0:.2f} degrees'.format(
lastLeg.getBearingTailHeadDegrees()))
'''==================== check if anticipated turn or fly by is applicable '''
anticipatedTurnWayPoint = None
if (self.flightListIndex + 2) < len(self.fixList):
''' still another fix in the list '''
firstAngleDegrees = endOfTurnLegWayPoint.getBearingDegreesTo(
headWayPoint)
secondAngleDegrees = headWayPoint.getBearingDegreesTo(
self.wayPointsDict[self.fixList[self.flightListIndex + 2]])
firstAngleRadians = math.radians(firstAngleDegrees)
secondAngleRadians = math.radians(secondAngleDegrees)
angleDifferenceDegrees = math.degrees(
math.atan2(
math.sin(secondAngleRadians - firstAngleRadians),
math.cos(secondAngleRadians - firstAngleRadians)))
print(self.className + ': difference= {0:.2f} degrees'.format(
angleDifferenceDegrees))
tasMetersPerSecond = self.aircraft.getCurrentTrueAirSpeedMetersSecond(
)
radiusOfTurnMeters = (tasMetersPerSecond * tasMetersPerSecond
) / (9.81 * math.tan(math.radians(15.0)))
anticipatedTurnStartMeters = radiusOfTurnMeters * math.tan(
math.radians((180.0 - abs(angleDifferenceDegrees)) / 2.0))
print(self.className +
': anticipated turn start from end point= {0:.2f} meters'
.format(anticipatedTurnStartMeters))
if ((endOfTurnLegWayPoint.getDistanceMetersTo(headWayPoint) >
(1.1 * anticipatedTurnStartMeters)
and abs(angleDifferenceDegrees) > 30.)):
print(self.className +
': Envisage anticipated Fly By turn !!!')
bearingDegrees = math.fmod(firstAngleDegrees + 180.0,
360.0)
anticipatedTurnWayPoint = headWayPoint.getWayPointAtDistanceBearing(
Name='Anticipated-Turn-' + headWayPoint.getName(),
DistanceMeters=anticipatedTurnStartMeters,
BearingDegrees=bearingDegrees)
headWayPoint = anticipatedTurnWayPoint
print(
' ==================== great circle ======================== ')
greatCircle = GreatCircleRoute(
initialWayPoint=endOfTurnLegWayPoint,
finalWayPoint=headWayPoint,
aircraft=self.aircraft)
distanceToLastFixMeters = self.computeDistanceToLastFixMeters(
currentPosition=endOfTurnLegWayPoint,
fixListIndex=headWayPointIndex)
print(self.className +
': distance to last fix= {0} nautics'.format(
distanceToLastFixMeters * Meter2NauticalMiles))
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters(
)
print(self.className + ': still to fly= {0} nautics'.format(
distanceStillToFlyMeters * Meter2NauticalMiles))
endOfSimulation = greatCircle.computeGreatCircle(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=endOfTurnLegWayPoint.getElapsedTimeSeconds(
),
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters)
''' update final route '''
self.finalRoute.addGraph(greatCircle)
print(
' ================== end of great circle ================== ')
finalWayPoint = self.finalRoute.getLastVertex().getWeight()
#print self.className + ': current end way point= ' + str(finalWayPoint)
lastLeg = self.finalRoute.getLastEdge()
finalHeadingDegrees = lastLeg.getBearingTailHeadDegrees()
#print self.className + ': last leg orientation= {0:.2f} degrees'.format(finalHeadingDegrees)
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters(
)
print(
self.className +
': still to fly= {0:.2f} meters - still to fly= {1:.2f} nautics'
.format(distanceStillToFlyMeters, distanceStillToFlyMeters *
Meter2NauticalMiles))
''' print the way point that has been passed right now '''
self.printPassedWayPoint(finalWayPoint)
''' return to caller '''
return endOfSimulation, finalHeadingDegrees, finalWayPoint.getElapsedTimeSeconds(
), anticipatedTurnWayPoint
def loopThroughFixList(self, initialHeadingDegrees, elapsedTimeSeconds):
anticipatedTurnWayPoint = None
''' start loop over the fix list '''
''' assumption: fix list does not contain departure and arrival airports '''
self.flightListIndex = 0
''' loop over the fix list '''
endOfSimulation = False
while (endOfSimulation
== False) and (self.flightListIndex < len(self.fixList)):
#print self.className + ': initial heading degrees= ' + str(initialHeadingDegrees) + ' degrees'
''' get the next fix '''
if (anticipatedTurnWayPoint is None):
fix = self.fixList[self.flightListIndex]
''' tail way point to reach '''
tailWayPoint = self.wayPointsDict[fix]
else:
''' we do not use the next fix but the anticipated turn way point '''
tailWayPoint = anticipatedTurnWayPoint
tailWayPoint.setElapsedTimeSeconds(elapsedTimeSeconds)
if (self.flightListIndex + 1) < len(self.fixList):
''' next way point is still in the fix list => not yet the arrival airport '''
headWayPoint = self.wayPointsDict[self.fixList[
self.flightListIndex + 1]]
print(headWayPoint)
''' turn and fly '''
endOfSimulation, initialHeadingDegrees, elapsedTimeSeconds, anticipatedTurnWayPoint = self.turnAndFly(
tailWayPoint=tailWayPoint,
headWayPoint=headWayPoint,
initialHeadingDegrees=initialHeadingDegrees,
headWayPointIndex=self.flightListIndex)
''' prepare for next loop '''
self.flightListIndex += 1
''' return final heading of the last great circle '''
return endOfSimulation, initialHeadingDegrees
def buildDeparturePhase(self):
'''
this function manages the departure phases with a ground run and a climb ramp
'''
print(self.className +
' ============== build the departure ground run =========== ')
self.finalRoute = GroundRunLeg(runway=self.departureRunway,
aircraft=self.aircraft,
airport=self.departureAirport)
distanceToLastFixMeters = self.computeDistanceToLastFixMeters(
currentPosition=self.departureAirport, fixListIndex=0)
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters(
)
elapsedTimeSeconds = 0.0
self.finalRoute.buildDepartureGroundRun(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=elapsedTimeSeconds,
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters)
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters(
)
#print '==================== end of ground run ==================== '
initialWayPoint = self.finalRoute.getLastVertex().getWeight()
distanceToFirstFixNautics = initialWayPoint.getDistanceMetersTo(
self.getFirstWayPoint()) * Meter2NauticalMiles
#print '==================== Initial Climb Ramp ==================== '
climbRamp = ClimbRamp(initialWayPoint=initialWayPoint,
runway=self.departureRunway,
aircraft=self.aircraft,
departureAirport=self.departureAirport)
''' climb ramp of 5.0 nautics is not possible if first fix placed in between '''
climbRampLengthNautics = min(distanceToFirstFixNautics / 2.0, 5.0)
climbRamp.buildClimbRamp(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=initialWayPoint.getElapsedTimeSeconds(),
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters,
climbRampLengthNautics=climbRampLengthNautics)
self.finalRoute.addGraph(climbRamp)
#print '============= initial condition for the route ================='
initialWayPoint = self.finalRoute.getLastVertex().getWeight()
lastLeg = self.finalRoute.getLastEdge()
initialHeadingDegrees = lastLeg.getBearingTailHeadDegrees()
print(self.className +
': last leg orientation= {0:.2f} degrees'.format(
initialHeadingDegrees))
#'''============= add way point in the fix list =============== '''
self.insert(position='begin', wayPoint=initialWayPoint)
#print self.className + ': fix list= {0}'.format(self.fixList)
return initialHeadingDegrees, initialWayPoint
def buildSimulatedArrivalPhase(self):
print(
self.className +
'=========== add final turn, descent and ground run ==================='
)
arrivalGroundRun = GroundRunLeg(runway=self.arrivalRunway,
aircraft=self.aircraft,
airport=self.arrivalAirport)
self.touchDownWayPoint = arrivalGroundRun.computeTouchDownWayPoint()
# add touch down to constraint list
self.constraintsList.append(
ArrivalRunWayTouchDownConstraint(self.touchDownWayPoint))
print(self.touchDownWayPoint)
''' distance from last fix to touch down '''
distanceToLastFixNautics = self.touchDownWayPoint.getDistanceMetersTo(
self.getLastWayPoint()) * Meter2NauticalMiles
print(
self.className +
'===================== final 3 degrees descending glide slope ================'
)
descentGlideSlope = DescentGlideSlope(
runway=self.arrivalRunway,
aircraft=self.aircraft,
arrivalAirport=self.arrivalAirport,
descentGlideSlopeDegrees=3.0)
''' if there is a fix nearer to 5 nautics of the touch-down then limit size of simulated glide slope '''
descentGlideSlopeSizeNautics = min(distanceToLastFixNautics / 2.0, 5.0)
''' build simulated glide slope '''
descentGlideSlope.buildSimulatedGlideSlope(
descentGlideSlopeSizeNautics)
self.firstGlideSlopeWayPoint = descentGlideSlope.getVertex(
v=0).getWeight()
print(self.className + ': top of arrival glide slope= {0}'.format(
self.firstGlideSlopeWayPoint))
print(
self.className +
' ================= need a turn leg to find the junction point the last way-point in the fix list to the top of the final glide slope'
)
'''
initial heading is the orientation of the run-way
'''
lastFixListWayPoint = self.wayPointsDict[self.fixList[-1]]
initialHeadingDegrees = self.arrivalRunway.getTrueHeadingDegrees()
print("=====> arrival runway - true heading degrees = {0}".format(
initialHeadingDegrees))
lastTurnLeg = TurnLeg(initialWayPoint=self.firstGlideSlopeWayPoint,
finalWayPoint=lastFixListWayPoint,
initialHeadingDegrees=initialHeadingDegrees,
aircraft=self.aircraft,
reverse=True)
lastTurnLeg.buildNewSimulatedArrivalTurnLeg(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=0.0,
distanceStillToFlyMeters=0.0,
simulatedAltitudeSeaLevelMeters=self.firstGlideSlopeWayPoint.
getAltitudeMeanSeaLevelMeters(),
flightPathAngleDegrees=3.0,
bankAngleDegrees=5.0)
descentGlideSlope.addGraph(lastTurnLeg)
#print self.className + ': compute arrival phase length= {0:.2f} meters'.format(descentGlideSlope.getLengthMeters())
#descentGlideSlope.createXlsxOutputFile()
#descentGlideSlope.createKmlOutputFile()
''' prepare next step '''
beginOfLastTurnLeg = lastTurnLeg.getVertex(v=0).getWeight()
print(self.className +
': begin of last turn= {0}'.format(beginOfLastTurnLeg))
''' add to constraint list '''
self.constraintsList.append(
TargetApproachConstraint(beginOfLastTurnLeg))
''' add the three last way-points in the fix list '''
self.insert(position='end', wayPoint=beginOfLastTurnLeg)
''' update the length of the flight path '''
self.distanceFromApproachToTouchDownMeters = descentGlideSlope.getLengthMeters(
)
self.flightLengthMeters = self.computeLengthMeters(
) + descentGlideSlope.getLengthMeters()
print(self.className +
': updated flight path length= {0:.2f} nautics'.format(
self.flightLengthMeters * Meter2NauticalMiles))
''' target approach fix is equal to the begin of the SIMULATED last turn leg '''
self.aircraft.setTargetApproachWayPoint(beginOfLastTurnLeg)
self.aircraft.setArrivalRunwayTouchDownWayPoint(self.touchDownWayPoint)
print(self.className + ': fix list= {0}'.format(self.fixList))
def buildArrivalPhase(self, initialHeadingDegrees):
print(
self.className +
': initial heading= {0:.2f} degrees'.format(initialHeadingDegrees))
print(self.className +
'==================== add last turn ==================== ')
if self.isDomestic() or self.isInBound():
endOfLastGreatCircleWayPoint = self.finalRoute.getLastVertex(
).getWeight()
finalHeadingDegrees = self.arrivalRunway.getTrueHeadingDegrees()
finalHeadingDegrees = math.fmod(finalHeadingDegrees + 180.0, 360.0)
print(self.className +
': runway final heading= {0:.2f} degrees'.format(
finalHeadingDegrees))
turnLeg = TurnLeg(
initialWayPoint=endOfLastGreatCircleWayPoint,
#finalWayPoint = self.firstGlideSlopeWayPoint,
finalWayPoint=self.touchDownWayPoint,
initialHeadingDegrees=initialHeadingDegrees,
aircraft=self.aircraft,
reverse=False)
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters(
)
distanceToLastFixMeters = self.computeDistanceToLastFixMeters(
currentPosition=endOfLastGreatCircleWayPoint,
fixListIndex=self.flightListIndex)
distanceToLastFixMeters = distanceStillToFlyMeters
''' for the last turn => final heading towards the runway orientation '''
deltaTimeSeconds = 0.1
turnLeg.buildTurnLeg(
deltaTimeSeconds=deltaTimeSeconds,
elapsedTimeSeconds=endOfLastGreatCircleWayPoint.
getElapsedTimeSeconds(),
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters,
finalHeadingDegrees=finalHeadingDegrees,
lastTurn=True,
bankAngleDegrees=5.0,
arrivalRunway=self.arrivalRunway)
self.finalRoute.addGraph(turnLeg)
endOfTurnLegWayPoint = self.finalRoute.getLastVertex().getWeight()
''' ============= use touch-down way-point to compute distance to fly ============='''
distanceStillToFlyMeters = endOfTurnLegWayPoint.getDistanceMetersTo(
self.touchDownWayPoint)
print(self.className +
': distance still to fly= {0:.2f} nautics'.format(
distanceStillToFlyMeters * Meter2NauticalMiles))
#print '==================== add descent slope ================= '
descentGlideSlope = DescentGlideSlope(
runway=self.arrivalRunway,
aircraft=self.aircraft,
arrivalAirport=self.arrivalAirport,
descentGlideSlopeDegrees=3.0)
flownDistanceMeters = self.finalRoute.getLengthMeters()
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters(
)
distanceToLastFixMeters = self.computeDistanceToLastFixMeters(
currentPosition=endOfTurnLegWayPoint,
fixListIndex=self.flightListIndex)
distanceToLastFixMeters = distanceStillToFlyMeters
descentGlideSlope.buildGlideSlope(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=endOfTurnLegWayPoint.getElapsedTimeSeconds(
),
initialWayPoint=endOfTurnLegWayPoint,
flownDistanceMeters=flownDistanceMeters,
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters)
self.finalRoute.addGraph(descentGlideSlope)
endOfDescentGlideSlope = self.finalRoute.getLastVertex().getWeight(
)
#print '================= add arrival ground run ================'
arrivalGroundRun = GroundRunLeg(runway=self.arrivalRunway,
aircraft=self.aircraft,
airport=self.arrivalAirport)
arrivalGroundRun.buildArrivalGroundRun(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=endOfDescentGlideSlope.
getElapsedTimeSeconds(),
initialWayPoint=endOfDescentGlideSlope)
self.finalRoute.addGraph(arrivalGroundRun)
def computeFlight(self, deltaTimeSeconds):
'''
main entry to compute a whole flight
'''
self.deltaTimeSeconds = deltaTimeSeconds
assert not (self.aircraft is None)
assert not (self.departureRunway is None)
assert not (self.departureAirport is None)
if self.isDomestic() or self.isOutBound():
initialHeadingDegrees, initialWayPoint = self.buildDeparturePhase()
if self.isDomestic() or self.isInBound():
assert not (self.arrivalAirport is None)
self.buildSimulatedArrivalPhase()
#print '==================== Loop over the fix list ==================== '
endOfSimulation, initialHeadingDegrees = self.loopThroughFixList(
initialHeadingDegrees=initialHeadingDegrees,
elapsedTimeSeconds=initialWayPoint.getElapsedTimeSeconds())
if (endOfSimulation == False):
#print '=========== build arrival phase =============='
self.buildArrivalPhase(initialHeadingDegrees)
print(self.className + ' ========== delta mass status ==============')
print(self.className +
': initial mass= {0:.2f} kilograms = {1:.2f} pounds'.format(
self.aircraft.getAircraftInitialMassKilograms(),
self.aircraft.getAircraftInitialMassKilograms() *
Kilogram2Pounds))
print(self.className +
': final mass= {0:.2f} kilograms = {1:.2f} pounds'.format(
self.aircraft.getAircraftCurrentMassKilograms(),
self.aircraft.getAircraftCurrentMassKilograms() *
Kilogram2Pounds))
print(self.className +
': diff mass= {0:.2f} kilograms = {1:.2f} pounds'.format(
self.aircraft.getAircraftInitialMassKilograms() -
self.aircraft.getAircraftCurrentMassKilograms(),
(self.aircraft.getAircraftInitialMassKilograms() -
self.aircraft.getAircraftCurrentMassKilograms()) *
Kilogram2Pounds))
print(self.className + ' ========== delta mass status ==============')
def createFlightOutputFiles(self):
''' build outputs '''
self.finalRoute.createXlsxOutputFile()
self.finalRoute.createKmlOutputFile()
''' add a prefix to the file path to identify the departure and arrival airport '''
filePrefix = ''
if not (self.departureAirport is None):
filePrefix = self.departureAirport.getICAOcode()
if not (self.arrivalAirport is None):
filePrefix += '-' + self.arrivalAirport.getICAOcode()
self.aircraft.createStateVectorOutputFile(filePrefix)
print('{0} - final route length= {1:.2f} nautics'.format(
self.className,
self.finalRoute.getLengthMeters() * Meter2NauticalMiles))
class FlightPath(FlightPlan):
flightPlan = None
aircraftICAOcode = ""
def __init__(
self, route, aircraftICAOcode="A320", RequestedFlightLevel=330.0, cruiseMach=0.8, takeOffMassKilograms=62000.0
):
self.className = self.__class__.__name__
FlightPlan.__init__(self, route)
""" first bad and incomplete flight length """
""" missing last turn and glide slope """
self.flightLengthMeters = self.computeLengthMeters()
self.aircraftICAOcode = aircraftICAOcode
self.aircraft = None
self.getAircraft()
assert isinstance(self.aircraft, BadaAircraft) and not (self.aircraft is None)
self.aircraft.setAircraftMassKilograms(takeOffMassKilograms)
assert RequestedFlightLevel >= 15.0 and RequestedFlightLevel <= 450.0
self.aircraft.setTargetCruiseFlightLevel(
RequestedFlightLevel=RequestedFlightLevel,
departureAirportAltitudeMSLmeters=self.getDepartureAirport().getFieldElevationAboveSeaLevelMeters(),
)
self.aircraft.setTargetCruiseMach(cruiseMachNumber=cruiseMach)
self.arrivalAirport = self.getArrivalAirport()
if self.arrivalAirport is None:
print self.className + ": there is no arrival airport => flight is outbound !!!"
# assert isinstance(self.arrivalAirport, Airport) and not(self.arrivalAirport is None)
self.departureAirport = self.getDepartureAirport()
assert isinstance(self.departureAirport, Airport) and not (self.departureAirport is None)
def getAircraft(self):
print self.className + ": ================ get aircraft ================="
atmosphere = Atmosphere()
earth = Earth()
acBd = BadaAircraftDatabase()
assert acBd.read()
if acBd.aircraftExists(self.aircraftICAOcode) and acBd.aircraftPerformanceFileExists(self.aircraftICAOcode):
print self.className + ": performance file= {0}".format(
acBd.getAircraftPerformanceFile(self.aircraftICAOcode)
)
self.aircraft = BadaAircraft(
ICAOcode=self.aircraftICAOcode,
aircraftFullName=acBd.getAircraftFullName(self.aircraftICAOcode),
badaPerformanceFilePath=acBd.getAircraftPerformanceFile(self.aircraftICAOcode),
atmosphere=atmosphere,
earth=earth,
)
self.aircraft.dump()
else:
raise ValueError(self.className + ": aircraft not found= " + self.aircraftICAOcode)
def printPassedWayPoint(self, finalWayPoint):
minutes, seconds = divmod(finalWayPoint.getElapsedTimeSeconds(), 60)
distanceFlownNautics = self.finalRoute.getLengthMeters() * Meter2NauticalMiles
strMsg = ": passing waypoint: {0} - alt= {1:.2f} meters - alt= {2:.2f} feet - distance= {3:.2f} nautics".format(
finalWayPoint.getName(),
finalWayPoint.getAltitudeMeanSeaLevelMeters(),
finalWayPoint.getAltitudeMeanSeaLevelMeters() * Meter2Feet,
distanceFlownNautics,
)
elapsedTimeSeconds = finalWayPoint.getElapsedTimeSeconds()
if elapsedTimeSeconds >= 60.0 and elapsedTimeSeconds < 3600.0:
minutes, seconds = divmod(elapsedTimeSeconds, 60)
strMsg += " - real time = {0:.2f} seconds - {1:.2f} minutes {2:.2f} seconds".format(
elapsedTimeSeconds, minutes, seconds
)
else:
minutes, seconds = divmod(elapsedTimeSeconds, 60)
hours, minutes = divmod(minutes, 60)
strMsg += " - real time = {0:.2f} seconds - {1:.2f} hours {2:.2f} minutes {3:.2f} seconds".format(
elapsedTimeSeconds, hours, minutes, seconds
)
print self.className + strMsg
def turnAndFly(self, tailWayPoint, headWayPoint, initialHeadingDegrees, headWayPointIndex):
"""
execute a turn to align true heading and then fly a great circle
"""
print " ================== one Turn Leg for each fix in the list =============== "
turnLeg = TurnLeg(
initialWayPoint=tailWayPoint,
finalWayPoint=headWayPoint,
initialHeadingDegrees=initialHeadingDegrees,
aircraft=self.aircraft,
reverse=False,
)
distanceToLastFixMeters = self.computeDistanceToLastFixMeters(
currentPosition=tailWayPoint, fixListIndex=headWayPointIndex
)
print self.className + ": distance to last fix= {0} nautics".format(
distanceToLastFixMeters * Meter2NauticalMiles
)
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters()
print self.className + ": still to fly= {0} nautics".format(distanceStillToFlyMeters * Meter2NauticalMiles)
endOfSimulation = turnLeg.buildTurnLeg(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=tailWayPoint.getElapsedTimeSeconds(),
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters,
)
self.finalRoute.addGraph(turnLeg)
if endOfSimulation == False:
print " ==================== end of turn leg ==================== "
endOfTurnLegWayPoint = self.finalRoute.getLastVertex().getWeight()
lastLeg = self.finalRoute.getLastEdge()
print self.className + ": end of turn orientation= {0:.2f} degrees".format(
lastLeg.getBearingTailHeadDegrees()
)
"""==================== check if anticipated turn or fly by is applicable """
anticipatedTurnWayPoint = None
if (self.flightListIndex + 2) < len(self.fixList):
""" still another fix in the list """
firstAngleDegrees = endOfTurnLegWayPoint.getBearingDegreesTo(headWayPoint)
secondAngleDegrees = headWayPoint.getBearingDegreesTo(
self.wayPointsDict[self.fixList[self.flightListIndex + 2]]
)
firstAngleRadians = math.radians(firstAngleDegrees)
secondAngleRadians = math.radians(secondAngleDegrees)
angleDifferenceDegrees = math.degrees(
math.atan2(
math.sin(secondAngleRadians - firstAngleRadians),
math.cos(secondAngleRadians - firstAngleRadians),
)
)
print self.className + ": difference= {0:.2f} degrees".format(angleDifferenceDegrees)
tasMetersPerSecond = self.aircraft.getCurrentTrueAirSpeedMetersSecond()
radiusOfTurnMeters = (tasMetersPerSecond * tasMetersPerSecond) / (9.81 * math.tan(math.radians(15.0)))
anticipatedTurnStartMeters = radiusOfTurnMeters * math.tan(
math.radians((180.0 - abs(angleDifferenceDegrees)) / 2.0)
)
print self.className + ": anticipated turn start from end point= {0:.2f} meters".format(
anticipatedTurnStartMeters
)
if (
endOfTurnLegWayPoint.getDistanceMetersTo(headWayPoint) > (1.1 * anticipatedTurnStartMeters)
and abs(angleDifferenceDegrees) > 30.0
):
print self.className + ": Envisage anticipated Fly By turn !!!!!!!!!!!!!!!!!!!!!!!!!"
bearingDegrees = math.fmod(firstAngleDegrees + 180.0, 360.0)
anticipatedTurnWayPoint = headWayPoint.getWayPointAtDistanceBearing(
Name="Anticipated-Turn-" + headWayPoint.getName(),
DistanceMeters=anticipatedTurnStartMeters,
BearingDegrees=bearingDegrees,
)
headWayPoint = anticipatedTurnWayPoint
print " ==================== great circle ======================== "
greatCircle = GreatCircleRoute(
initialWayPoint=endOfTurnLegWayPoint, finalWayPoint=headWayPoint, aircraft=self.aircraft
)
distanceToLastFixMeters = self.computeDistanceToLastFixMeters(
currentPosition=endOfTurnLegWayPoint, fixListIndex=headWayPointIndex
)
print self.className + ": distance to last fix= {0} nautics".format(
distanceToLastFixMeters * Meter2NauticalMiles
)
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters()
print self.className + ": still to fly= {0} nautics".format(distanceStillToFlyMeters * Meter2NauticalMiles)
endOfSimulation = greatCircle.computeGreatCircle(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=endOfTurnLegWayPoint.getElapsedTimeSeconds(),
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters,
)
""" update final route """
self.finalRoute.addGraph(greatCircle)
print " ================== end of great circle ================== "
finalWayPoint = self.finalRoute.getLastVertex().getWeight()
# print self.className + ': current end way point= ' + str(finalWayPoint)
lastLeg = self.finalRoute.getLastEdge()
finalHeadingDegrees = lastLeg.getBearingTailHeadDegrees()
# print self.className + ': last leg orientation= {0:.2f} degrees'.format(finalHeadingDegrees)
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters()
print self.className + ": still to fly= {0:.2f} meters - still to fly= {1:.2f} nautics".format(
distanceStillToFlyMeters, distanceStillToFlyMeters * Meter2NauticalMiles
)
""" print the way point that has been passed right now """
self.printPassedWayPoint(finalWayPoint)
""" return to caller """
return endOfSimulation, finalHeadingDegrees, finalWayPoint.getElapsedTimeSeconds(), anticipatedTurnWayPoint
def loopThroughFixList(self, initialHeadingDegrees, elapsedTimeSeconds):
anticipatedTurnWayPoint = None
""" start loop over the fix list """
""" fix list does not contain departure and arrival airports """
self.flightListIndex = 0
""" loop over the fix list """
endOfSimulation = False
while (endOfSimulation == False) and (self.flightListIndex < len(self.fixList)):
# print self.className + ': initial heading degrees= ' + str(initialHeadingDegrees) + ' degrees'
""" get the next fix """
if anticipatedTurnWayPoint is None:
fix = self.fixList[self.flightListIndex]
""" tail way point to reach """
tailWayPoint = self.wayPointsDict[fix]
else:
""" we do not use the next fix but the anticipated turn way point """
tailWayPoint = anticipatedTurnWayPoint
tailWayPoint.setElapsedTimeSeconds(elapsedTimeSeconds)
if (self.flightListIndex + 1) < len(self.fixList):
""" next way point is still in the fix list => not yet the arrival airport """
headWayPoint = self.wayPointsDict[self.fixList[self.flightListIndex + 1]]
""" turn and fly """
endOfSimulation, initialHeadingDegrees, elapsedTimeSeconds, anticipatedTurnWayPoint = self.turnAndFly(
tailWayPoint=tailWayPoint,
headWayPoint=headWayPoint,
initialHeadingDegrees=initialHeadingDegrees,
headWayPointIndex=self.flightListIndex,
)
""" prepare for next loop """
self.flightListIndex += 1
""" return final heading of the last great circle """
return endOfSimulation, initialHeadingDegrees
def buildDeparturePhase(self):
"""
this function manages the departure phases with a ground run and a climb ramp
"""
print self.className + " ============== build the departure ground run =========== "
self.finalRoute = GroundRunLeg(
runway=self.departureRunway, aircraft=self.aircraft, airport=self.departureAirport
)
distanceToLastFixMeters = self.computeDistanceToLastFixMeters(
currentPosition=self.departureAirport, fixListIndex=0
)
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters()
elapsedTimeSeconds = 0.0
self.finalRoute.buildDepartureGroundRun(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=elapsedTimeSeconds,
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters,
)
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters()
# print '==================== end of ground run ==================== '
initialWayPoint = self.finalRoute.getLastVertex().getWeight()
distanceToFirstFixNautics = initialWayPoint.getDistanceMetersTo(self.getFirstWayPoint()) * Meter2NauticalMiles
# print '==================== Initial Climb Ramp ==================== '
climbRamp = ClimbRamp(
initialWayPoint=initialWayPoint,
runway=self.departureRunway,
aircraft=self.aircraft,
departureAirport=self.departureAirport,
)
""" climb ramp of 5.0 nautics is not possible is first fix in between """
climbRampLengthNautics = min(distanceToFirstFixNautics / 2.0, 5.0)
climbRamp.buildClimbRamp(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=initialWayPoint.getElapsedTimeSeconds(),
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters,
climbRampLengthNautics=climbRampLengthNautics,
)
self.finalRoute.addGraph(climbRamp)
# print '============= initial condition for the route ================='
initialWayPoint = self.finalRoute.getLastVertex().getWeight()
lastLeg = self.finalRoute.getLastEdge()
initialHeadingDegrees = lastLeg.getBearingTailHeadDegrees()
print self.className + ": last leg orientation= {0:.2f} degrees".format(initialHeadingDegrees)
#'''============= add way point in the fix list =============== '''
self.insert(position="begin", wayPoint=initialWayPoint)
# print self.className + ': fix list= {0}'.format(self.fixList)
return initialHeadingDegrees, initialWayPoint
def buildSimulatedArrivalPhase(self):
print self.className + "=========== add final turn, descent and ground run ==================="
arrivalGroundRun = GroundRunLeg(runway=self.arrivalRunway, aircraft=self.aircraft, airport=self.arrivalAirport)
self.touchDownWayPoint = arrivalGroundRun.computeTouchDownWayPoint()
print self.touchDownWayPoint
""" distance from last fix to touch down """
distanceToLastFixNautics = (
self.touchDownWayPoint.getDistanceMetersTo(self.getLastWayPoint()) * Meter2NauticalMiles
)
print self.className + "===================== final 3 degrees descending glide slope ================"
descentGlideSlope = DescentGlideSlope(
runway=self.arrivalRunway,
aircraft=self.aircraft,
arrivalAirport=self.arrivalAirport,
descentGlideSlopeDegrees=3.0,
)
""" if there is a fix nearer to 5 nautics of the touch-down then limit size of simulated glide slope """
descentGlideSlopeSizeNautics = min(distanceToLastFixNautics / 2.0, 5.0)
""" build simulated glide slope """
descentGlideSlope.buildSimulatedGlideSlope(descentGlideSlopeSizeNautics)
self.firstGlideSlopeWayPoint = descentGlideSlope.getVertex(v=0).getWeight()
print self.className + ": top of arrival glide slope= {0}".format(self.firstGlideSlopeWayPoint)
print self.className + " ================= need a turn leg to find the junction point the last way-point in the fix list to the top of the final glide slope"
"""
initial heading is the orientation of the run-way
"""
lastFixListWayPoint = self.wayPointsDict[self.fixList[-1]]
initialHeadingDegrees = self.arrivalRunway.getTrueHeadingDegrees()
lastTurnLeg = TurnLeg(
initialWayPoint=self.firstGlideSlopeWayPoint,
finalWayPoint=lastFixListWayPoint,
initialHeadingDegrees=initialHeadingDegrees,
aircraft=self.aircraft,
reverse=True,
)
lastTurnLeg.buildNewSimulatedArrivalTurnLeg(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=0.0,
distanceStillToFlyMeters=0.0,
simulatedAltitudeSeaLevelMeters=self.firstGlideSlopeWayPoint.getAltitudeMeanSeaLevelMeters(),
flightPathAngleDegrees=3.0,
bankAngleDegrees=5.0,
)
descentGlideSlope.addGraph(lastTurnLeg)
# print self.className + ': compute arrival phase length= {0:.2f} meters'.format(descentGlideSlope.getLengthMeters())
# descentGlideSlope.createXlsxOutputFile()
# descentGlideSlope.createKmlOutputFile()
""" prepare next step """
beginOfLastTurnLeg = lastTurnLeg.getVertex(v=0).getWeight()
print self.className + ": begin of last turn= {0}".format(beginOfLastTurnLeg)
""" add the three last way-points in the fix list """
self.insert(position="end", wayPoint=beginOfLastTurnLeg)
""" update the length of the flight path """
self.distanceFromApproachToTouchDownMeters = descentGlideSlope.getLengthMeters()
self.flightLengthMeters = self.computeLengthMeters() + descentGlideSlope.getLengthMeters()
print self.className + ": updated flight path length= {0:.2f} nautics".format(
self.flightLengthMeters * Meter2NauticalMiles
)
""" target approach fix is equal to the begin of the SIMULATED last turn leg """
self.aircraft.setTargetApproachWayPoint(beginOfLastTurnLeg)
self.aircraft.setArrivalRunwayTouchDownWayPoint(self.touchDownWayPoint)
print self.className + ": fix list= {0}".format(self.fixList)
def buildArrivalPhase(self, initialHeadingDegrees):
print self.className + "==================== add last turn ==================== "
if self.isDomestic() or self.isInBound():
endOfLastGreatCircleWayPoint = self.finalRoute.getLastVertex().getWeight()
finalHeadingDegrees = self.arrivalRunway.getTrueHeadingDegrees()
finalHeadingDegrees = math.fmod(finalHeadingDegrees + 180.0, 360.0)
print self.className + ": runway final heading= {0:.2f} degrees".format(finalHeadingDegrees)
turnLeg = TurnLeg(
initialWayPoint=endOfLastGreatCircleWayPoint,
# finalWayPoint = self.firstGlideSlopeWayPoint,
finalWayPoint=self.touchDownWayPoint,
initialHeadingDegrees=initialHeadingDegrees,
aircraft=self.aircraft,
reverse=False,
)
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters()
distanceToLastFixMeters = self.computeDistanceToLastFixMeters(
currentPosition=endOfLastGreatCircleWayPoint, fixListIndex=self.flightListIndex
)
distanceToLastFixMeters = distanceStillToFlyMeters
""" for the last turn => final heading towards the runway orientation """
deltaTimeSeconds = 0.1
turnLeg.buildTurnLeg(
deltaTimeSeconds=deltaTimeSeconds,
elapsedTimeSeconds=endOfLastGreatCircleWayPoint.getElapsedTimeSeconds(),
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters,
finalHeadingDegrees=finalHeadingDegrees,
lastTurn=True,
bankAngleDegrees=5.0,
)
self.finalRoute.addGraph(turnLeg)
endOfTurnLegWayPoint = self.finalRoute.getLastVertex().getWeight()
""" ============= use touch-down way-point to compute distance to fly ============="""
distanceStillToFlyMeters = endOfTurnLegWayPoint.getDistanceMetersTo(self.touchDownWayPoint)
print self.className + ": distance still to fly= {0:.2f} nautics".format(
distanceStillToFlyMeters * Meter2NauticalMiles
)
# print '==================== add descent slope ================= '
descentGlideSlope = DescentGlideSlope(
runway=self.arrivalRunway,
aircraft=self.aircraft,
arrivalAirport=self.arrivalAirport,
descentGlideSlopeDegrees=3.0,
)
flownDistanceMeters = self.finalRoute.getLengthMeters()
distanceStillToFlyMeters = self.flightLengthMeters - self.finalRoute.getLengthMeters()
distanceToLastFixMeters = self.computeDistanceToLastFixMeters(
currentPosition=endOfTurnLegWayPoint, fixListIndex=self.flightListIndex
)
distanceToLastFixMeters = distanceStillToFlyMeters
descentGlideSlope.buildGlideSlope(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=endOfTurnLegWayPoint.getElapsedTimeSeconds(),
initialWayPoint=endOfTurnLegWayPoint,
flownDistanceMeters=flownDistanceMeters,
distanceStillToFlyMeters=distanceStillToFlyMeters,
distanceToLastFixMeters=distanceToLastFixMeters,
)
self.finalRoute.addGraph(descentGlideSlope)
endOfDescentGlideSlope = self.finalRoute.getLastVertex().getWeight()
# print '================= add arrival ground run ================'
arrivalGroundRun = GroundRunLeg(
runway=self.arrivalRunway, aircraft=self.aircraft, airport=self.arrivalAirport
)
arrivalGroundRun.buildArrivalGroundRun(
deltaTimeSeconds=self.deltaTimeSeconds,
elapsedTimeSeconds=endOfDescentGlideSlope.getElapsedTimeSeconds(),
initialWayPoint=endOfDescentGlideSlope,
)
self.finalRoute.addGraph(arrivalGroundRun)
def computeFlight(self, deltaTimeSeconds):
"""
main entry to compute a whole flight
"""
self.deltaTimeSeconds = deltaTimeSeconds
assert not (self.aircraft is None)
assert not (self.departureRunway is None)
assert not (self.departureAirport is None)
if self.isDomestic() or self.isOutBound():
initialHeadingDegrees, initialWayPoint = self.buildDeparturePhase()
if self.isDomestic() or self.isInBound():
assert not (self.arrivalAirport is None)
self.buildSimulatedArrivalPhase()
# print '==================== Loop over the fix list ==================== '
endOfSimulation, initialHeadingDegrees = self.loopThroughFixList(
initialHeadingDegrees=initialHeadingDegrees, elapsedTimeSeconds=initialWayPoint.getElapsedTimeSeconds()
)
if endOfSimulation == False:
# print '=========== build arrival phase =============='
self.buildArrivalPhase(initialHeadingDegrees)
print self.className + " ========== delta mass status =============="
print self.className + ": initial mass= {0:.2f} kilograms = {1:.2f} pounds".format(
self.aircraft.getAircraftInitialMassKilograms(),
self.aircraft.getAircraftInitialMassKilograms() * Kilogram2Pounds,
)
print self.className + ": final mass= {0:.2f} kilograms = {1:.2f} pounds".format(
self.aircraft.getAircraftCurrentMassKilograms(),
self.aircraft.getAircraftCurrentMassKilograms() * Kilogram2Pounds,
)
print self.className + ": diff mass= {0:.2f} kilograms = {1:.2f} pounds".format(
self.aircraft.getAircraftInitialMassKilograms() - self.aircraft.getAircraftCurrentMassKilograms(),
(self.aircraft.getAircraftInitialMassKilograms() - self.aircraft.getAircraftCurrentMassKilograms())
* Kilogram2Pounds,
)
print self.className + " ========== delta mass status =============="
def createFlightOutputFiles(self):
""" build outputs """
self.finalRoute.createXlsxOutputFile()
self.finalRoute.createKmlOutputFile()
""" add a prefix to the file path to identify the departure and arrival airport """
filePrefix = ""
if not (self.departureAirport is None):
filePrefix = self.departureAirport.getICAOcode()
if not (self.arrivalAirport is None):
filePrefix += "-" + self.arrivalAirport.getICAOcode()
self.aircraft.createStateVectorOutputFile(filePrefix)
print self.className + ": final route length= {0} nautics".format(
self.finalRoute.getLengthMeters() * Meter2NauticalMiles
)
departureAirport = airportsDB.getAirportFromICAOCode('EGLL')
assert not (departureAirport is None)
print('========== ' + str(arrivalRunway) + ' =================')
airportIcaoCode = arrivalRunway.getAirportICAOcode()
arrivalAirport = airportsDB.getAirportFromICAOCode(airportIcaoCode)
print('arrival airport= {0}'.format(arrivalAirport))
aircraft.setArrivalAirportElevationMeters(
arrivalAirport.fieldElevationAboveSeaLevelMeters)
print(
'=========== add final turn, descent and ground run ==================='
)
arrivalGroundRun = GroundRunLeg(runway=arrivalRunway,
aircraft=aircraft,
airport=arrivalAirport)
touchDownWayPoint = arrivalGroundRun.computeTouchDownWayPoint()
print(touchDownWayPoint)
print(
'===================== final 3 degrees descending glide slope ================'
)
dummyDescentGlideSlope = DescentGlideSlope(runway=arrivalRunway,
aircraft=aircraft,
arrivalAirport=arrivalAirport,
descentGlideSlopeDegrees=3.0)
dummyDescentGlideSlope.buildSimulatedGlideSlope()
firstGlideSlopeWayPoint = dummyDescentGlideSlope.getVertex(v=0).getWeight()
print('=============== init aircraft state vector =================')
def test_Two(self):
t0 = time.clock()
print ( " ========== Great Circle ======= time start= ", t0 )
atmosphere = Atmosphere()
earth = Earth()
print ( '==================== Great Circle ==================== '+ time.strftime("%c") )
acBd = BadaAircraftDatabase()
aircraftICAOcode = 'A320'
if acBd.read():
if ( acBd.aircraftExists(aircraftICAOcode)
and acBd.aircraftPerformanceFileExists(aircraftICAOcode)):
print ( '==================== aircraft found ==================== '+ time.strftime("%c") )
aircraft = BadaAircraft(ICAOcode = aircraftICAOcode,
aircraftFullName = acBd.getAircraftFullName(aircraftICAOcode),
badaPerformanceFilePath = acBd.getAircraftPerformanceFile(aircraftICAOcode),
atmosphere = atmosphere,
earth = earth)
print ( aircraft )
else:
print ( '==================== airport database ==================== '+ time.strftime("%c") )
airportsDB = AirportsDatabase()
assert not(airportsDB is None)
wayPointsDb = WayPointsDatabase()
assert (wayPointsDb.read())
initialWayPoint = wayPointsDb.getWayPoint('TOU')
finalWayPoint = wayPointsDb.getWayPoint('ALIVA')
print ( initialWayPoint.getBearingDegreesTo(finalWayPoint) )
print ( finalWayPoint.getBearingDegreesTo(initialWayPoint) )
''' departure ground run => initial speed is null '''
trueAirSpeedMetersSecond = 70.0
elapsedTimeSeconds = 0.0
aircraft.setCurrentAltitudeSeaLevelMeters(
elapsedTimeSeconds = 0.0 ,
altitudeMeanSeaLevelMeters = 0.0,
lastAltitudeMeanSeaLevelMeters = 0.0,
targetCruiseAltitudeMslMeters = 10000.0)
aircraft.initStateVector(
elapsedTimeSeconds = 0.0,
trueAirSpeedMetersSecond = 70.0,
airportFieldElevationAboveSeaLevelMeters = 152.0)
aircraft.setTargetCruiseFlightLevel(RequestedFlightLevel = 310,
departureAirportAltitudeMSLmeters = 152.0)
print ( "=========== simulated descent glide slope =========== " + time.strftime("%c") )
MarseilleMarignane = airportsDB.getAirportFromICAOCode('LFML')
print ( '==================== runways database ==================== '+ time.strftime("%c") )
runWaysDatabase = RunWayDataBase()
assert runWaysDatabase.read()
runway = runWaysDatabase.getFilteredRunWays(airportICAOcode = 'LFML', runwayName = '')
arrivalGroundRun = GroundRunLeg( runway = runway,
aircraft = aircraft,
airport = MarseilleMarignane )
touchDownWayPoint = arrivalGroundRun.computeTouchDownWayPoint()
aircraft.setArrivalRunwayTouchDownWayPoint(touchDownWayPoint)
threeDegreesGlideSlope = DescentGlideSlope(runway = runway,
aircraft = aircraft,
arrivalAirport = MarseilleMarignane )
threeDegreesGlideSlope.buildSimulatedGlideSlope(descentGlideSlopeSizeNautics = 5.0)
approachWayPoint = threeDegreesGlideSlope.getLastVertex().getWeight()
aircraft.setTargetApproachWayPoint(approachWayPoint)
''' =================================='''
greatCircle = GreatCircleRoute(initialWayPoint = initialWayPoint,
finalWayPoint = finalWayPoint,
aircraft = aircraft)
distanceStillToFlyMeters = initialWayPoint.getDistanceMetersTo(approachWayPoint)
greatCircle.computeGreatCircle(
deltaTimeSeconds = 0.1,
elapsedTimeSeconds = 0.0,
distanceStillToFlyMeters = distanceStillToFlyMeters,
distanceToLastFixMeters = distanceStillToFlyMeters)
print ( 'main great circle length= ' + str(greatCircle.computeLengthMeters()) + ' meters' )
greatCircle.createKmlOutputFile()
greatCircle.createXlsxOutputFile()
def test_ClimbRamp(self):
atmosphere = Atmosphere()
earth = Earth()
print '==================== Three Degrees climb slope ==================== ' + time.strftime(
"%c")
acBd = BadaAircraftDatabase()
aircraftICAOcode = 'A320'
if acBd.read():
if (acBd.aircraftExists(aircraftICAOcode)
and acBd.aircraftPerformanceFileExists(aircraftICAOcode)):
print '==================== aircraft found ==================== ' + time.strftime(
"%c")
aircraft = BadaAircraft(
ICAOcode=aircraftICAOcode,
aircraftFullName=acBd.getAircraftFullName(
aircraftICAOcode),
badaPerformanceFilePath=acBd.getAircraftPerformanceFile(
aircraftICAOcode),
atmosphere=atmosphere,
earth=earth)
aircraft.dump()
assert not (aircraft is None)
print '==================== get Charles Gaulle airport ==================== ' + time.strftime(
"%c")
airportsDB = AirportsDatabase()
assert (airportsDB.read())
CharlesDeGaulle = airportsDB.getAirportFromICAOCode('LFPG')
print CharlesDeGaulle
assert not (aircraft is None)
aircraft.setTargetCruiseFlightLevel(
RequestedFlightLevel=390,
departureAirportAltitudeMSLmeters=CharlesDeGaulle.
getAltitudeMeanSeaLevelMeters())
print '==================== Three Degrees climb slope==================== ' + time.strftime(
"%c")
runWaysDatabase = RunWayDataBase()
if runWaysDatabase.read():
print 'runways DB correctly read'
runway = runWaysDatabase.getFilteredRunWays('LFPG')
print runway
print '==================== Ground Run ==================== ' + time.strftime(
"%c")
groundRun = GroundRunLeg(runway=runway,
aircraft=aircraft,
airport=CharlesDeGaulle)
groundRun.buildDepartureGroundRun(deltaTimeSeconds=0.1,
elapsedTimeSeconds=0.0,
distanceStillToFlyMeters=100000.0,
distanceToLastFixMeters=100000.0)
print '==================== Three Degrees climb slope==================== ' + time.strftime(
"%c")
initialVertex = groundRun.getVertex(groundRun.getNumberOfVertices() -
1)
initialWayPoint = initialVertex.getWeight()
climbRamp = ClimbRamp(initialWayPoint=initialWayPoint,
runway=runway,
aircraft=aircraft,
departureAirport=CharlesDeGaulle)
climbRamp.buildClimbRamp(deltaTimeSeconds=0.1,
elapsedTimeSeconds=0.0,
distanceStillToFlyMeters=100000.0,
distanceToLastFixMeters=100000.0,
climbRampLengthNautics=5.0)
groundRun.addGraph(climbRamp)
groundRun.createKmlOutputFile()
print "=========== ThreeDegreesGlideSlope end =========== " + time.strftime(
"%c")
else:
raise ValueError('runways not read correctly')
print('==================== find the run-ways ==================== ' +
time.strftime("%c"))
for runway in runWaysDB.getRunWays():
print('==================== aircraft found ==================== ' +
time.strftime("%c"))
aircraft = BadaAircraft(
aircraftICAOcode,
acBd.getAircraftPerformanceFile(aircraftICAOcode), atmosphere,
earth)
print('==================== run-way ==================== ')
print(runway)
airportIcaoCode = runway.getAirportICAOcode()
departureAirport = airportsDB.getAirportFromICAOCode(airportIcaoCode)
print('====================== departure airport =================')
print(departureAirport)
print('==================== ground run ==================== ')
groundRun = GroundRunLeg(runway=runway,
aircraft=aircraft,
airport=departureAirport)
groundRun.buildDepartureGroundRun(elapsedTimeSeconds=0.0,
distanceStillToFlyMeters=600000.0)
groundRun.createKmlOutputFile()
