OBJHANDLE VOBJ::prevTarget()
{
/*if (iTarget-1 < 0)
iTarget=oapiGetVesselCount()-1;
else
iTarget--;*/
OBJHANDLE hVes = NULL;
OBJHANDLE hTarget = oapiGetVesselByIndex(iTarget);
for (int i = iTarget; i > 0; i--)
{
hVes = oapiGetVesselByIndex(i);
if (hTarget==hVes)
continue;
if (VESSEL(hVes).GetPropellantCount() < 1)
continue;
iTarget=i;
return hVes;
}
for (int i = oapiGetVesselCount()-1; i > iTarget; i--)
{
hVes = oapiGetVesselByIndex(i);
if (hTarget==hVes)
continue;
if (VESSEL(hVes).GetPropellantCount() < 1)
continue;
iTarget=i;
return hVes;
}
iTarget=0;
return oapiGetVesselByIndex(iTarget);
}
OBJHANDLE VOBJ::nextTarget()
{
/*if (iTarget+1 < oapiGetVesselCount())
iTarget++;
else
iTarget=0;*/
OBJHANDLE hVes=NULL;
OBJHANDLE hTarget=oapiGetVesselByIndex(iTarget);
for (int i = iTarget; i < oapiGetVesselCount(); i++)
{
hVes = oapiGetVesselByIndex(i);
if (hTarget==hVes)
continue;
if (VESSEL(hVes).GetPropellantCount() < 1)
continue;
iTarget=i;
return hVes;
}
for (int i = 0; i < iTarget; i++)
{
hVes = oapiGetVesselByIndex(i);
if (hTarget==hVes)
continue;
if (VESSEL(hVes).GetPropellantCount() < 1)
continue;
iTarget=i;
return hVes;
}
iTarget=0;
return oapiGetVesselByIndex(iTarget);
}
int VOBJ::GetIndexByHandle(OBJHANDLE h)
{
if (!oapiIsVessel(h))
return 0;
for (int i = 0; i < oapiGetVesselCount(); i++)
{
if (h == oapiGetVesselByIndex(i))
return i;
}
return 0;
}
void RMANAGER::TimeStep()
{
VESSEL * v = NULL;
OBJHANDLE hVes = NULL;
char ini[255];
for (int i = 0; i < oapiGetVesselCount(); i++)
{
hVes = oapiGetVesselByIndex(i);
if (!oapiIsVessel(hVes))
continue;
v = oapiGetVesselInterface(hVes);
if (isAttended(v))
continue;
if (!hasConfig(v))
continue;
sprintf(ini,"./Config/orbReentryStream/%s.ini",INI(v));
atList.push_back(ReadAndAssign(ini,v));
}
VOBJ * vbj = NULL;
for (int i = 0; i < atList.size(); i++)
{
if (!atList[i])
continue;
if (!oapiIsVessel(atList[i]->hook))
continue;
vbj = atList[i];
v = oapiGetVesselInterface(vbj->hook);
hVes = v->GetHandle();
if (calcFlux(v) > vbj->flux)
{
if (!vbj->th)
CreateResourceAndStreams(vbj);
v->SetThrusterLevel(vbj->th,1);
}else if (vbj->th)
v->SetThrusterLevel(vbj->th,0);
}
}
void DockingProbe::TimeStep(double simt, double simdt)
{
if (!FirstTimeStepDone) {
DoFirstTimeStep();
FirstTimeStepDone = true;
return;
}
if (UndockNextTimestep) {
UpdatePort(Dockparam[1] * 0.5, simdt);
OurVessel->Undock(ourPort);
UndockNextTimestep = false;
}
if (ExtendingRetracting > 0) {
if (Status >= DOCKINGPROBE_STATUS_EXTENDED) {
Status = DOCKINGPROBE_STATUS_EXTENDED;
ExtendingRetracting = 0;
Dockproc = DOCKINGPROBE_PROC_UNDOCKED;
OurVessel->Undocking(ourPort);
OurVessel->SetDockingProbeMesh();
} else {
Status += 0.33 * simdt;
}
} else if (ExtendingRetracting < 0) {
if (Status <= DOCKINGPROBE_STATUS_RETRACTED) {
Status = DOCKINGPROBE_STATUS_RETRACTED;
ExtendingRetracting = 0;
OurVessel->HaveHardDocked(ourPort);
OurVessel->SetDockingProbeMesh();
} else {
Status -= 0.33 * simdt;
}
}
if (Dockproc == DOCKINGPROBE_PROC_SOFTDOCKED) {
UpdatePort(Dockparam[1] * 0.5, simdt);
Dockproc = DOCKINGPROBE_PROC_HARDDOCKED;
} else if (Dockproc == DOCKINGPROBE_PROC_HARDDOCKED) {
if (Status > DOCKINGPROBE_STATUS_RETRACTED) {
UpdatePort(Dockparam[1] * 0.5 * Status / 0.9, simdt);
} else {
UpdatePort(_V(0,0,0), simdt);
Dockproc = DOCKINGPROBE_PROC_UNDOCKED;
}
}
// sprintf(oapiDebugString(), "Docked %d Status %.3f Dockproc %d ExtendingRetracting %d", (Docked ? 1 : 0), Status, Dockproc, ExtendingRetracting);
// Switching logic
if (OurVessel->DockingProbeExtdRelSwitch.IsUp() && IsPowered()) {
Extend();
} else if (OurVessel->DockingProbeExtdRelSwitch.IsDown()) {
if ((!OurVessel->DockingProbeRetractPrimSwitch.IsCenter() && OurVessel->DockProbeMnACircuitBraker.IsPowered() && OurVessel->PyroBusA.Voltage() > SP_MIN_DCVOLTAGE) ||
(!OurVessel->DockingProbeRetractSecSwitch.IsCenter() && OurVessel->DockProbeMnBCircuitBraker.IsPowered() && OurVessel->PyroBusB.Voltage() > SP_MIN_DCVOLTAGE)) {
int ActiveCharges = 0;
if (OurVessel->DockingProbeRetractPrimSwitch.IsUp()) ActiveCharges = ActiveCharges | DOCKINGPROBE_CHARGE_PRIM1;
if (OurVessel->DockingProbeRetractPrimSwitch.IsDown()) ActiveCharges = ActiveCharges | DOCKINGPROBE_CHARGE_PRIM2;
if (OurVessel->DockingProbeRetractSecSwitch.IsUp()) ActiveCharges = ActiveCharges | DOCKINGPROBE_CHARGE_SEC1;
if (OurVessel->DockingProbeRetractSecSwitch.IsDown()) ActiveCharges = ActiveCharges | DOCKINGPROBE_CHARGE_SEC2;
if ((ActiveCharges & RetractChargesUsed)!= ActiveCharges) Retract();
RetractChargesUsed = RetractChargesUsed | ActiveCharges;
// sprintf(oapiDebugString(), "Charge Used: P1%d P2%d S1%d S2%d", RetractChargesUsed & DOCKINGPROBE_CHARGE_PRIM1 , RetractChargesUsed & DOCKINGPROBE_CHARGE_PRIM2 , RetractChargesUsed & DOCKINGPROBE_CHARGE_SEC1 , RetractChargesUsed & DOCKINGPROBE_CHARGE_SEC2);
}
}
///
/// Begin Advanced Docking Code
///
if (DockingMethod > ADVANCED){
// Code that follows is largely lifted from Atlantis...
// Goal is to handle close proximity docking between a probe and drogue
VECTOR3 gdrgPos, gdrgDir, gprbPos, gprbDir, gvslPos, rvel, pos, dir, rot;
OurVessel->Local2Global (Dockparam[0],gprbPos); //converts probe location to global
OurVessel->GlobalRot (Dockparam[1],gprbDir); //rotates probe direction to global
// Search the complete vessel list for a grappling candidate.
// Not very scalable ...
for (DWORD i = 0; i < oapiGetVesselCount(); i++) {
OBJHANDLE hV = oapiGetVesselByIndex (i);
if (hV == OurVessel->GetHandle()) continue; // we don't want to grapple ourselves ...
oapiGetGlobalPos (hV, &gvslPos);
if (dist (gvslPos, gprbPos) < oapiGetSize (hV)) { // in range
VESSEL *v = oapiGetVesselInterface (hV);
DWORD nAttach = v->AttachmentCount (true);
for (DWORD j = 0; j < nAttach; j++) { // now scan all attachment points of the candidate
ATTACHMENTHANDLE hAtt = v->GetAttachmentHandle (true, j);
const char *id = v->GetAttachmentId (hAtt);
if (strncmp (id, "PADROGUE", 8)) continue; // attachment point not compatible
v->GetAttachmentParams (hAtt, pos, dir, rot);
v->Local2Global (pos, gdrgPos); // converts found drogue position to global
v->GlobalRot (dir, gdrgDir); // rotates found drogue direction to global
if (dist (gdrgPos, gprbPos) < COLLISION_DETECT_RANGE && DockingMethod == ADVANCEDPHYSICS) { // found one less than a meter away!
// Detect if collision has happend, if so, t will return intersection point along the probe line X(t) = gprbPos + t * gprbDir
double t = CollisionDetection(gprbPos, gprbDir, gdrgPos, gdrgDir);
// Calculate time of penetration according to current velocity
OurVessel->GetRelativeVel(hV, rvel);
// Determine resultant force
//APPLY rforce to DockingProbe Vessel, and APPLY -rforce to Drogue Vessel
return;
}
if (dist(gdrgPos, gprbPos) < CAPTURE_DETECT_RANGE && DockingMethod > ADVANCED) {
// If we're within capture range, set docking port to attachment so docking can take place
// Originally, I would have used the Attachment features to soft dock and move the LM during retract
// but Artlav's docking method does this better and uses the docking port itself.
// Attachment is being used as a placeholder for the docking port and to identify its orientation.
OurVessel->GetAttachmentParams(hattPROBE, pos, dir, rot);
DOCKHANDLE dock = OurVessel->GetDockHandle(ourPort);
OurVessel->SetDockParams(dock, pos, dir, rot);
}
}//for nAttach
}//if inRange
}//for nVessel
}
}
void EVA::clbkPreStep (double simt, double SimDT, double mjd)
{
char EVAName[256]="";
char CSMName[256]="";
char MSName[256]="";
strcpy(EVAName,GetName());
double VessCount;
int i=0;
VessCount=oapiGetVesselCount();
hMaster=oapiGetVesselByIndex(i);
while (i<VessCount)i++;{
oapiGetObjectName(hMaster,MSName,256);
strcpy(CSMName,MSName);strcat(CSMName,"-EVA");
if (strcmp(CSMName,EVAName)==0)
{
i=int(VessCount);
}
}
sprintf(oapiDebugString(), "EVA Cable Attached to %s", MSName);
VESSELSTATUS csmV;
VESSELSTATUS evaV;
VESSEL *csmvessel;
VECTOR3 rdist = {0,0,0};
VECTOR3 posr = {0,0,0};
VECTOR3 rvel = {0,0,0};
VECTOR3 RelRot = {0,0,0};
double dist = 0.0;
double Vel = 0.0;
if (hMaster)
{
csmvessel = oapiGetVesselInterface(hMaster);
oapiGetRelativePos (GetHandle() ,hMaster, &posr);
oapiGetRelativeVel (GetHandle() ,hMaster , &rvel);
GetStatus(evaV);
csmvessel->GetStatus(csmV);
GlobalRot (posr, RelRot);
dist = sqrt(posr.x * posr.x + posr.y * posr.y + posr.z * posr.z);
Vel = sqrt(rvel.x * rvel.x + rvel.y * rvel.y + rvel.z * rvel.z);
if (dist >= 25)
{
rvel = evaV.rvel-csmV.rvel;
rvel.x = -rvel.x;
rvel.y = -rvel.y;
rvel.z = -rvel.z;
GetStatus(evaV);
csmvessel->GetStatus(csmV);
evaV.rvel = csmV.rvel + rvel;
DefSetState(&evaV);
}
if (GoDock1){
sprintf(oapiDebugString(), "EVA Back CSM Mode Relative Distance M/s %f", dist);
if (dist <= 0.55 && dist>=0.50 ){
GoDock1 =false;
oapiSetFocusObject(hMaster);
oapiDeleteVessel(GetHandle());
}
}
}
}
