fix a lot of issues, add gyroscopic force integrator, add contact polygon winding, add some quaternion constraints, add more tests
This commit is contained in:
Irlan
337
examples/testbed/tests/tumbler.h
Normal file
337
examples/testbed/tests/tumbler.h
Normal file
@ -0,0 +1,337 @@
|
||||
/*
|
||||
* Copyright (c) 2016-2016 Irlan Robson http://www.irlan.net
|
||||
*
|
||||
* This software is provided 'as-is', without any express or implied
|
||||
* warranty. In no event will the authors be held liable for any damages
|
||||
* arising from the use of this software.
|
||||
* Permission is granted to anyone to use this software for any purpose,
|
||||
* including commercial applications, and to alter it and redistribute it
|
||||
* freely, subject to the following restrictions:
|
||||
* 1. The origin of this software must not be misrepresented; you must not
|
||||
* claim that you wrote the original software. If you use this software
|
||||
* in a product, an acknowledgment in the product documentation would be
|
||||
* appreciated but is not required.
|
||||
* 2. Altered source versions must be plainly marked as such, and must not be
|
||||
* misrepresented as being the original software.
|
||||
* 3. This notice may not be removed or altered from any source distribution.
|
||||
*/
|
||||
|
||||
#ifndef TUMBLER_TEST_H
|
||||
#define TUMBLER_TEST_H
|
||||
|
||||
#include <testbed/tests/quickhull_test.h>
|
||||
|
||||
extern DebugDraw* g_debugDraw;
|
||||
extern Camera g_camera;
|
||||
extern Settings g_settings;
|
||||
|
||||
class Tumbler : public Test
|
||||
{
|
||||
public:
|
||||
enum
|
||||
{
|
||||
e_count = 100
|
||||
};
|
||||
|
||||
Tumbler()
|
||||
{
|
||||
g_camera.m_center.Set(0.0f, 10.0f, 0.0f);
|
||||
g_camera.m_q.SetIdentity();
|
||||
g_camera.m_zoom = 150.0f;
|
||||
|
||||
{
|
||||
b3BodyDef bd;
|
||||
b3Body* ground = m_world.CreateBody(bd);
|
||||
|
||||
bd.type = e_dynamicBody;
|
||||
b3Body* rotor = m_world.CreateBody(bd);
|
||||
|
||||
{
|
||||
static b3BoxHull box;
|
||||
|
||||
b3Transform m;
|
||||
m.position.Set(0.0f, -45.0f, 0.0f);
|
||||
m.rotation = b3Diagonal(50.0f, 1.0f, 200.0f);
|
||||
|
||||
box.SetTransform(m);
|
||||
|
||||
b3HullShape hs;
|
||||
hs.m_hull = &box;
|
||||
|
||||
b3ShapeDef sd;
|
||||
sd.density = 5.0f;
|
||||
sd.shape = &hs;
|
||||
|
||||
rotor->CreateShape(sd);
|
||||
}
|
||||
|
||||
{
|
||||
static b3BoxHull box;
|
||||
|
||||
b3Transform m;
|
||||
m.position.Set(0.0f, 50.0f, 0.0f);
|
||||
m.rotation = b3Diagonal(50.0f, 1.0f, 200.0f);
|
||||
|
||||
box.SetTransform(m);
|
||||
|
||||
b3HullShape hs;
|
||||
hs.m_hull = &box;
|
||||
|
||||
b3ShapeDef sd;
|
||||
sd.density = 5.0f;
|
||||
sd.shape = &hs;
|
||||
|
||||
rotor->CreateShape(sd);
|
||||
}
|
||||
|
||||
{
|
||||
static b3BoxHull box;
|
||||
|
||||
b3Transform m;
|
||||
m.position.Set(0.0f, 5.0f, -200.0f);
|
||||
m.rotation = b3Diagonal(50.0f, 50.0f, 1.0f);
|
||||
|
||||
box.SetTransform(m);
|
||||
|
||||
b3HullShape hs;
|
||||
hs.m_hull = &box;
|
||||
|
||||
b3ShapeDef sd;
|
||||
sd.density = 5.0f;
|
||||
sd.shape = &hs;
|
||||
|
||||
rotor->CreateShape(sd);
|
||||
}
|
||||
|
||||
{
|
||||
static b3BoxHull box;
|
||||
|
||||
b3Transform m;
|
||||
m.position.Set(0.0f, 5.0f, 200.0f);
|
||||
m.rotation = b3Diagonal(50.0f, 50.0f, 1.0f);
|
||||
|
||||
box.SetTransform(m);
|
||||
|
||||
b3HullShape hs;
|
||||
hs.m_hull = &box;
|
||||
|
||||
b3ShapeDef sd;
|
||||
sd.density = 5.0f;
|
||||
sd.shape = &hs;
|
||||
|
||||
rotor->CreateShape(sd);
|
||||
}
|
||||
|
||||
{
|
||||
static b3BoxHull box;
|
||||
|
||||
b3Transform m;
|
||||
m.position.Set(-50.0f, 5.0f, 0.0f);
|
||||
m.rotation = b3Diagonal(1.0f, 50.0f, 200.0f);
|
||||
|
||||
box.SetTransform(m);
|
||||
|
||||
b3HullShape hs;
|
||||
hs.m_hull = &box;
|
||||
|
||||
b3ShapeDef sd;
|
||||
sd.density = 5.0f;
|
||||
sd.shape = &hs;
|
||||
|
||||
rotor->CreateShape(sd);
|
||||
}
|
||||
|
||||
{
|
||||
static b3BoxHull box;
|
||||
|
||||
b3Transform m;
|
||||
m.position.Set(50.0f, 5.0f, 0.0f);
|
||||
m.rotation = b3Diagonal(1.0f, 50.0f, 200.0f);
|
||||
|
||||
box.SetTransform(m);
|
||||
|
||||
b3HullShape hs;
|
||||
hs.m_hull = &box;
|
||||
|
||||
b3ShapeDef sd;
|
||||
sd.density = 5.0f;
|
||||
sd.shape = &hs;
|
||||
|
||||
rotor->CreateShape(sd);
|
||||
}
|
||||
|
||||
{
|
||||
b3RevoluteJointDef jd;
|
||||
jd.Initialize(ground, rotor, b3Vec3(0.0f, 0.0f, -1.0f), ground->GetPosition(), -B3_PI, B3_PI);
|
||||
jd.motorSpeed = 0.05f * B3_PI;
|
||||
jd.maxMotorTorque = 1000.0f * rotor->GetMass();
|
||||
jd.enableMotor = true;
|
||||
|
||||
b3Joint* joint = (b3RevoluteJoint*)m_world.CreateJoint(jd);
|
||||
}
|
||||
}
|
||||
|
||||
{
|
||||
b3StackArray<b3Vec3, 32> points;
|
||||
ConstructCone(points);
|
||||
|
||||
u32 size = qhGetMemorySize(points.Count());
|
||||
void* p = b3Alloc(size);
|
||||
|
||||
qhHull hull;
|
||||
hull.Construct(p, points);
|
||||
m_coneHull = ConvertHull(hull);
|
||||
|
||||
b3Free(p);
|
||||
}
|
||||
|
||||
{
|
||||
b3StackArray<b3Vec3, 32> points;
|
||||
ConstructCylinder(points);
|
||||
|
||||
const u32 size = qhGetMemorySize(points.Count());
|
||||
void* p = b3Alloc(size);
|
||||
|
||||
qhHull hull;
|
||||
hull.Construct(p, points);
|
||||
m_cylinderHull = ConvertHull(hull);
|
||||
|
||||
b3Free(p);
|
||||
}
|
||||
|
||||
m_count = 0;
|
||||
}
|
||||
|
||||
~Tumbler()
|
||||
{
|
||||
{
|
||||
b3Free(m_coneHull.vertices);
|
||||
b3Free(m_coneHull.edges);
|
||||
b3Free(m_coneHull.faces);
|
||||
b3Free(m_coneHull.planes);
|
||||
}
|
||||
|
||||
{
|
||||
b3Free(m_cylinderHull.vertices);
|
||||
b3Free(m_cylinderHull.edges);
|
||||
b3Free(m_cylinderHull.faces);
|
||||
b3Free(m_cylinderHull.planes);
|
||||
}
|
||||
}
|
||||
|
||||
void Step()
|
||||
{
|
||||
if(m_count < e_count)
|
||||
{
|
||||
++m_count;
|
||||
|
||||
{
|
||||
b3BodyDef bdef;
|
||||
bdef.type = e_dynamicBody;
|
||||
bdef.position.Set(-10.0f, 5.0f, 0.0f);
|
||||
|
||||
b3Body* body = m_world.CreateBody(bdef);
|
||||
|
||||
b3SphereShape sphere;
|
||||
sphere.m_center.SetZero();
|
||||
sphere.m_radius = 1.0f;
|
||||
|
||||
b3ShapeDef sdef;
|
||||
sdef.density = 1.0f;
|
||||
sdef.friction = 0.3f;
|
||||
sdef.shape = &sphere;
|
||||
|
||||
body->CreateShape(sdef);
|
||||
}
|
||||
|
||||
{
|
||||
b3BodyDef bdef;
|
||||
bdef.type = e_dynamicBody;
|
||||
bdef.position.Set(-5.0f, 5.0f, 0.0f);
|
||||
|
||||
b3Body* body = m_world.CreateBody(bdef);
|
||||
|
||||
b3CapsuleShape capsule;
|
||||
capsule.m_centers[0].Set(0.0f, 0.0f, -1.0f);
|
||||
capsule.m_centers[1].Set(0.0f, 0.0f, 1.0f);
|
||||
capsule.m_radius = 1.0f;
|
||||
|
||||
b3ShapeDef sdef;
|
||||
sdef.density = 0.1f;
|
||||
sdef.friction = 0.2f;
|
||||
sdef.shape = &capsule;
|
||||
|
||||
body->CreateShape(sdef);
|
||||
}
|
||||
|
||||
{
|
||||
b3BodyDef bdef;
|
||||
bdef.type = e_dynamicBody;
|
||||
bdef.position.Set(0.0f, 0.0f, 0.0f);
|
||||
bdef.angularVelocity.Set(0.0f, 0.05f * B3_PI, 0.0f);
|
||||
b3Body* body = m_world.CreateBody(bdef);
|
||||
|
||||
static b3BoxHull box;
|
||||
box.SetIdentity();
|
||||
|
||||
b3HullShape hs;
|
||||
hs.m_hull = &box;
|
||||
|
||||
b3ShapeDef sd;
|
||||
sd.density = 0.05f;
|
||||
sd.shape = &hs;
|
||||
|
||||
body->CreateShape(sd);
|
||||
}
|
||||
|
||||
{
|
||||
b3BodyDef bdef;
|
||||
bdef.type = e_dynamicBody;
|
||||
bdef.position.Set(0.0f, 5.0f, 0.0f);
|
||||
|
||||
b3Body* body = m_world.CreateBody(bdef);
|
||||
|
||||
b3HullShape hull;
|
||||
hull.m_hull = &m_coneHull;
|
||||
|
||||
b3ShapeDef sdef;
|
||||
sdef.density = 1.0f;
|
||||
sdef.friction = 0.3f;
|
||||
sdef.shape = &hull;
|
||||
|
||||
body->CreateShape(sdef);
|
||||
}
|
||||
|
||||
{
|
||||
b3BodyDef bdef;
|
||||
bdef.type = e_dynamicBody;
|
||||
bdef.position.Set(4.0f, 5.0f, 0.0f);
|
||||
|
||||
b3Body* body = m_world.CreateBody(bdef);
|
||||
|
||||
b3HullShape hull;
|
||||
hull.m_hull = &m_cylinderHull;
|
||||
|
||||
b3ShapeDef sdef;
|
||||
sdef.density = 1.0f;
|
||||
sdef.friction = 0.2f;
|
||||
sdef.shape = &hull;
|
||||
|
||||
body->CreateShape(sdef);
|
||||
}
|
||||
}
|
||||
|
||||
Test::Step();
|
||||
}
|
||||
|
||||
static Test* Create()
|
||||
{
|
||||
return new Tumbler();
|
||||
}
|
||||
|
||||
u32 m_count;
|
||||
b3Hull m_coneHull;
|
||||
b3Hull m_cylinderHull;
|
||||
};
|
||||
|
||||
#endif
|
||||
Reference in New Issue
Block a user