#include "Math.hpp"
#include "BodyEnvironment.hpp"
#include "RigidBody.hpp"
-#include <Main/fg_props.hxx>
#include <string.h>
+#include <sstream>
namespace yasim {
Hitch::Hitch(const char *name)
{
+ if (fgGetNode("/sim/hitches", true))
+ _node = fgGetNode("/sim/hitches", true)->getNode(name, true);
+ else _node = 0;
int i;
- strncpy(_name,name,128);
- _name[127]=0;
for(i=0; i<3; i++)
_pos[i] = _force[i] = _winchPos[i] = _mp_lpos[i]=_towEndForce[i]=_mp_force[i]=0;
for(i=0; i<2; i++)
_mp_is_slave=false;
_mp_open_last_state=false;
_timeLagCorrectedDist=0;
-
- //tie the properties
- char text[128];
- sprintf(text,"/sim/hitches/%s", _name);
- SGPropertyNode * node = fgGetNode(text, true);
- node->tie("tow/length",SGRawValuePointer<float>(&_towLength));
- node->tie("tow/elastic-constant",SGRawValuePointer<float>(&_towElasticConstant));
- node->tie("tow/weight-per-m-kg-m",SGRawValuePointer<float>(&_towWeightPerM));
- node->tie("tow/brake-force",SGRawValuePointer<float>(&_towBrakeForce));
- node->tie("winch/max-speed-m-s",SGRawValuePointer<float>(&_winchMaxSpeed));
- node->tie("winch/rel-speed",SGRawValuePointer<float>(&_winchRelSpeed));
- node->tie("winch/initial-tow-length-m",SGRawValuePointer<float>(&_winchInitialTowLength));
- node->tie("winch/min-tow-length-m",SGRawValuePointer<float>(&_winchMinTowLength));
- node->tie("winch/max-tow-length-m",SGRawValuePointer<float>(&_winchMaxTowLength));
- node->tie("winch/global-pos-x",SGRawValuePointer<double>(&_winchPos[0]));
- node->tie("winch/global-pos-y",SGRawValuePointer<double>(&_winchPos[1]));
- node->tie("winch/global-pos-z",SGRawValuePointer<double>(&_winchPos[2]));
- node->tie("winch/max-power",SGRawValuePointer<float>(&_winchPower));
- node->tie("winch/max-force",SGRawValuePointer<float>(&_winchMaxForce));
- node->tie("winch/actual-force",SGRawValuePointer<float>(&_winchActualForce));
- node->tie("tow/end-force-x",SGRawValuePointer<float>(&_reportTowEndForce[0]));
- node->tie("tow/end-force-y",SGRawValuePointer<float>(&_reportTowEndForce[1]));
- node->tie("tow/end-force-z",SGRawValuePointer<float>(&_reportTowEndForce[2]));
- node->tie("force",SGRawValuePointer<float>(&_forceMagnitude));
- node->tie("open",SGRawValuePointer<bool>(&_open));
- node->tie("force-is-calculated-by-other",SGRawValuePointer<bool>(&_forceIsCalculatedByMaster));
- node->tie("local-pos-x",SGRawValuePointer<float>(&_pos[0]));
- node->tie("local-pos-y",SGRawValuePointer<float>(&_pos[1]));
- node->tie("local-pos-z",SGRawValuePointer<float>(&_pos[2]));
- node->tie("tow/dist",SGRawValuePointer<float>(&_dist));
- node->tie("tow/dist-time-lag-corrected",SGRawValuePointer<float>(&_timeLagCorrectedDist));
- node->tie("tow/connected-to-property-node",SGRawValuePointer<bool>(&_towEndIsConnectedToProperty));
- node->tie("tow/connected-to-mp-node",SGRawValuePointer<bool>(&_nodeIsMultiplayer));
- node->tie("tow/connected-to-ai-node",SGRawValuePointer<bool>(&_nodeIsAiAircraft));
- node->tie("tow/connected-to-ai-or-mp-id",SGRawValuePointer<int>(&_nodeID));
- node->tie("debug/hitch-height-above-ground",SGRawValuePointer<float>(&_height_above_ground));
- node->tie("debug/tow-end-height-above-ground",SGRawValuePointer<float>(&_winch_height_above_ground));
- node->tie("debug/tow-rel-lo-pos",SGRawValuePointer<float>(&_loPosFrac));
- node->tie("debug/tow-lowest-pos-height",SGRawValuePointer<float>(&_lowest_tow_height));
- node->tie("is-slave",SGRawValuePointer<bool>(&_isSlave));
- node->tie("speed-in-tow-direction",SGRawValuePointer<float>(&_speed_in_tow_direction));
- node->tie("mp-auto-connect-period",SGRawValuePointer<float>(&_mpAutoConnectPeriod));
- node->tie("mp-time-lag",SGRawValuePointer<float>(&_mp_time_lag));
- node->setStringValue("tow/Node","");
- node->setStringValue("tow/connectedToAIorMP-callsign");
- node->setBoolValue("broken",false);
+ if (_node)
+ {
+ _node->tie("tow/length",SGRawValuePointer<float>(&_towLength));
+ _node->tie("tow/elastic-constant",SGRawValuePointer<float>(&_towElasticConstant));
+ _node->tie("tow/weight-per-m-kg-m",SGRawValuePointer<float>(&_towWeightPerM));
+ _node->tie("tow/brake-force",SGRawValuePointer<float>(&_towBrakeForce));
+ _node->tie("winch/max-speed-m-s",SGRawValuePointer<float>(&_winchMaxSpeed));
+ _node->tie("winch/rel-speed",SGRawValuePointer<float>(&_winchRelSpeed));
+ _node->tie("winch/initial-tow-length-m",SGRawValuePointer<float>(&_winchInitialTowLength));
+ _node->tie("winch/min-tow-length-m",SGRawValuePointer<float>(&_winchMinTowLength));
+ _node->tie("winch/max-tow-length-m",SGRawValuePointer<float>(&_winchMaxTowLength));
+ _node->tie("winch/global-pos-x",SGRawValuePointer<double>(&_winchPos[0]));
+ _node->tie("winch/global-pos-y",SGRawValuePointer<double>(&_winchPos[1]));
+ _node->tie("winch/global-pos-z",SGRawValuePointer<double>(&_winchPos[2]));
+ _node->tie("winch/max-power",SGRawValuePointer<float>(&_winchPower));
+ _node->tie("winch/max-force",SGRawValuePointer<float>(&_winchMaxForce));
+ _node->tie("winch/actual-force",SGRawValuePointer<float>(&_winchActualForce));
+ _node->tie("tow/end-force-x",SGRawValuePointer<float>(&_reportTowEndForce[0]));
+ _node->tie("tow/end-force-y",SGRawValuePointer<float>(&_reportTowEndForce[1]));
+ _node->tie("tow/end-force-z",SGRawValuePointer<float>(&_reportTowEndForce[2]));
+ _node->tie("force",SGRawValuePointer<float>(&_forceMagnitude));
+ _node->tie("open",SGRawValuePointer<bool>(&_open));
+ _node->tie("force-is-calculated-by-other",SGRawValuePointer<bool>(&_forceIsCalculatedByMaster));
+ _node->tie("local-pos-x",SGRawValuePointer<float>(&_pos[0]));
+ _node->tie("local-pos-y",SGRawValuePointer<float>(&_pos[1]));
+ _node->tie("local-pos-z",SGRawValuePointer<float>(&_pos[2]));
+ _node->tie("tow/dist",SGRawValuePointer<float>(&_dist));
+ _node->tie("tow/dist-time-lag-corrected",SGRawValuePointer<float>(&_timeLagCorrectedDist));
+ _node->tie("tow/connected-to-property-node",SGRawValuePointer<bool>(&_towEndIsConnectedToProperty));
+ _node->tie("tow/connected-to-mp-node",SGRawValuePointer<bool>(&_nodeIsMultiplayer));
+ _node->tie("tow/connected-to-ai-node",SGRawValuePointer<bool>(&_nodeIsAiAircraft));
+ _node->tie("tow/connected-to-ai-or-mp-id",SGRawValuePointer<int>(&_nodeID));
+ _node->tie("debug/hitch-height-above-ground",SGRawValuePointer<float>(&_height_above_ground));
+ _node->tie("debug/tow-end-height-above-ground",SGRawValuePointer<float>(&_winch_height_above_ground));
+ _node->tie("debug/tow-rel-lo-pos",SGRawValuePointer<float>(&_loPosFrac));
+ _node->tie("debug/tow-lowest-pos-height",SGRawValuePointer<float>(&_lowest_tow_height));
+ _node->tie("is-slave",SGRawValuePointer<bool>(&_isSlave));
+ _node->tie("speed-in-tow-direction",SGRawValuePointer<float>(&_speed_in_tow_direction));
+ _node->tie("mp-auto-connect-period",SGRawValuePointer<float>(&_mpAutoConnectPeriod));
+ _node->tie("mp-time-lag",SGRawValuePointer<float>(&_mp_time_lag));
+ _node->setStringValue("tow/node","");
+ _node->setStringValue("tow/connected-to-ai-or-mp-callsign");
+ _node->setBoolValue("broken",false);
+ }
}
Hitch::~Hitch()
{
- char text[128];
- sprintf(text,"/sim/hitches/%s", _name);
- SGPropertyNode * node = fgGetNode(text, true);
- node->untie("tow/length");
- node->untie("tow/elastic-constant");
- node->untie("tow/weight-per-m-kg-m");
- node->untie("tow/brake-force");
- node->untie("winch/max-speed-m-s");
- node->untie("winch/rel-speed");
- node->untie("winch/initial-tow-length-m");
- node->untie("winch/min-tow-length-m");
- node->untie("winch/max-tow-length-m");
- node->untie("winch/global-pos-x");
- node->untie("winch/global-pos-y");
- node->untie("winch/global-pos-z");
- node->untie("winch/max-power");
- node->untie("winch/max-force");
- node->untie("winch/actual-force");
- node->untie("tow/end-force-x");
- node->untie("tow/end-force-y");
- node->untie("tow/end-force-z");
- node->untie("force");
- node->untie("open");
- node->untie("force-is-calculated-by-other");
- node->untie("local-pos-x");
- node->untie("local-pos-y");
- node->untie("local-pos-z");
- node->untie("tow/dist");
- node->untie("tow/dist-time-lag-corrected");
- node->untie("tow/connected-to-property-node");
- node->untie("tow/connected-to-mp-node");
- node->untie("tow/connected-to-ai-node");
- node->untie("tow/connected-to-ai-or-mp-id");
- node->untie("debug/hitch-height-above-ground");
- node->untie("debug/tow-end-height-above-ground");
- node->untie("debug/tow-rel-lo-pos");
- node->untie("debug/tow-lowest-pos-height");
- node->untie("is-slave");
- node->untie("speed-in-tow-direction");
- node->untie("mp-auto-connect-period");
- node->untie("mp-time-lag");
-
+ if (_node)
+ {
+ _node->untie("tow/length");
+ _node->untie("tow/elastic-constant");
+ _node->untie("tow/weight-per-m-kg-m");
+ _node->untie("tow/brake-force");
+ _node->untie("winch/max-speed-m-s");
+ _node->untie("winch/rel-speed");
+ _node->untie("winch/initial-tow-length-m");
+ _node->untie("winch/min-tow-length-m");
+ _node->untie("winch/max-tow-length-m");
+ _node->untie("winch/global-pos-x");
+ _node->untie("winch/global-pos-y");
+ _node->untie("winch/global-pos-z");
+ _node->untie("winch/max-power");
+ _node->untie("winch/max-force");
+ _node->untie("winch/actual-force");
+ _node->untie("tow/end-force-x");
+ _node->untie("tow/end-force-y");
+ _node->untie("tow/end-force-z");
+ _node->untie("force");
+ _node->untie("open");
+ _node->untie("force-is-calculated-by-other");
+ _node->untie("local-pos-x");
+ _node->untie("local-pos-y");
+ _node->untie("local-pos-z");
+ _node->untie("tow/dist");
+ _node->untie("tow/dist-time-lag-corrected");
+ _node->untie("tow/connected-to-property-node");
+ _node->untie("tow/connected-to-mp-node");
+ _node->untie("tow/connected-to-ai-node");
+ _node->untie("tow/connected-to-ai-or-mp-id");
+ _node->untie("debug/hitch-height-above-ground");
+ _node->untie("debug/tow-end-height-above-ground");
+ _node->untie("debug/tow-rel-lo-pos");
+ _node->untie("debug/tow-lowest-pos-height");
+ _node->untie("is-slave");
+ _node->untie("speed-in-tow-direction");
+ _node->untie("mp-auto-connect-period");
+ _node->untie("mp-time-lag");
+ }
delete _state;
}
_forceIsCalculatedByMaster=b;
}
-const char *Hitch::getConnectedPropertyNode() const
+std::string Hitch::getConnectedPropertyNode() const
{
if (_towEndNode)
return _towEndNode->getDisplayName();
else
- return 0;
+ return std::string("");
}
void Hitch::setConnectedPropertyNode(const char *nodename)
_state->posLocalToGlobal(lWinchPos,_winchPos);
_towLength=_winchInitialTowLength;
- SG_LOG(SG_GENERAL, SG_ALERT,"Set the winch pos to "<<_winchPos[0]<<","<<_winchPos[1]<<","<<_winchPos[2]<<endl);
+ fgSetString("/sim/messages/pilot", "Connected to winch!");
_open=false;
- char text[512];
- sprintf(text,"/sim/hitches/%s", _name);
- SGPropertyNode * node = fgGetNode(text, true);
- node->setBoolValue("broken",false);
+ _node->setBoolValue("broken",false);
//set the dist value (if not, the hitch would open in the next calcforce run
- //float delta[3];
- //Math::sub3(lWinchPos,_pos,delta);
- //_dist=Math::mag3(delta);
- _dist=Math::mag3(lWinchPos); //use the aircraft center as reference for distance calculation
- //this position is transferred to the MP-Aircraft.
- //With this trick, both player in aerotow get the same length
-
+ float delta[3];
+ Math::sub3(lWinchPos,_pos,delta);
+ _dist=Math::mag3(delta);
}
void Hitch::findBestAIObject(bool doit,bool running_as_autoconnect)
static bool lastState=false;
if(!_state)
return;
- if (!doit)
+ if (!running_as_autoconnect)
{
- lastState=false;
- return;
+ //if this function is binded to an input, it will be called every frame as long as the key is pressed.
+ //therefore wait for a key-release before running it again.
+ if (!doit)
+ {
+ lastState=false;
+ return;
+ }
+ if(lastState)
+ return;
+ lastState=true;
}
- if(lastState)
- return;
- lastState=true;
double gpos[3];
_state->posLocalToGlobal(_pos,gpos);
double bestdist=_towLength*_towLength;//squared!
if (!_nodeIsMultiplayer)
continue;
if(n->getBoolValue("sim/hitches/aerotow/open",true)) continue;
- if(strncmp(myCallsign,n->getStringValue("sim/hitches/aerotow/tow/connectedToAIorMP-callsign"),255)!=0)
+ if(strncmp(myCallsign,n->getStringValue("sim/hitches/aerotow/tow/connected-to-ai-or-mp-callsign"),255)!=0)
continue;
}
double pos[3];
bestdist=dist;
_towEndNode=n;
_towEndIsConnectedToProperty=true;
- char text[512];
- sprintf(text,"/sim/hitches/%s", _name);
- SGPropertyNode * node = fgGetNode(text, true);
- //node->setStringValue("tow/Node",n->getPath());
- node->setStringValue("tow/Node",n->getDisplayName());
+ //_node->setStringValue("tow/node",n->getPath());
+ _node->setStringValue("tow/node",n->getDisplayName());
_nodeID=n->getIntValue("id",0);
- node->setStringValue("tow/connectedToAIorMP-callsign",n->getStringValue("callsign"));
+ _node->setStringValue("tow/connected-to-ai-or-mp-callsign",n->getStringValue("callsign"));
_open=false;
found = true;
}
}
if (found)
{
- char text[512];
- sprintf(text,"/sim/hitches/%s", _name);
- SGPropertyNode * node = fgGetNode(text, true);
- //if (!running_as_autoconnect)
- SG_LOG(SG_GENERAL, SG_ALERT,"Found aircraft for aerotow: "
- <<node->getStringValue("tow/connectedToAIorMP-callsign")
- <<", distance "<<Math::sqrt(bestdist)<<"m at "
- <<node->getStringValue("tow/Node")<<endl);
+ if (!running_as_autoconnect)
+ {
+ std::stringstream message;
+ message<<_node->getStringValue("tow/connected-to-ai-or-mp-callsign")
+ <<", I am on your hook, distance "<<Math::sqrt(bestdist)<<" meter.";
+ fgSetString("/sim/messages/pilot", message.str().c_str());
+ }
+ else
+ {
+ std::stringstream message;
+ message<<_node->getStringValue("tow/connected-to-ai-or-mp-callsign")
+ <<": I am on your hook, distance "<<Math::sqrt(bestdist)<<" meter.";
+ fgSetString("/sim/messages/ai-plane", message.str().c_str());
+ }
if (running_as_autoconnect)
_isSlave=true;
//set the dist value to some value below the tow lentgh (if not, the hitch
}
else
if (!running_as_autoconnect)
- SG_LOG(SG_GENERAL, SG_ALERT,"Found no aircraft for aerotow!"<<endl);
+ {
+ fgSetString("/sim/messages/atc", "Sorry, no aircraft for aerotow!");
+ }
}
void Hitch::setWinchInitialTowLength(float length)
*_state=*s;
s->posGlobalToLocal(_winchPos,lWinchPos);
Math::sub3(lWinchPos,_pos,delta);
- //_dist=Math::mag3(delta);
- _dist=Math::mag3(lWinchPos); //use the aircraft center as reference for distance calculation
+ if(!_towEndIsConnectedToProperty)
+ _dist=Math::mag3(delta);
+ else
+ _dist=Math::mag3(lWinchPos); //use the aircraft center as reference for distance calculation
//this position is transferred to the MP-Aircraft.
//With this trick, both player in aerotow get the same length
Math::unit3(delta,deltaN);
{
_forceMagnitude=0;
_open=true;
- char text[128];
- sprintf(text,"/sim/hitches/%s", _name);
- SGPropertyNode * node = fgGetNode(text, true);
- node->setBoolValue("broken",true);
+ _node->setBoolValue("broken",true);
_force[0]=_force[1]=_force[2]=0;
_towEndForce[0]=_towEndForce[1]=_towEndForce[2]=0;
_reportTowEndForce[0]=_reportTowEndForce[1]=_reportTowEndForce[2]=0;
{
_forceMagnitude=0;
_open=true;
- char text[128];
- sprintf(text,"/sim/hitches/%s", _name);
- SGPropertyNode * node = fgGetNode(text, true);
- node->setBoolValue("broken",true);
+ _node->setBoolValue("broken",true);
_force[0]=_force[1]=_force[2]=0;
_towEndForce[0]=_towEndForce[1]=_towEndForce[2]=0;
}
{
if (_dist>_towLength*1.00001)
{
- SG_LOG(SG_GENERAL, SG_ALERT,"Could not lock Hinch (tow length is insufficient) on hitch '"<<_name<<"' !"<<endl);
+ std::stringstream message;
+ message<<"Could not lock hitch (tow length is insufficient) on hitch "
+ <<_node->getName()<<" "<<_node->getIndex()<<"!";
+ fgSetString("/sim/messages/pilot", message.str().c_str());
_open=true;
return;
}
- char text[512];
- sprintf(text,"/sim/hitches/%s", _name);
- SGPropertyNode * node = fgGetNode(text, true);
- node->setBoolValue("broken",false);
+ _node->setBoolValue("broken",false);
}
- SG_LOG(SG_GENERAL, SG_ALERT,(_open?"Opened hitch (or broken tow) '":"Locked hitch '")<<_name<<"' !"<<endl);
+ std::stringstream message;
+ if (_node->getBoolValue("broken",false)&&_open)
+ message<<"Oh no, the tow is broken";
+ else
+ message<<(_open?"Opened hitch ":"Locked hitch ")<<_node->getName()<<" "<<_node->getIndex()<<"!";
+ fgSetString("/sim/messages/pilot", message.str().c_str());
_oldOpen=_open;
}
//check, if tow end can be modified by property, if yes: update
if(_towEndIsConnectedToProperty)
{
- char text[128];
- sprintf(text,"/sim/hitches/%s", _name);
- SGPropertyNode * node = fgGetNode(text, true);
- if (node)
+ if (_node)
{
- //_towEndNode=fgGetNode(node->getStringValue("tow/Node"), false);
+ //_towEndNode=fgGetNode(_node->getStringValue("tow/node"), false);
char towNode[256];
- strncpy(towNode,node->getStringValue("tow/Node"),256);
+ strncpy(towNode,_node->getStringValue("tow/node"),256);
towNode[255]=0;
_towEndNode=fgGetNode("ai/models")->getNode(towNode, false);
//AI and multiplayer objects seem to change node?
{
char MPcallsign[256]="";
const char *MPc;
- MPc=node->getStringValue("tow/connectedToAIorMP-callsign");
+ MPc=_node->getStringValue("tow/connected-to-ai-or-mp-callsign");
if (MPc)
{
strncpy(MPcallsign,MPc,256);
if (strcmp(n->getStringValue("callsign"),MPcallsign)==0)//found
{
_towEndNode=n;
- //node->setStringValue("tow/Node",n->getPath());
- node->setStringValue("tow/Node",n->getDisplayName());
+ //_node->setStringValue("tow/node",n->getPath());
+ _node->setStringValue("tow/node",n->getDisplayName());
}
}
}
{
if(mp_open)
{
- _open=true;
- char text[512];
- sprintf(text,"/sim/hitches/%s", _name);
- SGPropertyNode * node = fgGetNode(text, true);
- node->getStringValue("tow/Node","");
- SG_LOG(SG_GENERAL, SG_ALERT,"'"<<node->getStringValue("tow/Node","")<<"' has opened hitch!"<<endl);
+ _oldOpen=_open=true;
+ std::stringstream message;
+ message<<_node->getStringValue("tow/connected-to-ai-or-mp-callsign")
+ <<": I have released the tow!";
+ fgSetString("/sim/messages/ai-plane", message.str().c_str());
}
}
}
}
}
}
- //set the _reported_tow_end_force (smoothed)
- //smooth it a bit and store it
- float sc=10.*dt; //100ms
- float tmp[3];
- Math::mul3(sc,_towEndForce,tmp);
- Math::mul3(1.-sc,_reportTowEndForce,_reportTowEndForce);
- Math::add3(tmp,_reportTowEndForce,_reportTowEndForce);
+ //set the _reported_tow_end_force
+ Math::set3(_towEndForce,_reportTowEndForce);
if (_open) return;
if (_winchRelSpeed==0) return;
-}; // namespace yasim
\ No newline at end of file
+}; // namespace yasim