void EVA2BS::ToggleGrapple2(void)
{
//sprintf(oapiDebugString(), "scn_att_pos %0.4f %0.4f %0.4f", scn_att_pos.x, scn_att_pos.y, scn_att_pos.z);
HWND hDlg;
OBJHANDLE hV = GetAttachmentStatus(RHAND);
if (hV) { // release satellite
ATTACHMENTHANDLE hAtt = Can2Arrest();
DetachChild(RHAND);
if (hDlg = oapiFindDialog(g_Param.hDLL, IDD_RMS)) {
SetWindowText(GetDlgItem(hDlg, IDC_GRAPPLE1), "Grapple");
//EnableWindow(GetDlgItem(hDlg, IDC_STOW), TRUE);
}
#ifdef UNDEF
VECTOR3 pos, dir, rot, gbay, gpos;
GetAttachmentParams(sat_attach, pos, dir, rot);
Local2Global(pos, gbay);
VESSEL *v = oapiGetVesselInterface(hV);
DWORD nAttach = v->AttachmentCount(true);
for (DWORD j = 0; j < nAttach; j++) { // now scan all attachment points
ATTACHMENTHANDLE hAtt = v->GetAttachmentHandle(true, j);
v->GetAttachmentParams(hAtt, pos, dir, rot);
v->Local2Global(pos, gpos);
if (dist(gpos, gbay) < MAX_GRAPPLING_DIST) {
AttachChild(hV, sat_attach, hAtt);
return;
}
}
#endif
}
else { // grapple satellite
VECTOR3 gpos, grms, pos, dir, rot;
Local2Global(arm_tip1[0], grms); // global position of RMS tip
// 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 == GetHandle()) continue; // we don't want to grapple ourselves ...
oapiGetGlobalPos(hV, &gpos);
if (dist(gpos, grms) < 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, "HD", 2)) continue; // attachment point not compatible
v->GetAttachmentParams(hAtt, pos, dir, rot);
v->Local2Global(pos, gpos);
sprintf(oapiDebugString(), "scn_att_pos %0.4f", dist(gpos, grms));
if (dist(gpos, grms) < MAX_GRAPPLING_DIST) { // found one!
// check whether satellite is currently clamped into payload bay
//if (hV == GetAttachmentStatus(sat_attach))
// DetachChild(sat_attach);
sprintf(oapiDebugString(), "attach %0.4f", dist(gpos, grms));
AttachChild(hV, RHAND, hAtt);
if (hDlg = oapiFindDialog(g_Param.hDLL, IDD_RMS)) {
SetWindowText(GetDlgItem(hDlg, IDC_GRAPPLE1), "Release");
//EnableWindow(GetDlgItem(hDlg, IDC_STOW), FALSE);
}
return;
}
}
}
}
}
}
// check whether the currently grappled object can be stowed in the cargo bay
ATTACHMENTHANDLE EVA2BS::Can2Arrest(void) const
{
OBJHANDLE hV = GetAttachmentStatus(RHAND);
if (!hV) return 0;
VESSEL *v = oapiGetVesselInterface(hV);
DWORD nAttach = v->AttachmentCount(true);
VECTOR3 pos, dir, rot, gpos, gbay;
GetAttachmentParams(RHAND, pos, dir, rot);
Local2Global(pos, gbay);
for (DWORD j = 0; j < nAttach; j++) {
ATTACHMENTHANDLE hAtt = v->GetAttachmentHandle(true, j);
if (strncmp(v->GetAttachmentId(hAtt), "HD", 2)) continue; // attachment point not compatible
v->GetAttachmentParams(hAtt, pos, dir, rot);
v->Local2Global(pos, gpos);
if (dist(gpos, gbay) < MAX_GRAPPLING_DIST) {
return hAtt;
}
}
return 0;
}
