//------------------------------------------------------------------------------
bool TDRSSTwoWayRange::Evaluate(bool withEvents)
{
bool retval = false;
if (!initialized)
InitializeMeasurement();
#ifdef DEBUG_RANGE_CALC
MessageInterface::ShowMessage("Entered TDRSSTwoWayRange::Evaluate()\n");
MessageInterface::ShowMessage(" ParticipantCount: %d\n",
participants.size());
#endif
if (withEvents == false)
{
#ifdef DEBUG_RANGE_CALC
MessageInterface::ShowMessage("TDRSS 2-Way Range Calculation without "
"events\n");
#endif
#ifdef VIEW_PARTICIPANT_STATES
DumpParticipantStates("++++++++++++++++++++++++++++++++++++++++++++\n"
"Evaluating TDRSS 2-Way Range without events");
#endif
if (CheckLOS(0, 1, NULL) && CheckLOS(1, 2, NULL))
{
// Calculate the range vector between the groundstation and the TDRS
CalculateRangeVectorInertial(0, 1);
Rvector3 outState;
// Set feasibility off of topospheric horizon, set by the Z value in topo
// coords
std::string updateAll = "All";
UpdateRotationMatrix(currentMeasurement.epoch, updateAll);
outState = R_o_j2k * rangeVecInertial;
currentMeasurement.feasibilityValue = outState[2];
#ifdef CHECK_PARTICIPANT_LOCATIONS
MessageInterface::ShowMessage("Evaluating without events\n");
MessageInterface::ShowMessage("Calculating TDRSS 2-Way Range at epoch "
"%.12lf\n", currentMeasurement.epoch);
MessageInterface::ShowMessage(" J2K Location of %s, id = '%s': %s",
participants[0]->GetName().c_str(),
currentMeasurement.participantIDs[0].c_str(),
p1Loc.ToString().c_str());
MessageInterface::ShowMessage(" J2K Location of %s, id = '%s': %s",
participants[1]->GetName().c_str(),
currentMeasurement.participantIDs[1].c_str(),
p2Loc.ToString().c_str());
Rvector3 bfLoc = R_o_j2k * p1Loc;
MessageInterface::ShowMessage(" BodyFixed Location of %s: %s",
participants[0]->GetName().c_str(),
bfLoc.ToString().c_str());
bfLoc = R_o_j2k * p2Loc;
MessageInterface::ShowMessage(" BodyFixed Location of %s: %s\n",
participants[1]->GetName().c_str(),
bfLoc.ToString().c_str());
#endif
if (currentMeasurement.feasibilityValue > 0.0)
{
currentMeasurement.isFeasible = true;
currentMeasurement.value[0] = rangeVecInertial.GetMagnitude();
currentMeasurement.eventCount = 4;
retval = true;
}
}
else
{
currentMeasurement.isFeasible = false;
currentMeasurement.value[0] = 0.0;
currentMeasurement.eventCount = 0;
}
#ifdef DEBUG_RANGE_CALC
MessageInterface::ShowMessage("Calculating Range at epoch %.12lf\n",
currentMeasurement.epoch);
MessageInterface::ShowMessage(" Location of %s, id = '%s': %s",
participants[0]->GetName().c_str(),
currentMeasurement.participantIDs[0].c_str(),
p1Loc.ToString().c_str());
MessageInterface::ShowMessage(" Location of %s, id = '%s': %s",
participants[1]->GetName().c_str(),
currentMeasurement.participantIDs[1].c_str(),
p2Loc.ToString().c_str());
MessageInterface::ShowMessage(" Range Vector (inertial): %s\n",
rangeVecInertial.ToString().c_str());
MessageInterface::ShowMessage(" R(Groundstation) dot RangeVec = %lf\n",
currentMeasurement.feasibilityValue);
MessageInterface::ShowMessage(" Feasibility: %s\n",
(currentMeasurement.isFeasible ? "true" : "false"));
MessageInterface::ShowMessage(" Range is %.12lf\n",
currentMeasurement.value[0]);
MessageInterface::ShowMessage(" EventCount is %d\n",
currentMeasurement.eventCount);
#endif
#ifdef SHOW_RANGE_CALC
MessageInterface::ShowMessage("Range at epoch %.12lf is ",
currentMeasurement.epoch);
if (currentMeasurement.isFeasible)
MessageInterface::ShowMessage("feasible, value = %.12lf\n",
currentMeasurement.value[0]);
else
MessageInterface::ShowMessage("not feasible\n");
#endif
}
else
{
// Calculate the corrected range measurement
#ifdef DEBUG_RANGE_CALC
MessageInterface::ShowMessage("TDRSS 2-Way Range Calculation:\n");
#endif
#ifdef VIEW_PARTICIPANT_STATES
DumpParticipantStates("********************************************\n"
"Evaluating TDRSS 2-Way Range with located events");
MessageInterface::ShowMessage("Calculating TDRSS 2-Way Range at epoch "
"%.12lf\n", currentMeasurement.epoch);
#endif
// Get the range from the downlink
Rvector3 r1, r2;
r1 = downlinkLeg.GetPosition(participants[0]);
r2 = downlinkLeg.GetPosition(participants[1]);
Rvector3 rVector = r2 - r1;
Real realRange = rVector.GetMagnitude();
#ifdef VIEW_PARTICIPANT_STATES
MessageInterface::ShowMessage(" %s at downlink: %.12lf %.12lf %.12lf\n",
participants[0]->GetName().c_str(), r1[0], r1[1], r1[2]);
MessageInterface::ShowMessage(" %s at downlink: %.12lf %.12lf %.12lf\n",
participants[1]->GetName().c_str(), r2[0], r2[1], r2[2]);
#endif
#ifdef DEBUG_RANGE_CALC
MessageInterface::ShowMessage(" Downlink Range: %.12lf\n",
rVector.GetMagnitude());
#endif
r1 = backlinkLeg.GetPosition(participants[1]);
r2 = backlinkLeg.GetPosition(participants[2]);
if (CheckSat2SatLOS(r1, r2, NULL) == false)
return false;
rVector = r2 - r1;
realRange += rVector.GetMagnitude();
#ifdef VIEW_PARTICIPANT_STATES
MessageInterface::ShowMessage(" %s at backlink: %.12lf %.12lf %.12lf\n",
participants[1]->GetName().c_str(), r1[0], r1[1], r1[2]);
MessageInterface::ShowMessage(" %s at backlink: %.12lf %.12lf %.12lf\n",
participants[2]->GetName().c_str(), r2[0], r2[1], r2[2]);
#endif
#ifdef DEBUG_RANGE_CALC
MessageInterface::ShowMessage(" Backlink Range: %.12lf\n",
rVector.GetMagnitude());
#endif
// Add the pseudorange from the transponder delay
targetDelay = GetDelay(2,0);
#ifdef DEBUG_RANGE_CALC
MessageInterface::ShowMessage(" TDRSS target delay is %.12lf\n",
targetDelay);
#endif
realRange += GmatPhysicalConstants::SPEED_OF_LIGHT_VACUUM / GmatMathConstants::KM_TO_M *
targetDelay;
#ifdef DEBUG_RANGE_CALC
MessageInterface::ShowMessage(" Delay Range (%le sec delay): "
"%.12lf\n", targetDelay,
(GmatPhysicalConstants::SPEED_OF_LIGHT_VACUUM/GmatMathConstants::KM_TO_M * targetDelay));
#endif
r1 = forwardlinkLeg.GetPosition(participants[2]);
r2 = forwardlinkLeg.GetPosition(participants[1]);
if (CheckSat2SatLOS(r1, r2, NULL) == false)
return false;
rVector = r2 - r1;
realRange += rVector.GetMagnitude();
#ifdef VIEW_PARTICIPANT_STATES
MessageInterface::ShowMessage(" %s at frwdlink: %.12lf %.12lf %.12lf\n",
participants[2]->GetName().c_str(), r1[0], r1[1], r1[2]);
MessageInterface::ShowMessage(" %s at frwdlink: %.12lf %.12lf %.12lf\n",
participants[1]->GetName().c_str(), r2[0], r2[1], r2[2]);
#endif
#ifdef DEBUG_RANGE_CALC
MessageInterface::ShowMessage(" forwardlink Range: %.12lf\n",
rVector.GetMagnitude());
#endif
r1 = uplinkLeg.GetPosition(participants[1]);
r2 = uplinkLeg.GetPosition(participants[0]);
rVector = r2 - r1;
realRange += rVector.GetMagnitude();
#ifdef VIEW_PARTICIPANT_STATES
MessageInterface::ShowMessage(" %s at frwdlink: %.12lf %.12lf %.12lf\n",
participants[1]->GetName().c_str(), r1[0], r1[1], r1[2]);
MessageInterface::ShowMessage(" %s at frwdlink: %.12lf %.12lf %.12lf\n",
participants[0]->GetName().c_str(), r2[0], r2[1], r2[2]);
#endif
#ifdef DEBUG_RANGE_CALC
MessageInterface::ShowMessage(" Uplink Range: %.12lf\n",
rVector.GetMagnitude());
#endif
currentMeasurement.value[0] = realRange / 2.0;
#ifdef DEBUG_RANGE_CALC
MessageInterface::ShowMessage(" Calculated Range: %.12lf\n",
currentMeasurement.value[0]);
#endif
retval = true;
}
return retval;
}
/*
** GroundClass Exec() function.
** NOTE: returns TRUE if we've processed this frame. FALSE if we're to do
** dead reckoning (in VU)
*/
int GroundClass::Exec (void)
{
//RV - I-Hawk - Added a 0 vector for RV new PS calls
Tpoint PSvec;
PSvec.x = 0;
PSvec.y = 0;
PSvec.z = 0;
Tpoint pos;
Tpoint vec;
float speedScale;
float groundZ;
float labelLOD;
float drawLOD;
RadarClass *radar = NULL;
SoundPos.UpdatePos((SimBaseClass *)this);
//Cobra
pos.x = 0.0f;
pos.y = 0.0f;
pos.z = 0.0f;
// MLR 5/23/2004 -
pos.x = XPos();
pos.y = YPos();
pos.z = OTWDriver.GetApproxGroundLevel( pos.x, pos.y );
// pos.z = -10.0f;//Cobra trying to fix the stupid uninit CTD
SetPosition(pos.x, pos.y, pos.z);
// dead? -- we do nothing
if ( IsDead() ){
return FALSE;
}
// if damaged
if ( pctStrength < 0.5f ){
if (sfxTimer > 1.5f - gai->distLOD * 1.3){
// reset the timer
sfxTimer = 0.0f;
pos.z -= 10.0f;
// VP_changes this shoud be checked why have GetGroundLevel been subtracted by 10.0F
// Sometimes the trails seem strange
vec.x = PRANDFloat() * 20.0f;
vec.y = PRANDFloat() * 20.0f;
vec.z = PRANDFloat() * 20.0f;
/*
OTWDriver.AddSfxRequest(
new SfxClass(
SFX_TRAILSMOKE, // type
SFX_MOVES | SFX_NO_GROUND_CHECK, // flags
&pos, // world pos
&vec, // vector
3.5f, // time to live
4.5f // scale
)
);
*/
DrawableParticleSys::PS_AddParticleEx((SFX_TRAILSMOKE + 1),
&pos,
&vec);
}
}
if (IsExploding()){
// KCK: I've never seen this section of code executed. Maybe it gets hit, but I doubt
// it.
if (!IsSetFlag( SHOW_EXPLOSION )){
// Show the explosion
Tpoint pos, vec;
Falcon4EntityClassType *classPtr = (Falcon4EntityClassType *)EntityType();
//DrawableGroundVehicle *destroyedPtr; // FRB
//Cobra TJL 11/07/04 CTD point initialize here
pos.x = 0.0f;
pos.y = 0.0f;
pos.z = 0.0f;
// MLR 5/23/2004 - uncommented out the x, y
pos.x = XPos();
pos.y = YPos();
pos.z = OTWDriver.GetApproxGroundLevel( pos.x, pos.y ) - 10.0f;
vec.x = 0.0f;
vec.y = 0.0f;
vec.z = 0.0f;
// create a new drawable for destroyed vehicle
// sometimes.....
//RV - I-Hawk - Commenting all this if statement... not necessary
/*
if ( rand() & 1 ){
destroyedPtr = new DrawableGroundVehicle(
classPtr->visType[3],
&pos,
Yaw(),
1.0f
);
groundZ = PRANDFloatPos() * 60.0f + 15.0f;
/*
OTWDriver.AddSfxRequest(
new SfxClass (
SFX_BURNING_PART, // type
&pos, // world pos
&vec, //
(DrawableBSP *)destroyedPtr,
groundZ, // time to live
1.0f // scale
)
);
*/
/*
DrawableParticleSys::PS_AddParticleEx((SFX_BURNING_PART + 1),
&pos,
&vec);
pos.z += 10.0f;
/*
OTWDriver.AddSfxRequest(
new SfxClass(
SFX_FEATURE_EXPLOSION, // type
&pos, // world pos
groundZ, // time to live
100.0f // scale
)
);
*/
/*
DrawableParticleSys::PS_AddParticleEx((SFX_FEATURE_EXPLOSION + 1),
&pos,
&PSvec);
}
*/
//RV - I-Hawk - seperating explosion type for ground/sea domains. also
//adding a check so soldiers will not explode like ground vehicles...
if (GetDomain() == DOMAIN_LAND && GetType() != TYPE_FOOT)
{
//pos.z -= 20.0f;
/*
OTWDriver.AddSfxRequest(
new SfxClass(
SFX_VEHICLE_EXPLOSION, // type
&pos, // world pos
1.5f, // time to live
100.0f // scale
)
);
*/
DrawableParticleSys::PS_AddParticleEx((SFX_VEHICLE_EXPLOSION + 1),
&pos,
&PSvec);
}
else if ( GetDomain() == DOMAIN_SEA )
{
DrawableParticleSys::PS_AddParticleEx((SFX_WATER_FIREBALL + 1),
&pos,
&PSvec);
}
// make sure we don't do it again...
SetFlag( SHOW_EXPLOSION );
// we can now kill it immediately
SetDead(TRUE);
}
return FALSE;
}
// exec any base functionality
SimVehicleClass::Exec();
// Sept 30, 2002
// VP_changes: Frequently Z value is not in the correct place. It should follow the terrain.
if ( drawPointer ){
drawPointer->GetPosition( &pos );
}
else {
return FALSE;
}
//JAM 27Sep03 - Let's try this
groundZ = pos.z; // - 0.7f; KCK: WTF is this?
//VP_changes Sept 25
groundZ = OTWDriver.GetGroundLevel( pos.x, pos.y );
// Movement/Targeting for local entities
if (IsLocal() && SimDriver.MotionOn())
{
//I commented this out, because it is done in gai->ProcessTargeting down below DSP 4/30/99
// Refresh our target pointer (if any)
//SetTarget( SimCampHandoff( targetPtr, targetList, HANDOFF_RANDOM ) );
// Look for someone to do radar fire control for us
FindBattalionFireControl();
// RV - Biker - Switch on lights for ground/naval vehicles
int isNight = TimeOfDayGeneral(TheCampaign.CurrentTime) < TOD_DAWNDUSK ? true : false;
if (drawPointer && ((DrawableBSP *)drawPointer)->GetNumSwitches() >= AIRDEF_LIGHT_SWITCH)
{
if (isShip)
{
isNight = (TimeOfDayGeneral(TheCampaign.CurrentTime) <= TOD_DAWNDUSK || realWeather->weatherCondition == INCLEMENT) ? true : false;
if (pctStrength > 0.50f)
{
((DrawableBSP *)drawPointer)->SetSwitchMask(0, isNight);
((DrawableBSP *)drawPointer)->SetSwitchMask(AIRDEF_LIGHT_SWITCH, isNight);
}
}
else if (GetVt() > 1.0f)
{
VuListIterator vehicleWalker(SimDriver.combinedList);
FalconEntity* object = (FalconEntity*)vehicleWalker.GetFirst();
bool hasThreat = false;
float range = 999.9f * NM_TO_FT;
// Consider each potential target in our environment
while (object && !hasThreat)
{
// Skip sleeping sim objects
if (object->IsSim())
{
if (!((SimBaseClass*)object)->IsAwake())
{
object = (FalconEntity*)vehicleWalker.GetNext();
continue;
}
}
// Fow now we skip missles -- might want to display them eventually...
if (object->IsMissile() || object->IsBomb())
{
object = (FalconEntity*)vehicleWalker.GetNext();
continue;
}
if (object->GetTeam() == GetTeam())
{
object = (FalconEntity*)vehicleWalker.GetNext();
continue;
}
float dx = object->XPos() - XPos();
float dy = object->YPos() - YPos();
float dz = object->ZPos() - ZPos();
range = (float)sqrt(dx*dx + dy*dy + dz*dz);
if (range < 5.0f * NM_TO_FT)
hasThreat = true;
object = (FalconEntity*)vehicleWalker.GetNext();
}
// If no enemy nearby and not heavy damaged switch on lights
if (!hasThreat && pctStrength > 0.75f) {
((DrawableBSP *)drawPointer)->SetSwitchMask(AIRDEF_LIGHT_SWITCH, isNight);
}
else
{
((DrawableBSP *)drawPointer)->SetSwitchMask(AIRDEF_LIGHT_SWITCH, 0);
}
}
else
{
((DrawableBSP *)drawPointer)->SetSwitchMask(AIRDEF_LIGHT_SWITCH, 0);
}
}
// RV - Biker - Do also switch on lights for tractor vehicles
if (truckDrawable && truckDrawable->GetNumSwitches() >= AIRDEF_LIGHT_SWITCH)
{
if (GetVt() > 1.0f)
{
VuListIterator vehicleWalker(SimDriver.combinedList);
FalconEntity* object = (FalconEntity*)vehicleWalker.GetFirst();
bool hasThreat = false;
float range = 999.9f * NM_TO_FT;
// Consider each potential target in our environment
while (object && !hasThreat)
{
// Skip sleeping sim objects
if (object->IsSim())
{
if (!((SimBaseClass*)object)->IsAwake())
{
object = (FalconEntity*)vehicleWalker.GetNext();
continue;
}
}
// Fow now we skip missles -- might want to display them eventually...
if (object->IsMissile() || object->IsBomb())
{
object = (FalconEntity*)vehicleWalker.GetNext();
continue;
}
if (object->GetTeam() == GetTeam())
{
object = (FalconEntity*)vehicleWalker.GetNext();
continue;
}
float dx = object->XPos() - XPos();
float dy = object->YPos() - YPos();
float dz = object->ZPos() - ZPos();
range = (float)sqrt(dx*dx + dy*dy + dz*dz);
if (range < 5.0f * NM_TO_FT)
hasThreat = true;
object = (FalconEntity*)vehicleWalker.GetNext();
}
// If no enemy nearby and not heavy damaged switch on lights
if (!hasThreat && pctStrength > 0.75f) {
truckDrawable->SetSwitchMask(AIRDEF_LIGHT_SWITCH, isNight);
}
else
{
truckDrawable->SetSwitchMask(AIRDEF_LIGHT_SWITCH, 0);
}
}
else
{
truckDrawable->SetSwitchMask(AIRDEF_LIGHT_SWITCH, 0);
}
}
// RV - Biker - Shut down ship radar if damaged
if (isShip && radarDown == false && pctStrength < 0.9f && rand()%50 > (pctStrength - 0.50f)*100)
{
isEmitter = false;
RadarClass *radar = (RadarClass*)FindSensor(this, SensorClass::Radar);
if (radar)
{
radarDown = true;
radar->SetDesiredTarget(NULL);
radar->SetEmitting(FALSE);
}
if (targetPtr)
{
SelectWeapon(true);
}
}
// 2001-03-26 ADDED BY S.G. NEED TO KNOW IF THE RADAR CALLED SetSpotted
// RV - Biker - Rotate radars
float deltaDOF;
float curDOF = GetDOFValue(5);
deltaDOF = 180.0f * DTR * SimLibMajorFrameTime;
curDOF += deltaDOF;
if ( curDOF > 360.0f * DTR )
curDOF -= 360.0f * DTR;
SetDOF(5, curDOF);
int spottedSet = FALSE;
// END OF ADDED SECTION
// 2002-03-21 ADDED BY S.G.
// If localData only has zeros,
// there is a good chance they are not valid (should not happen here though)...
if (targetPtr) {
SimObjectLocalData* localData= targetPtr->localData;
if (
localData->ataFrom == 0.0f &&
localData->az == 0.0f &&
localData->el == 0.0f &&
localData->range == 0.0f
) {
CalcRelAzElRangeAta(this, targetPtr);
}
}
// END OF ADDED SECTION 2002-03-21
// check for sending radar emmisions
// 2002-02-26 MODIFIED BY S.G.
// Added the nextTargetUpdate check to prevent the radar code to run on every frame!
if ( isEmitter && nextTargetUpdate < SimLibElapsedTime){
// 2002-02-26 ADDED BY S.G. Next radar scan is 1 sec for aces, 2 for vets, etc ...
nextTargetUpdate = SimLibElapsedTime + (5 - gai->skillLevel) * SEC_TO_MSEC;
radar = (RadarClass*)FindSensor( this, SensorClass::Radar );
ShiAssert( radar );
if (radar){
radar->Exec( targetList );
}
// 2001-03-26 ADDED BY S.G.
// IF WE CAN SEE THE RADAR'S TARGET AND WE ARE A AIR DEFENSE THINGY
// NOT IN A BKOGEN MORAL STATE, MARK IT AS SPOTTED IF WE'RE BRIGHT ENOUGH
if (
radar &&
radar->CurrentTarget() &&
gai->skillLevel >= 3 &&
((UnitClass *)GetCampaignObject())->GetSType() == STYPE_UNIT_AIR_DEFENSE &&
!((UnitClass *)GetCampaignObject())->Broken()
){
CampBaseClass *campBaseObj;
if (radar->CurrentTarget()->BaseData()->IsSim()){
campBaseObj = ((SimBaseClass *)radar->CurrentTarget()->BaseData())->GetCampaignObject();
}
else{
campBaseObj = (CampBaseClass *)radar->CurrentTarget()->BaseData();
}
// JB 011002 If campBaseObj is NULL the target may be chaff
if (campBaseObj && !(campBaseObj->GetSpotted(GetTeam())) && campBaseObj->IsFlight()){
RequestIntercept((FlightClass *)campBaseObj, GetTeam());
}
spottedSet = TRUE;
if (campBaseObj && radar->GetRadarDatFile()){
campBaseObj->SetSpotted(
GetTeam(), TheCampaign.CurrentTime,
(radar->radarData->flag & RAD_NCTR) != 0 &&
radar->CurrentTarget()->localData &&
radar->CurrentTarget()->localData->ataFrom < 45.0f * DTR &&
radar->CurrentTarget()->localData->range <
radar->GetRadarDatFile()->MaxNctrRange / (2.0f * (16.0f - (float)gai->skillLevel) / 16.0f)
);
}
// 2002-03-05 MODIFIED BY S.G. target's aspect and skill used in the equation
}
// END OF ADDED SECTION
}
// 2001-03-26 ADDED BY S.G.
// IF THE BATTALION LEAD HAS LOS
// ON IT AND WE ARE A AIR DEFENSE THINGY NOT IN A BKOGEN MORAL STATE,
// MARK IT AS SPOTTED IF WE'RE BRIGHT ENOUGH
// 2002-02-11 MODIFED BY S.G.
// Since I only identify visually, need to perform this even if spotted by radar in case I can ID it.
if (
/*!spottedSet && gai->skillLevel >= 3 && */
((UnitClass *)GetCampaignObject())->GetSType() == STYPE_UNIT_AIR_DEFENSE &&
gai == gai->battalionCommand &&
!((UnitClass *)GetCampaignObject())->Broken() &&
gai->GetAirTargetPtr() &&
CheckLOS(gai->GetAirTargetPtr())
){
CampBaseClass *campBaseObj;
if (gai->GetAirTargetPtr()->BaseData()->IsSim())
campBaseObj = ((SimBaseClass *)gai->GetAirTargetPtr()->BaseData())->GetCampaignObject();
else
campBaseObj = (CampBaseClass *)gai->GetAirTargetPtr()->BaseData();
// JB 011002 If campBaseObj is NULL the target may be chaff
if (!spottedSet && campBaseObj && !(campBaseObj->GetSpotted(GetTeam())) && campBaseObj->IsFlight())
RequestIntercept((FlightClass *)campBaseObj, GetTeam());
if (campBaseObj)
campBaseObj->SetSpotted(GetTeam(),TheCampaign.CurrentTime, 1);
// 2002-02-11 MODIFIED BY S.G. Visual detection means identified as well
}
// END OF ADDED SECTION
// KCK: When should we run a target update cycle?
if (SimLibElapsedTime > lastProcess){
gai->ProcessTargeting();
lastProcess = SimLibElapsedTime + processRate;
}
// KCK: Check if it's ok to think
if (SimLibElapsedTime > lastThought ){
// do movement and (possibly) firing....
gai->Process ();
lastThought = SimLibElapsedTime + thoughtRate;
}
// RV - Biker - Only allow SAM fire if radar still does work
SimWeaponClass *theWeapon = Sms->GetCurrentWeapon();
// FRB - This version seems to give SAMs a little more activity
if(SimLibElapsedTime > nextSamFireTime && !allowSamFire){
allowSamFire = TRUE;
}
// Biker's version
//if(SimLibElapsedTime > nextSamFireTime && !allowSamFire)
//{
// if (radarDown == false || (theWeapon && theWeapon->IsMissile() && theWeapon->sensorArray[0]->Type() == SensorClass::IRST))
// allowSamFire = TRUE;
//}
// Move and update delta;
gai->Move_Towards_Dest();
// edg: always insure that our Z position is valid for the entity.
// the draw pointer should have this value
// KCK NOTE: The Z we have is actually LAST FRAME's Z. Probably not a big deal.
SetPosition(
XPos() + XDelta() * SimLibMajorFrameTime,
YPos() + YDelta() * SimLibMajorFrameTime,
groundZ
);
// do firing
// this also does weapon keep alive
if ( Sms ){
gai->Fire();
}
}
// KCK: I simplified this some. This is now speed squared.
speedScale = XDelta()*XDelta() + YDelta()*YDelta();
// set our level of detail
if ( gai == gai->battalionCommand ){
gai->SetDistLOD();
}
else{
gai->distLOD = gai->battalionCommand->distLOD;
}
// do some extra LOD stuff: if the unit is not a lead veh amd the
// distLOD is less than a certain value, remove it from the draw
// list.
if (drawPointer && gai->rank != GNDAI_BATTALION_COMMANDER){
// distLOD cutoff by ranking (KCK: This is explicit for testing, could be a formula/table)
if (gai->rank & GNDAI_COMPANY_LEADER){
labelLOD = .5F;
drawLOD = .25F;
}
else if (gai->rank & GNDAI_PLATOON_LEADER){
labelLOD = .925F;
drawLOD = .5F;
}
else {
labelLOD = 1.1F;
drawLOD = .75F;
}
// RV - Biker - Why do this maybe helpful knowing which vehicle has problems
// Determine wether to draw label or not
if (gai->distLOD < labelLOD){
if (!IsSetLocalFlag(NOT_LABELED)){
drawPointer->SetLabel ("", 0xff00ff00); // Don't label
SetLocalFlag(NOT_LABELED);
}
}
else if (IsSetLocalFlag(NOT_LABELED)){
SetLabel(this);
UnSetLocalFlag(NOT_LABELED);
}
//if (IsSetLocalFlag(NOT_LABELED)) {
// SetLabel(this);
// UnSetLocalFlag(NOT_LABELED);
//}
}
if (!targetPtr){
//rotate turret to be pointing forward again
float maxAz = TURRET_ROTATE_RATE * SimLibMajorFrameTime;
float maxEl = TURRET_ELEVATE_RATE * SimLibMajorFrameTime;
float newEl;
if (isAirDefense){
newEl = 60.0F*DTR;
}
else {
newEl = 0.0F;
}
float delta = newEl - GetDOFValue(AIRDEF_ELEV);
if(delta > 180.0F*DTR){
delta -= 180.0F*DTR;
}
else if(delta < -180.0F*DTR){
delta += 180.0F*DTR;
}
// Do elevation adjustments
if (delta > maxEl){
SetDOFInc(AIRDEF_ELEV, maxEl);
}
else if (delta < -maxEl){
SetDOFInc(AIRDEF_ELEV, -maxEl);
}
else {
SetDOF(AIRDEF_ELEV, newEl);
}
SetDOF(AIRDEF_ELEV, min(85.0F*DTR, max(GetDOFValue(AIRDEF_ELEV), 0.0F)));
SetDOF(AIRDEF_ELEV2, GetDOFValue(AIRDEF_ELEV));
delta = 0.0F - GetDOFValue(AIRDEF_AZIMUTH);
if(delta > 180.0F*DTR){
delta -= 180.0F*DTR;
}
else if(delta < -180.0F*DTR){
delta += 180.0F*DTR;
}
// Now do the azmuth adjustments
if (delta > maxAz){
SetDOFInc(AIRDEF_AZIMUTH, maxAz);
}
else if (delta < -maxAz){
SetDOFInc(AIRDEF_AZIMUTH, -maxAz);
}
// RV - Biker - Don't do this
//else
// SetDOF(AIRDEF_AZIMUTH, 0.0F);
}
// Special shit by ground type
if ( isFootSquad ){
if ( speedScale > 0.0f ){
// Couldn't this be done in the drawable class's update function???
((DrawableGuys*)drawPointer)->SetSquadMoving( TRUE );
}
else {
// Couldn't this be done in the drawable class's update function???
((DrawableGuys*)drawPointer)->SetSquadMoving( FALSE );
}
// If we're less than 80% of the way from "FAR" toward the viewer, just draw one guy
// otherwise, put 5 guys in a squad.
if (gai->distLOD < 0.8f) {
((DrawableGuys*)drawPointer)->SetNumInSquad( 1 );
}
else {
((DrawableGuys*)drawPointer)->SetNumInSquad( 5 );
}
}
// We're not a foot squad, so do the vehicle stuff
else if ( !IsSetLocalFlag( IS_HIDDEN ) && speedScale > 300.0f )
{
// speedScale /= ( 900.0f * KPH_TO_FPS * KPH_TO_FPS); // essentially 1.0F at 30 mph
// JPO - for engine noise
VehicleClassDataType *vc = GetVehicleClassData(Type() - VU_LAST_ENTITY_TYPE);
ShiAssert(FALSE == F4IsBadReadPtr(vc, sizeof *vc));
// (a) Make sound:
// everything sounds like a tank right now
if ( GetCampaignObject()->IsBattalion() ){
//if (vc)
if (vc && vc->EngineSound!=34){ // kludge prevent 34 from playing
SoundPos.Sfx( vc->EngineSound, 0, 1.0, 0); // MLR 5/16/2004 -
}
else{
SoundPos.Sfx( SFX_TANK, 0, 1.0, 0); // MLR 5/16/2004 -
}
// (b) Make dust
// dustTimer += SimLibMajorFrameTime;
// if ( dustTimer > max( 0.2f, 4.5f - speedScale - gai->distLOD * 3.3f ) )
if ( ((rand() & 7) == 7) &&
gSfxCount[ SFX_GROUND_DUSTCLOUD ] < gSfxLODCutoff &&
gTotSfx < gSfxLODTotCutoff
){
// reset the timer
// dustTimer = 0.0f;
pos.x += PRANDFloat() * 5.0f;
pos.y += PRANDFloat() * 5.0f;
pos.z = groundZ;
// RV - Biker - Move that smoke more behind the vehicle
mlTrig trig;
mlSinCos (&trig, Yaw());
pos.x -= 15.0f*trig.cos;
pos.y -= 15.0f*trig.sin;
vec.x = PRANDFloat() * 5.0f;
vec.y = PRANDFloat() * 5.0f;
vec.z = -20.0f;
//JAM 24Oct03 - No dust trails when it's raining.
if(realWeather->weatherCondition < INCLEMENT){
/*
OTWDriver.AddSfxRequest(
new SfxClass (SFX_VEHICLE_DUST, // type //JAM 03Oct03
// new SfxClass (SFX_GROUND_DUSTCLOUD, // type
SFX_USES_GRAVITY | SFX_NO_DOWN_VECTOR | SFX_MOVES | SFX_NO_GROUND_CHECK,
&pos, // world pos
&vec,
1.0f, // time to live
1.f)); //JAM 03Oct03 8.5f )); // scale
*/
DrawableParticleSys::PS_AddParticleEx((SFX_VEHICLE_DUST + 1),
&pos,
&vec);
}
}
// (c) Make sure we're using our 'Moving' model (i.e. Trucked artillery, APC, etc)
if (truckDrawable){
// Keep truck 20 feet behind us (HACK HACK)
Tpoint truckPos;
mlTrig trig;
mlSinCos (&trig, Yaw());
truckPos.x = XPos()-20.0F*trig.cos;
truckPos.y = YPos()-20.0F*trig.sin;
truckPos.z = ZPos();
truckDrawable->Update(&truckPos, Yaw()+PI);
}
if (isTowed || hasCrew){
SetSwitch(0,0x2);
}
}
else // itsa task force
{
if (vc){
SoundPos.Sfx( vc->EngineSound, 0, 1.0, 0);
}
else {
SoundPos.Sfx( SFX_SHIP, 0, 1.0, 0);
}
//RV - I-Hawk - Do wakes only at some cases
if ( (rand() & 7) == 7 )
{
//I-Hawk - not using all this anymore
//
// reset the timer
// dustTimer = 0.0f;
//float ttl;
//static float trailspd = 5.0f;
//static float bowfx = 0.92f;
//static float sternfx = 0.75f;
//float spdratio = GetVt() / ((UnitClass*)GetCampaignObject())->GetMaxSpeed();
float radius;
if ( drawPointer ){
radius = drawPointer->Radius(); // JPO from 0.15 - now done inline
}
else{
radius = 90.0f;
}
//I-Hawk - Fixed position for ships wakes, effect "delay" in position is
//handled by PS now. No more the "V shape" of water wakes.
pos.x = XPos() + XDelta() * SimLibMajorFrameTime;
pos.y = YPos() + YDelta() * SimLibMajorFrameTime;
pos.z = groundZ;
//// JPO - think this is sideways on.
///*
//vec.x = dmx[1][0] * spdratio * PRANDFloat() * trailspd;
//vec.y = dmx[1][1] * spdratio * PRANDFloat() * trailspd;
//vec.z = 0.5f; // from -20 JPO
//*/
//I-Hawk - More correct vector for wakes
vec.x = XDelta();
vec.y = YDelta();
vec.z = 0.0f;
//I-Hawk - Separate wake effect for different ships size
int theSFX;
if ( radius < 200.0f )
{
theSFX = SFX_WATER_WAKE_SMALL;
}
else if ( radius >= 200.0f && radius < 400.0f )
{
theSFX = SFX_WATER_WAKE_MEDIUM;
}
else if ( radius >= 400.0f )
{
theSFX = SFX_WATER_WAKE_LARGE;
}
//I-Hawk - The PS
DrawableParticleSys::PS_AddParticleEx((theSFX + 1),
&pos,
&vec);
}
}
}
// Otherwise, we're not moving or are hidden. Do some stuff
else {
// (b) Make sure we're using our 'Holding' model (i.e. Unlimbered artillery, troops prone, etc)
if (truckDrawable){
// Once we stop, our truck doesn't move at all - but sits further away than when moving
Tpoint truckPos;
truckPos.x = XPos() + 40.0F;
truckPos.y = YPos();
truckPos.z = 0.0F;
truckDrawable->Update(&truckPos, Yaw());
}
if (isTowed || hasCrew){
SetSwitch(0,0x1);
}
}
// ACMI Output
if (gACMIRec.IsRecording() && (SimLibFrameCount & 0x0f ) == 0){
ACMIGenPositionRecord genPos;
genPos.hdr.time = SimLibElapsedTime * MSEC_TO_SEC + OTWDriver.todOffset;
genPos.data.type = Type();
genPos.data.uniqueID = ACMIIDTable->Add(Id(),NULL,TeamInfo[GetTeam()]->GetColor());//.num_;
genPos.data.x = XPos();
genPos.data.y = YPos();
genPos.data.z = ZPos();
genPos.data.roll = Roll();
genPos.data.pitch = Pitch();
genPos.data.yaw = Yaw();
// Remove genPos.data.teamColor = TeamInfo[GetTeam()]->GetColor();
gACMIRec.GenPositionRecord( &genPos );
}
return IsLocal();
}
bool load_paths_from_db(MYSQL *m, Map *map, const char *zone, list<PathGraph*> &db_paths, list<PathNode*> &end_points) {
char query[512];
sprintf(query,
"SELECT x,y,z,gridid FROM grid_entries,zone "
"WHERE zone.zoneidnumber=zoneid AND short_name='%s' "
"ORDER BY gridid,number", zone);
if(mysql_query(m, query) != 0) {
printf("Unable to query: %s\n", mysql_error(m));
return(false);
}
MYSQL_RES *res = mysql_store_result(m);
if(res == NULL) {
printf("Unable to store res: %s\n", mysql_error(m));
return(false);
}
MYSQL_ROW row;
PathNode *cur = NULL, *last = NULL, *first = NULL;
PathGraph *g = NULL;
int cur_g = -1,last_g = -1;
// int lid = 0;
while((row = mysql_fetch_row(res))) {
last = cur;
cur = new PathNode;
// cur->load_id = lid++;
cur->x = atof(row[0]);
cur->y = atof(row[1]);
cur->z = atof(row[2]);
cur_g = atoi(row[3]);
if(cur_g != last_g) {
if(g != NULL) {
//if we have a first and last node for this path
//and they are not the same node, try to connect them.
if(first != NULL && last != NULL && first != last && last->Dist2(first) < ENDPOINT_CONNECT_MAX_DISTANCE*ENDPOINT_CONNECT_MAX_DISTANCE) {
if(CheckLOS(map, last, first))
g->add_edge(last, first);
}
#ifdef LINK_PATH_ENDPOINTS
if(first != last && last != NULL)
end_points.push_back(last);
#endif
db_paths.push_back(g);
}
g = new PathGraph();
first = cur;
last_g = cur_g;
last = NULL;
}
g->nodes.push_back(cur);
#ifdef LINK_PATH_ENDPOINTS
//this is a begining point
if(last == NULL)
end_points.push_back(cur);
#endif
if(last != NULL) {
#ifdef SPLIT_INVALID_PATHS
if(CheckLOS(map, last, cur)) {
g->edges.push_back(new PathEdge(last, cur));
} else {
//no LOS, split the path into two
load_split_paths++;
last_g = -1; //tell this thing to start over
}
#else
g->edges.push_back(new PathEdge(last, cur));
#endif
}
}
//handle the last active path
if(g != NULL) {
if(first != NULL && cur->Dist2(first) < ENDPOINT_CONNECT_MAX_DISTANCE*ENDPOINT_CONNECT_MAX_DISTANCE) {
if(CheckLOS(map, cur, first))
g->add_edge(cur, first);
}
db_paths.push_back(g);
}
mysql_free_result(res);
return(true);
}
void CMutualFOV::CheckWayToCorner(const CPosition &start,const CPosition &end,const int &distance)
{
if (end.x>=0 && end.x<=MAPWIDTH && end.y>=0 && end.y<=MAPHEIGHT)
if (m_map->getCornerState(end.x,end.y)!=CORNER_INVISIBLE_CHECKED)
CheckLOS(start,end,distance);
}
