aboutsummaryrefslogtreecommitdiff
path: root/main/tests/test_misc.cpp
diff options
context:
space:
mode:
Diffstat (limited to 'main/tests/test_misc.cpp')
-rw-r--r--main/tests/test_misc.cpp217
1 files changed, 84 insertions, 133 deletions
diff --git a/main/tests/test_misc.cpp b/main/tests/test_misc.cpp
index 68564c62b..9133f31fa 100644
--- a/main/tests/test_misc.cpp
+++ b/main/tests/test_misc.cpp
@@ -27,16 +27,14 @@
/* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */
/*************************************************************************/
#include "test_misc.h"
-#include "servers/visual_server.h"
-#include "os/main_loop.h"
#include "math_funcs.h"
+#include "os/main_loop.h"
#include "print_string.h"
-
+#include "servers/visual_server.h"
namespace TestMisc {
-struct ConvexTestResult
-{
+struct ConvexTestResult {
Vector3 edgeA[2];
Vector3 edgeB[2];
@@ -65,13 +63,10 @@ struct ConvexTestResult
neSwap(contactA, contactB);
contactNormal *= -1.0f;
}*/
- bool ComputerEdgeContactPoint2(float & au, float & bu);
+ bool ComputerEdgeContactPoint2(float &au, float &bu);
};
-
-
-bool ConvexTestResult::ComputerEdgeContactPoint2(float & au, float & bu)
-{
+bool ConvexTestResult::ComputerEdgeContactPoint2(float &au, float &bu) {
float d1343, d4321, d1321, d4343, d2121;
float numer, denom;
@@ -83,16 +78,14 @@ bool ConvexTestResult::ComputerEdgeContactPoint2(float & au, float & bu)
p13 = (edgeA[0]) - (edgeB[0]);
p43 = (edgeB[1]) - (edgeB[0]);
- if ( p43.length_squared() < CMP_EPSILON2 )
- {
+ if (p43.length_squared() < CMP_EPSILON2) {
valid = false;
goto ComputerEdgeContactPoint2_Exit;
}
p21 = (edgeA[1]) - (edgeA[0]);
- if ( p21.length_squared()<CMP_EPSILON2 )
- {
+ if (p21.length_squared() < CMP_EPSILON2) {
valid = false;
goto ComputerEdgeContactPoint2_Exit;
}
@@ -105,8 +98,7 @@ bool ConvexTestResult::ComputerEdgeContactPoint2(float & au, float & bu)
denom = d2121 * d4343 - d4321 * d4321;
- if (ABS(denom) < CMP_EPSILON)
- {
+ if (ABS(denom) < CMP_EPSILON) {
valid = false;
goto ComputerEdgeContactPoint2_Exit;
@@ -116,16 +108,11 @@ bool ConvexTestResult::ComputerEdgeContactPoint2(float & au, float & bu)
au = numer / denom;
bu = (d1343 + d4321 * (au)) / d4343;
- if (au < 0.0f || au >= 1.0f)
- {
+ if (au < 0.0f || au >= 1.0f) {
valid = false;
- }
- else if (bu < 0.0f || bu >= 1.0f)
- {
+ } else if (bu < 0.0f || bu >= 1.0f) {
valid = false;
- }
- else
- {
+ } else {
valid = true;
}
{
@@ -158,7 +145,6 @@ struct neCollisionResult {
Vector3 contactB;
};
-
struct TConvex {
float radius;
@@ -167,14 +153,13 @@ struct TConvex {
float CylinderHalfHeight() const { return half_height; }
};
-float GetDistanceFromLine2(Vector3 v, Vector3 & project, const Vector3 & pointA, const Vector3 & pointB)
-{
+float GetDistanceFromLine2(Vector3 v, Vector3 &project, const Vector3 &pointA, const Vector3 &pointB) {
Vector3 ba = pointB - pointA;
float len = ba.length();
- if (len<CMP_EPSILON)
- ba=Vector3();
+ if (len < CMP_EPSILON)
+ ba = Vector3();
else
ba *= 1.0f / len;
@@ -189,12 +174,11 @@ float GetDistanceFromLine2(Vector3 v, Vector3 & project, const Vector3 & pointA,
return diff.length();
}
-void TestCylinderVertEdge(neCollisionResult & result, Vector3 & edgeA1, Vector3 & edgeA2, Vector3 & vertB,
- TConvex & cA, TConvex & cB, Transform & transA, Transform & transB, bool flip)
-{
+void TestCylinderVertEdge(neCollisionResult &result, Vector3 &edgeA1, Vector3 &edgeA2, Vector3 &vertB,
+ TConvex &cA, TConvex &cB, Transform &transA, Transform &transB, bool flip) {
Vector3 project;
- float dist = GetDistanceFromLine2(vertB,project, edgeA1, edgeA2);
+ float dist = GetDistanceFromLine2(vertB, project, edgeA1, edgeA2);
float depth = cA.CylinderRadius() + cB.CylinderRadius() - dist;
@@ -208,18 +192,15 @@ void TestCylinderVertEdge(neCollisionResult & result, Vector3 & edgeA1, Vector3
result.depth = depth;
- if (!flip)
- {
- result.collisionFrame.set_axis(2,(project - vertB).normalized());
+ if (!flip) {
+ result.collisionFrame.set_axis(2, (project - vertB).normalized());
result.contactA = project - result.collisionFrame.get_axis(2) * cA.CylinderRadius();
result.contactB = vertB + result.collisionFrame.get_axis(2) * cB.CylinderRadius();
- }
- else
- {
+ } else {
- result.collisionFrame.set_axis(2,(vertB - project).normalized());
+ result.collisionFrame.set_axis(2, (vertB - project).normalized());
result.contactA = vertB - result.collisionFrame.get_axis(2) * cB.CylinderRadius();
@@ -227,9 +208,8 @@ void TestCylinderVertEdge(neCollisionResult & result, Vector3 & edgeA1, Vector3
}
}
-void TestCylinderVertVert(neCollisionResult & result, Vector3 & vertA, Vector3 & vertB,
- TConvex & cA, TConvex & cB, Transform & transA, Transform & transB)
-{
+void TestCylinderVertVert(neCollisionResult &result, Vector3 &vertA, Vector3 &vertB,
+ TConvex &cA, TConvex &cB, Transform &transA, Transform &transB) {
Vector3 diff = vertA - vertB;
float dist = diff.length();
@@ -253,17 +233,16 @@ void TestCylinderVertVert(neCollisionResult & result, Vector3 & vertA, Vector3 &
result.contactB = vertB + result.collisionFrame.get_axis(2) * cB.CylinderRadius();
}
-void Cylinder2CylinderTest(neCollisionResult & result, TConvex & cA, Transform & transA, TConvex & cB, Transform & transB)
-{
+void Cylinder2CylinderTest(neCollisionResult &result, TConvex &cA, Transform &transA, TConvex &cB, Transform &transB) {
result.penetrate = false;
Vector3 dir = transA.basis.get_axis(1).cross(transB.basis.get_axis(1));
float len = dir.length();
-// bool isParallel = len<CMP_EPSILON;
+ // bool isParallel = len<CMP_EPSILON;
-// int doVertCheck = 0;
+ // int doVertCheck = 0;
ConvexTestResult cr;
@@ -272,16 +251,14 @@ void Cylinder2CylinderTest(neCollisionResult & result, TConvex & cA, Transform &
cr.edgeB[0] = transB.origin + transB.basis.get_axis(1) * cB.CylinderHalfHeight();
cr.edgeB[1] = transB.origin - transB.basis.get_axis(1) * cB.CylinderHalfHeight();
-// float dot = transA.basis.get_axis(1).dot(transB.basis.get_axis(1));
+ // float dot = transA.basis.get_axis(1).dot(transB.basis.get_axis(1));
- if (len>CMP_EPSILON)
- {
+ if (len > CMP_EPSILON) {
float au, bu;
cr.ComputerEdgeContactPoint2(au, bu);
- if (cr.valid)
- {
+ if (cr.valid) {
float depth = cA.CylinderRadius() + cB.CylinderRadius() - cr.depth;
if (depth <= 0.0f)
@@ -291,7 +268,7 @@ void Cylinder2CylinderTest(neCollisionResult & result, TConvex & cA, Transform &
result.penetrate = true;
- result.collisionFrame.set_axis(2, (cr.contactA - cr.contactB)*(1.0f / cr.depth));
+ result.collisionFrame.set_axis(2, (cr.contactA - cr.contactB) * (1.0f / cr.depth));
result.contactA = cr.contactA - result.collisionFrame.get_axis(2) * cA.CylinderRadius();
@@ -304,51 +281,38 @@ void Cylinder2CylinderTest(neCollisionResult & result, TConvex & cA, Transform &
int i;
- for (i = 0; i < 2; i++)
- {
+ for (i = 0; i < 2; i++) {
//project onto edge b
Vector3 diff = cr.edgeA[i] - cr.edgeB[1];
float dot = diff.dot(transB.basis.get_axis(1));
- if (dot < 0.0f)
- {
+ if (dot < 0.0f) {
TestCylinderVertVert(result, cr.edgeA[i], cr.edgeB[1], cA, cB, transA, transB);
- }
- else if (dot > (2.0f * cB.CylinderHalfHeight()))
- {
+ } else if (dot > (2.0f * cB.CylinderHalfHeight())) {
TestCylinderVertVert(result, cr.edgeA[i], cr.edgeB[0], cA, cB, transA, transB);
- }
- else
- {
+ } else {
TestCylinderVertEdge(result, cr.edgeB[0], cr.edgeB[1], cr.edgeA[i], cB, cA, transB, transA, true);
}
}
- for (i = 0; i < 2; i++)
- {
+ for (i = 0; i < 2; i++) {
//project onto edge b
Vector3 diff = cr.edgeB[i] - cr.edgeA[1];
float dot = diff.dot(transA.basis.get_axis(1));
- if (dot < 0.0f)
- {
+ if (dot < 0.0f) {
TestCylinderVertVert(result, cr.edgeB[i], cr.edgeA[1], cA, cB, transA, transB);
- }
- else if (dot > (2.0f * cB.CylinderHalfHeight()))
- {
+ } else if (dot > (2.0f * cB.CylinderHalfHeight())) {
TestCylinderVertVert(result, cr.edgeB[i], cr.edgeA[0], cA, cB, transA, transB);
- }
- else
- {
+ } else {
TestCylinderVertEdge(result, cr.edgeA[0], cr.edgeA[1], cr.edgeB[i], cA, cB, transA, transB, false);
}
}
}
-
class TestMainLoop : public MainLoop {
RID meshA;
@@ -365,61 +329,61 @@ class TestMainLoop : public MainLoop {
Transform rot_b;
bool quit;
+
public:
- virtual void input_event(const InputEvent& p_event) {
+ virtual void input_event(const InputEvent &p_event) {
- if (p_event.type==InputEvent::MOUSE_MOTION && p_event.mouse_motion.button_mask&BUTTON_MASK_LEFT) {
+ if (p_event.type == InputEvent::MOUSE_MOTION && p_event.mouse_motion.button_mask & BUTTON_MASK_LEFT) {
- rot_b.origin.y+=-p_event.mouse_motion.relative_y/100.0;
- rot_b.origin.x+=p_event.mouse_motion.relative_x/100.0;
+ rot_b.origin.y += -p_event.mouse_motion.relative_y / 100.0;
+ rot_b.origin.x += p_event.mouse_motion.relative_x / 100.0;
}
- if (p_event.type==InputEvent::MOUSE_MOTION && p_event.mouse_motion.button_mask&BUTTON_MASK_MIDDLE) {
+ if (p_event.type == InputEvent::MOUSE_MOTION && p_event.mouse_motion.button_mask & BUTTON_MASK_MIDDLE) {
//rot_b.origin.x+=-p_event.mouse_motion.relative_y/100.0;
- rot_b.origin.z+=p_event.mouse_motion.relative_x/100.0;
+ rot_b.origin.z += p_event.mouse_motion.relative_x / 100.0;
}
- if (p_event.type==InputEvent::MOUSE_MOTION && p_event.mouse_motion.button_mask&BUTTON_MASK_RIGHT) {
+ if (p_event.type == InputEvent::MOUSE_MOTION && p_event.mouse_motion.button_mask & BUTTON_MASK_RIGHT) {
- float rot_x=-p_event.mouse_motion.relative_y/100.0;
- float rot_y=p_event.mouse_motion.relative_x/100.0;
- rot_b.basis = rot_b.basis * Matrix3(Vector3(1,0,0),rot_x) * Matrix3(Vector3(0,1,0),rot_y);
+ float rot_x = -p_event.mouse_motion.relative_y / 100.0;
+ float rot_y = p_event.mouse_motion.relative_x / 100.0;
+ rot_b.basis = rot_b.basis * Matrix3(Vector3(1, 0, 0), rot_x) * Matrix3(Vector3(0, 1, 0), rot_y);
}
-
}
virtual void request_quit() {
- quit=true;
+ quit = true;
}
virtual void init() {
- VisualServer *vs=VisualServer::get_singleton();
+ VisualServer *vs = VisualServer::get_singleton();
camera = vs->camera_create();
viewport = vs->viewport_create();
vs->viewport_attach_to_screen(viewport);
- vs->viewport_attach_camera( viewport, camera );
- vs->camera_set_transform(camera, Transform( Matrix3(), Vector3(0,0,3 ) ) );
+ vs->viewport_attach_camera(viewport, camera);
+ vs->camera_set_transform(camera, Transform(Matrix3(), Vector3(0, 0, 3)));
/* CONVEX SHAPE */
- DVector<Plane> cylinder_planes = Geometry::build_cylinder_planes(0.5,2,9,Vector3::AXIS_Y);
+ DVector<Plane> cylinder_planes = Geometry::build_cylinder_planes(0.5, 2, 9, Vector3::AXIS_Y);
RID cylinder_material = vs->fixed_material_create();
- vs->fixed_material_set_param( cylinder_material, VisualServer::FIXED_MATERIAL_PARAM_DIFFUSE, Color(0.8,0.2,0.9));
- vs->material_set_flag( cylinder_material, VisualServer::MATERIAL_FLAG_ONTOP,true);
+ vs->fixed_material_set_param(cylinder_material, VisualServer::FIXED_MATERIAL_PARAM_DIFFUSE, Color(0.8, 0.2, 0.9));
+ vs->material_set_flag(cylinder_material, VisualServer::MATERIAL_FLAG_ONTOP, true);
//vs->material_set_flag( cylinder_material, VisualServer::MATERIAL_FLAG_WIREFRAME,true);
- vs->material_set_flag( cylinder_material, VisualServer::MATERIAL_FLAG_DOUBLE_SIDED,true);
- vs->material_set_flag( cylinder_material, VisualServer::MATERIAL_FLAG_UNSHADED,true);
+ vs->material_set_flag(cylinder_material, VisualServer::MATERIAL_FLAG_DOUBLE_SIDED, true);
+ vs->material_set_flag(cylinder_material, VisualServer::MATERIAL_FLAG_UNSHADED, true);
RID cylinder_mesh = vs->mesh_create();
Geometry::MeshData cylinder_data = Geometry::build_convex_mesh(cylinder_planes);
- vs->mesh_add_surface_from_mesh_data(cylinder_mesh,cylinder_data);
- vs->mesh_surface_set_material( cylinder_mesh, 0, cylinder_material );
+ vs->mesh_add_surface_from_mesh_data(cylinder_mesh, cylinder_data);
+ vs->mesh_surface_set_material(cylinder_mesh, 0, cylinder_material);
- meshA=vs->instance_create2(cylinder_mesh,scenario);
- meshB=vs->instance_create2(cylinder_mesh,scenario);
- boxA=vs->instance_create2(vs->get_test_cube(),scenario);
- boxB=vs->instance_create2(vs->get_test_cube(),scenario);
+ meshA = vs->instance_create2(cylinder_mesh, scenario);
+ meshB = vs->instance_create2(cylinder_mesh, scenario);
+ boxA = vs->instance_create2(vs->get_test_cube(), scenario);
+ boxB = vs->instance_create2(vs->get_test_cube(), scenario);
/*
RID lightaux = vs->light_create( VisualServer::LIGHT_OMNI );
@@ -428,72 +392,59 @@ public:
vs->light_set_var( lightaux, VisualServer::LIGHT_VAR_ENERGY, 1.5 );
light = vs->instance_create2( lightaux );
*/
- RID lightaux = vs->light_create( VisualServer::LIGHT_DIRECTIONAL );
+ RID lightaux = vs->light_create(VisualServer::LIGHT_DIRECTIONAL);
//vs->light_set_color( lightaux, VisualServer::LIGHT_COLOR_AMBIENT, Color(0.0,0.0,0.0) );
//vs->light_set_shadow( lightaux, true );
- RID light = vs->instance_create2( lightaux,scenario );
+ RID light = vs->instance_create2(lightaux, scenario);
//rot_a=Transform(Matrix3(Vector3(1,0,0),Math_PI/2.0),Vector3());
- rot_b=Transform(Matrix3(),Vector3(2,0,0));
+ rot_b = Transform(Matrix3(), Vector3(2, 0, 0));
//rot_x=0;
//rot_y=0;
- quit=false;
+ quit = false;
}
virtual bool idle(float p_time) {
- VisualServer *vs=VisualServer::get_singleton();
-
- vs->instance_set_transform(meshA,rot_a);
- vs->instance_set_transform(meshB,rot_b);
+ VisualServer *vs = VisualServer::get_singleton();
+ vs->instance_set_transform(meshA, rot_a);
+ vs->instance_set_transform(meshB, rot_b);
neCollisionResult res;
TConvex a;
- a.radius=0.5;
- a.half_height=1;
- Cylinder2CylinderTest(res,a,rot_a,a,rot_b);
+ a.radius = 0.5;
+ a.half_height = 1;
+ Cylinder2CylinderTest(res, a, rot_a, a, rot_b);
if (res.penetrate) {
Matrix3 scale;
- scale.scale(Vector3(0.1,0.1,0.1));
- vs->instance_set_transform(boxA,Transform(scale,res.contactA));
- vs->instance_set_transform(boxB,Transform(scale,res.contactB));
- print_line("depth: "+rtos(res.depth));
- } else {
+ scale.scale(Vector3(0.1, 0.1, 0.1));
+ vs->instance_set_transform(boxA, Transform(scale, res.contactA));
+ vs->instance_set_transform(boxB, Transform(scale, res.contactB));
+ print_line("depth: " + rtos(res.depth));
+ } else {
Matrix3 scale;
scale.scale(Vector3());
- vs->instance_set_transform(boxA,Transform(scale,res.contactA));
- vs->instance_set_transform(boxB,Transform(scale,res.contactB));
-
+ vs->instance_set_transform(boxA, Transform(scale, res.contactA));
+ vs->instance_set_transform(boxB, Transform(scale, res.contactB));
}
- print_line("collided: "+itos(res.penetrate));
+ print_line("collided: " + itos(res.penetrate));
return false;
}
-
virtual bool iteration(float p_time) {
-
-
return quit;
}
virtual void finish() {
-
}
-
};
+MainLoop *test() {
-MainLoop* test() {
-
- return memnew( TestMainLoop );
-
+ return memnew(TestMainLoop);
}
-
}
-
-
-
generated by cgit v1.2.3-70-g09d2 (git 2.52.0) at 2026-01-05 09:27:23 +0000