Introduce new TCAS instrument
- implements a TCAS II v7.0
This commit is contained in:
ThorstenB
parent
dd7c88b8cb
commit
bdd931aed9
5 changed files with 1687 additions and 1 deletions
|
|
@ -31,6 +31,7 @@ set(SOURCES
|
|||
rnav_waypt_controller.cxx
|
||||
slip_skid_ball.cxx
|
||||
tacan.cxx
|
||||
tcas.cxx
|
||||
transponder.cxx
|
||||
turn_indicator.cxx
|
||||
vertical_speed_indicator.cxx
|
||||
|
|
|
|||
|
|
@ -33,6 +33,7 @@ libInstrumentation_a_SOURCES = \
|
|||
render_area_2d.cxx render_area_2d.hxx \
|
||||
groundradar.cxx groundradar.hxx \
|
||||
agradar.cxx agradar.hxx rad_alt.cxx rad_alt.hxx \
|
||||
rnav_waypt_controller.cxx rnav_waypt_controller.hxx
|
||||
rnav_waypt_controller.cxx rnav_waypt_controller.hxx \
|
||||
tcas.cxx tcas.hxx
|
||||
|
||||
INCLUDES = -I$(top_srcdir) -I$(top_srcdir)/src -I$(top_builddir)/src
|
||||
|
|
|
|||
|
|
@ -50,6 +50,7 @@
|
|||
#include "groundradar.hxx"
|
||||
#include "agradar.hxx"
|
||||
#include "rad_alt.hxx"
|
||||
#include "tcas.hxx"
|
||||
|
||||
FGInstrumentMgr::FGInstrumentMgr () :
|
||||
_explicitGps(false)
|
||||
|
|
@ -223,6 +224,9 @@ bool FGInstrumentMgr::build (SGPropertyNode* config_props)
|
|||
} else if ( name == "radar-altimeter" ) {
|
||||
set_subsystem( id, new radAlt( node ),1);
|
||||
|
||||
} else if ( name == "tcas" ) {
|
||||
set_subsystem( id, new TCAS( node ) );
|
||||
|
||||
} else {
|
||||
SG_LOG( SG_ALL, SG_ALERT, "Unknown top level section: "
|
||||
<< name );
|
||||
|
|
|
|||
1303
src/Instrumentation/tcas.cxx
Normal file
1303
src/Instrumentation/tcas.cxx
Normal file
File diff suppressed because it is too large
Load diff
377
src/Instrumentation/tcas.hxx
Normal file
377
src/Instrumentation/tcas.hxx
Normal file
|
|
@ -0,0 +1,377 @@
|
|||
// tcas.hxx -- Traffic Alert and Collision Avoidance System (TCAS)
|
||||
//
|
||||
// Written by Thorsten Brehm, started December 2010.
|
||||
//
|
||||
// Copyright (C) 2010 Thorsten Brehm - brehmt (at) gmail com
|
||||
//
|
||||
// This program is free software; you can redistribute it and/or
|
||||
// modify it under the terms of the GNU General Public License as
|
||||
// published by the Free Software Foundation; either version 2 of the
|
||||
// License, or (at your option) any later version.
|
||||
//
|
||||
// This program is distributed in the hope that it will be useful, but
|
||||
// WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||||
// General Public License for more details.
|
||||
//
|
||||
// You should have received a copy of the GNU General Public License
|
||||
// along with this program; if not, write to the Free Software
|
||||
// Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||
|
||||
#ifndef __INSTRUMENTS_TCAS_HXX
|
||||
#define __INSTRUMENTS_TCAS_HXX
|
||||
|
||||
#include <assert.h>
|
||||
|
||||
#include <vector>
|
||||
#include <deque>
|
||||
#include <map>
|
||||
|
||||
#include <simgear/props/props.hxx>
|
||||
#include <simgear/sound/sample_openal.hxx>
|
||||
#include <simgear/structure/subsystem_mgr.hxx>
|
||||
#include "mk_viii.hxx" // voiceplayer only
|
||||
|
||||
using std::vector;
|
||||
using std::deque;
|
||||
using std::map;
|
||||
|
||||
class SGSampleGroup;
|
||||
|
||||
#include <Main/globals.hxx>
|
||||
|
||||
#ifdef _MSC_VER
|
||||
# pragma warning( push )
|
||||
# pragma warning( disable: 4355 )
|
||||
#endif
|
||||
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
// TCAS //////////////////////////////////////////////////////////////////////
|
||||
///////////////////////////////////////////////////////////////////////////////
|
||||
|
||||
class TCAS : public SGSubsystem
|
||||
{
|
||||
|
||||
typedef enum
|
||||
{
|
||||
AdvisoryClear = 0, /*< Clear of traffic */
|
||||
AdvisoryIntrusion = 1, /*< Intrusion flag */
|
||||
AdvisoryClimb = AdvisoryIntrusion|(1 << 1), /*< RA climb */
|
||||
AdvisoryDescend = AdvisoryIntrusion|(1 << 2), /*< RA descend */
|
||||
AdvisoryAdjustVSpeed = AdvisoryIntrusion|(1 << 3), /*< RA adjust vertical speed (TCAS II 7.0 only) */
|
||||
AdvisoryMaintVSpeed = AdvisoryIntrusion|(1 << 4), /*< RA maintain vertical speed */
|
||||
AdvisoryMonitorVSpeed = AdvisoryIntrusion|(1 << 5), /*< RA monitor vertical speed */
|
||||
AdvisoryLevelOff = AdvisoryIntrusion|(1 << 6) /*< RA level off (TCAS II 7.1 only) */
|
||||
} EnumAdvisory;
|
||||
|
||||
typedef enum
|
||||
{
|
||||
OptionNone = 0, /*< no option modifier */
|
||||
OptionIncreaseClimb = (1 << 0), /*< increase climb */
|
||||
OptionIncreaseDescend = (1 << 1), /*< increase descend */
|
||||
OptionCrossingClimb = (1 << 2), /*< crossing climb */
|
||||
OptionCrossingDescent = (1 << 3) /*< crossing descent */
|
||||
} EnumAdvisoryOption;
|
||||
|
||||
typedef enum
|
||||
{
|
||||
SwitchOff = 0, /*< TCAS switched off */
|
||||
SwitchStandby = 1, /*< TCAS standby (no TA/RA) */
|
||||
SwitchTaOnly = 2, /*< TCAS in TA-only mode (no RA) */
|
||||
SwitchAuto = 3 /*< TCAS in TA/RA mode */
|
||||
} EnumModeSwitch;
|
||||
|
||||
typedef enum
|
||||
{
|
||||
ThreatInvisible = -1,/*< Traffic is invisible to TCAS (i.e. no transponder) */
|
||||
ThreatNone = 0, /*< Traffic is visible but no threat. */
|
||||
ThreatProximity = 1, /*< Proximity intruder traffic (no threat). */
|
||||
ThreatTA = 2, /*< TA-level threat traffic. */
|
||||
ThreatRA = 3 /*< RA-level threat traffic. */
|
||||
} EnumThreatLevel;
|
||||
|
||||
typedef struct
|
||||
{
|
||||
int threatLevel; /*< intruder threat level: 0=clear, 1=proximity,
|
||||
2=intruder, 3=proximity intruder */
|
||||
int RA; /*< resolution advisory */
|
||||
int RAOption; /*< option flags for advisory */
|
||||
} ResolutionAdvisory;
|
||||
|
||||
typedef struct
|
||||
{
|
||||
float Tau; /*< vertical/horizontal protection range in seconds */
|
||||
float DMOD; /*< horizontal protection range in nm */
|
||||
float ALIM; /*< vertical protection range in ft */
|
||||
} Thresholds;
|
||||
|
||||
typedef struct
|
||||
{
|
||||
double maxAltitude; /*< max altitude for this sensitivity level */
|
||||
int sl; /*< sensitivity level */
|
||||
Thresholds TA; /*< thresholds for TA-level threats */
|
||||
Thresholds RA; /*< thresholds for RA-level threats */
|
||||
} SensitivityLevel;
|
||||
|
||||
typedef struct
|
||||
{
|
||||
bool verticalTA;
|
||||
bool verticalRA;
|
||||
bool horizontalTA;
|
||||
bool horizontalRA;
|
||||
float horizontalTau;
|
||||
float verticalTau;
|
||||
float relativeAltitudeFt;
|
||||
float verticalFps;
|
||||
} ThreatInfo;
|
||||
|
||||
typedef struct
|
||||
{
|
||||
double lat;
|
||||
double lon;
|
||||
float altFt;
|
||||
float heading;
|
||||
float velocityKt;
|
||||
float verticalFps;
|
||||
} LocalInfo; /*< info structure for local aircraft */
|
||||
|
||||
// /////////////////////////////////////////////////////////////////////////////
|
||||
// // TCAS::Timer //////////////////////////////////////////////////////////////
|
||||
// /////////////////////////////////////////////////////////////////////////////
|
||||
//
|
||||
// class Timer
|
||||
// {
|
||||
// double start_time;
|
||||
//
|
||||
// public:
|
||||
// bool running;
|
||||
//
|
||||
// inline Timer ()
|
||||
// : running(false) {}
|
||||
//
|
||||
// inline void start () { running = true; start_time = globals->get_sim_time_sec(); }
|
||||
// inline void stop () { running = false; }
|
||||
// inline double elapsed () const { assert(running); return globals->get_sim_time_sec() - start_time; }
|
||||
// inline double start_or_elapsed ()
|
||||
// {
|
||||
// if (running)
|
||||
// return elapsed();
|
||||
// else
|
||||
// {
|
||||
// start();
|
||||
// return 0;
|
||||
// }
|
||||
// }
|
||||
// };
|
||||
|
||||
/////////////////////////////////////////////////////////////////////////////
|
||||
// TCAS::PropertiesHandler ///////////////////////////////////////////////
|
||||
/////////////////////////////////////////////////////////////////////////////
|
||||
|
||||
class PropertiesHandler : public FGVoicePlayer::PropertiesHandler
|
||||
{
|
||||
TCAS *tcas;
|
||||
|
||||
public:
|
||||
PropertiesHandler (TCAS *device) :
|
||||
FGVoicePlayer::PropertiesHandler(), tcas(device) {}
|
||||
|
||||
PropertiesHandler (void) : FGVoicePlayer::PropertiesHandler() {}
|
||||
};
|
||||
|
||||
/////////////////////////////////////////////////////////////////////////////
|
||||
// TCAS::VoicePlayer ////////////////////////////////////////////////////////
|
||||
/////////////////////////////////////////////////////////////////////////////
|
||||
|
||||
class VoicePlayer :
|
||||
public FGVoicePlayer
|
||||
{
|
||||
public:
|
||||
VoicePlayer (TCAS* tcas) :
|
||||
FGVoicePlayer(&tcas->properties_handler, "tcas") {}
|
||||
|
||||
~VoicePlayer (void) {}
|
||||
|
||||
void init (void);
|
||||
|
||||
struct
|
||||
{
|
||||
Voice* pTrafficTraffic;
|
||||
Voice* pClimb;
|
||||
Voice* pClimbNow;
|
||||
Voice* pClimbCrossing;
|
||||
Voice* pClimbIncrease;
|
||||
Voice* pDescend;
|
||||
Voice* pDescendNow;
|
||||
Voice* pDescendCrossing;
|
||||
Voice* pDescendIncrease;
|
||||
Voice* pClear;
|
||||
Voice* pAdjustVSpeed;
|
||||
Voice* pMaintVSpeed;
|
||||
Voice* pMonitorVSpeed;
|
||||
Voice* pLevelOff;
|
||||
Voice* pTestOk;
|
||||
Voice* pTestFail;
|
||||
} Voices;
|
||||
private:
|
||||
SGPropertyNode_ptr nodeSoundFilePrefix;
|
||||
};
|
||||
|
||||
/////////////////////////////////////////////////////////////////////////////
|
||||
// TCAS::Annunciator ////////////////////////////////////////////////////////
|
||||
/////////////////////////////////////////////////////////////////////////////
|
||||
|
||||
class Annunciator
|
||||
{
|
||||
public:
|
||||
Annunciator (TCAS* tcas);
|
||||
~Annunciator (void) {}
|
||||
void bind (SGPropertyNode* node);
|
||||
void init (void);
|
||||
void update (void);
|
||||
|
||||
void trigger (const ResolutionAdvisory& newAdvisory, bool revertedRA);
|
||||
void test (bool testOk);
|
||||
void clear (void);
|
||||
bool isPlaying (void) { return voicePlayer.is_playing();}
|
||||
|
||||
private:
|
||||
ResolutionAdvisory previous;
|
||||
FGVoicePlayer::Voice* pLastVoice;
|
||||
VoicePlayer voicePlayer;
|
||||
SGPropertyNode_ptr nodeGpwsAlertOn;
|
||||
};
|
||||
|
||||
/////////////////////////////////////////////////////////////////////////////
|
||||
// TCAS::AdvisoryCoordinator ////////////////////////////////////////////////
|
||||
/////////////////////////////////////////////////////////////////////////////
|
||||
|
||||
class AdvisoryCoordinator
|
||||
{
|
||||
public:
|
||||
AdvisoryCoordinator (TCAS* _tcas);
|
||||
~AdvisoryCoordinator (void) {}
|
||||
|
||||
void bind (SGPropertyNode* node);
|
||||
void init (void);
|
||||
void update (int mode);
|
||||
|
||||
void clear (void);
|
||||
void add (const ResolutionAdvisory& newAdvisory);
|
||||
|
||||
private:
|
||||
TCAS* tcas;
|
||||
double lastTATime;
|
||||
ResolutionAdvisory current;
|
||||
ResolutionAdvisory previous;
|
||||
SGPropertyNode_ptr nodeTAWarning;
|
||||
};
|
||||
|
||||
/////////////////////////////////////////////////////////////////////////////
|
||||
// TCAS::AdvisoryGenerator //////////////////////////////////////////////////
|
||||
/////////////////////////////////////////////////////////////////////////////
|
||||
|
||||
class AdvisoryGenerator
|
||||
{
|
||||
public:
|
||||
AdvisoryGenerator (TCAS* _tcas);
|
||||
~AdvisoryGenerator (void) {}
|
||||
|
||||
void init (const LocalInfo* _pSelf, const ThreatInfo* _pCurrentThreat);
|
||||
|
||||
void setAlarmThresholds (const SensitivityLevel* _pAlarmThresholds);
|
||||
|
||||
int resolution (int mode, int threatLevel, float distanceNm,
|
||||
float altFt, float heading, float velocityKt);
|
||||
|
||||
private:
|
||||
float verticalSeparation (float newVerticalFps);
|
||||
void determineRAsense (int& RASense, bool& isCrossing);
|
||||
|
||||
private:
|
||||
TCAS* tcas;
|
||||
const LocalInfo* pSelf; /*< info structure for local aircraft */
|
||||
const ThreatInfo* pCurrentThreat; /*< info structure on current intruder/threat */
|
||||
const SensitivityLevel* pAlarmThresholds;
|
||||
};
|
||||
|
||||
/////////////////////////////////////////////////////////////////////////////
|
||||
// TCAS::ThreatDetector /////////////////////////////////////////////////////
|
||||
/////////////////////////////////////////////////////////////////////////////
|
||||
|
||||
class ThreatDetector
|
||||
{
|
||||
public:
|
||||
ThreatDetector (TCAS* _tcas);
|
||||
~ThreatDetector (void) {}
|
||||
|
||||
void init (void);
|
||||
void update (void);
|
||||
|
||||
bool checkTransponder (const SGPropertyNode* pModel, float velocityKt);
|
||||
int checkThreat (int mode, const SGPropertyNode* pModel);
|
||||
void checkVerticalThreat (void);
|
||||
void horizontalThreat (float bearing, float distanceNm, float heading,
|
||||
float velocityKt);
|
||||
|
||||
void setAlt (float altFt) { self.altFt = altFt;}
|
||||
float getAlt (void) { return self.altFt;}
|
||||
float getVelocityKt (void) { return self.velocityKt;}
|
||||
|
||||
private:
|
||||
void unitTest (void);
|
||||
|
||||
private:
|
||||
static const SensitivityLevel sensitivityLevels[];
|
||||
|
||||
TCAS* tcas;
|
||||
int checkCount;
|
||||
|
||||
SGPropertyNode_ptr nodeLat;
|
||||
SGPropertyNode_ptr nodeLon;
|
||||
SGPropertyNode_ptr nodeAlt;
|
||||
SGPropertyNode_ptr nodeHeading;
|
||||
SGPropertyNode_ptr nodeVelocity;
|
||||
SGPropertyNode_ptr nodeVerticalFps;
|
||||
|
||||
LocalInfo self; /*< info structure for local aircraft */
|
||||
ThreatInfo currentThreat; /*< info structure on current intruder/threat */
|
||||
const SensitivityLevel* pAlarmThresholds;
|
||||
};
|
||||
|
||||
private:
|
||||
string name;
|
||||
int num;
|
||||
double nextUpdateTime;
|
||||
int selfTestStep;
|
||||
|
||||
SGPropertyNode_ptr nodeModeSwitch;
|
||||
SGPropertyNode_ptr nodeServiceable;
|
||||
SGPropertyNode_ptr nodeSelfTest;
|
||||
SGPropertyNode_ptr nodeDebugTrigger;
|
||||
SGPropertyNode_ptr nodeDebugRA;
|
||||
SGPropertyNode_ptr nodeDebugThreat;
|
||||
|
||||
PropertiesHandler properties_handler;
|
||||
ThreatDetector threatDetector;
|
||||
AdvisoryCoordinator advisoryCoordinator;
|
||||
AdvisoryGenerator advisoryGenerator;
|
||||
Annunciator annunciator;
|
||||
|
||||
private:
|
||||
void selfTest (void);
|
||||
|
||||
public:
|
||||
TCAS (SGPropertyNode* node);
|
||||
|
||||
virtual void bind (void);
|
||||
virtual void unbind (void);
|
||||
virtual void init (void);
|
||||
virtual void update (double dt);
|
||||
};
|
||||
|
||||
#ifdef _MSC_VER
|
||||
# pragma warning( pop )
|
||||
#endif
|
||||
|
||||
#endif // __INSTRUMENTS_TCAS_HXX
|
||||
Loading…
Reference in a new issue