deargui-vpl/ref/virtools/Samples/Behaviors/Collision/behaviors src/BoundingSphereIntersection.cpp

127 lines
3.8 KiB
C++

/////////////////////////////////////////////////////
/////////////////////////////////////////////////////
//
// Bounding Sphere Intersection
//
/////////////////////////////////////////////////////
/////////////////////////////////////////////////////
#include "CKAll.h"
CKObjectDeclaration *FillBehaviorBoundingSphereIntersectionDecl();
CKERROR CreateBoundingSphereIntersectionProto(CKBehaviorPrototype **);
int BoundingSphereIntersection(const CKBehaviorContext& behcontext);
CKObjectDeclaration *FillBehaviorBoundingSphereIntersectionDecl()
{
CKObjectDeclaration *od = CreateCKObjectDeclaration("Sphere Sphere Intersection");
od->SetDescription("Detects the collision between two 3D entities at the bounding sphere level.");
/* rem:
<SPAN CLASS=in>In: </SPAN>triggers the process.<BR>
<BR>
<SPAN CLASS=out>True: </SPAN>is activated if the 2 entities are in intersection.<BR>
<SPAN CLASS=out>False: </SPAN>is activated if the 2 entities are not in intersection.<BR>
<BR>
<SPAN CLASS=pin>Entity 0: </SPAN>first entity to be tested.<BR>
<SPAN CLASS=pin>Entity 1: </SPAN>second entity to be tested.<BR>
<SPAN CLASS=pin>Hierarchy 0: </SPAN>specify whether to concider the bounding sphere of the first entity and its children, or just the bounding sphere of the first entity.<BR>
<SPAN CLASS=pin>Hierarchy 1: </SPAN>specify whether to concider the bounding sphere of the second entity and its children, or just the bounding sphere of the second entity.<BR>
<BR>
This building block detects the collision between two entity's bounding spheres.<BR>
*/
od->SetCategory("Collisions/Intersection");
od->SetType( CKDLL_BEHAVIORPROTOTYPE);
od->SetGuid(CKGUID(0x198531f9,0x60f66c57));
od->SetAuthorGuid(VIRTOOLS_GUID);
od->SetAuthorName("Virtools");
od->SetVersion(0x00010000);
od->SetCreationFunction(CreateBoundingSphereIntersectionProto);
od->SetCompatibleClassId(CKCID_BEOBJECT);
return od;
}
CKERROR CreateBoundingSphereIntersectionProto(CKBehaviorPrototype **pproto)
{
CKBehaviorPrototype *proto = CreateCKBehaviorPrototype("Sphere Sphere Intersection");
if(!proto) return CKERR_OUTOFMEMORY;
proto->DeclareInput("In");
proto->DeclareOutput("True");
proto->DeclareOutput("False");
proto->DeclareInParameter("Entity 0",CKPGUID_3DENTITY);
proto->DeclareInParameter("Entity 1",CKPGUID_3DENTITY);
proto->DeclareInParameter("Hierarchy 0",CKPGUID_BOOL,"FALSE");
proto->DeclareInParameter("Hierarchy 1",CKPGUID_BOOL,"FALSE");
proto->SetFlags(CK_BEHAVIORPROTOTYPE_NORMAL);
proto->SetFunction(BoundingSphereIntersection);
*pproto = proto;
return CK_OK;
}
int BoundingSphereIntersection(const CKBehaviorContext& behcontext)
{
CKBehavior* beh = behcontext.Behavior;
// Set Input state
beh->ActivateInput(0,FALSE);
CK3dEntity* ent1 = (CK3dEntity*)beh->GetInputParameterObject(0);
CK3dEntity* ent2 = (CK3dEntity*)beh->GetInputParameterObject(1);
if(!ent1 || !ent2) {
beh->ActivateOutput(1);
return CKBR_OK;
}
BOOL eh1 = FALSE;
beh->GetInputParameterValue(2,&eh1);
BOOL eh2 = FALSE;
beh->GetInputParameterValue(3,&eh2);
float radius1 = 0.0f;
float radius2 = 0.0f;
VxVector pos1;
VxVector pos2;
VxBbox box;
if(eh1) {
box = ent1->GetHierarchicalBox();
radius1 = 0.5f * Magnitude(box.Max - box.Min);
pos1 = (box.Max+box.Min)*0.5f;
} else {
//box = ent1->GetBoundingBox();
radius1 = ent1->GetRadius();
ent1->GetBaryCenter(&pos1);
}
if(eh2) {
box = ent2->GetHierarchicalBox();
radius2 = 0.5f * Magnitude(box.Max - box.Min);
pos2 = (box.Max+box.Min)*0.5f;
} else {
//box = ent2->GetBoundingBox();
radius2 = ent2->GetRadius();
ent2->GetBaryCenter(&pos2);
}
float dist = SquareMagnitude(pos2-pos1);
float radSum = radius1+radius2;
radSum *= radSum;
if ( radSum < dist ) {
beh->ActivateOutput(1);
} else {
beh->ActivateOutput(0);
}
return CKBR_OK;
}