basic physics
This commit is contained in:
parent
51d273b8fb
commit
7193bcbc41
2 changed files with 38 additions and 4 deletions
|
|
@ -316,8 +316,9 @@ struct _GSNetSocket {
|
|||
struct _GSPhysics {
|
||||
GSEngine engine;
|
||||
|
||||
dWorldID world;
|
||||
dSpaceID space;
|
||||
dWorldID world;
|
||||
dSpaceID space;
|
||||
dJointGroupID contact_group;
|
||||
};
|
||||
|
||||
struct _GSClient {
|
||||
|
|
|
|||
|
|
@ -15,8 +15,11 @@ GSPhysics GSPhysicsCreate(GSServer server) {
|
|||
|
||||
physics->engine = server->engine;
|
||||
|
||||
physics->world = dWorldCreate();
|
||||
physics->space = dSimpleSpaceCreate(0);
|
||||
physics->world = dWorldCreate();
|
||||
physics->space = dSimpleSpaceCreate(0);
|
||||
physics->contact_group = dJointGroupCreate(0);
|
||||
|
||||
dWorldSetGravity(physics->world, 0, 0, -9.81);
|
||||
|
||||
GSLog(server->engine, GSLogInfo, "Created physics engine");
|
||||
|
||||
|
|
@ -24,6 +27,7 @@ GSPhysics GSPhysicsCreate(GSServer server) {
|
|||
}
|
||||
|
||||
void GSPhysicsDestroy(GSPhysics physics) {
|
||||
dJointGroupDestroy(physics->contact_group);
|
||||
dSpaceDestroy(physics->space);
|
||||
dWorldDestroy(physics->world);
|
||||
|
||||
|
|
@ -32,5 +36,34 @@ void GSPhysicsDestroy(GSPhysics physics) {
|
|||
free(physics);
|
||||
}
|
||||
|
||||
void GSPhysicsStep(GSPhysics physics) {
|
||||
static void near_callback(void* data, dGeomID o1, dGeomID o2) {
|
||||
const int N = 256;
|
||||
dContact contact[256];
|
||||
GSPhysics physics = data;
|
||||
|
||||
if(dGeomIsSpace(o1) || dGeomIsSpace(o2)) {
|
||||
dSpaceCollide2(o1, o2, data, near_callback);
|
||||
if(dGeomIsSpace(o1)) dSpaceCollide((dSpaceID)o1, data, near_callback);
|
||||
if(dGeomIsSpace(o2)) dSpaceCollide((dSpaceID)o2, data, near_callback);
|
||||
} else {
|
||||
int how_many = dCollide(o1, o2, N, &contact[0].geom, sizeof(dContact));
|
||||
int i;
|
||||
|
||||
for(i = 0; i < how_many; i++) {
|
||||
dJointID joint;
|
||||
|
||||
contact[i].surface.mode = dContactApprox1;
|
||||
contact[i].surface.mu = 2;
|
||||
|
||||
joint = dJointCreateContact(physics->world, physics->contact_group, &contact[i]);
|
||||
|
||||
dJointAttach(joint, dGeomGetBody(contact[i].geom.g1), dGeomGetBody(contact[i].geom.g2));
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void GSPhysicsStep(GSPhysics physics) {
|
||||
dSpaceCollide(physics->space, physics, near_callback);
|
||||
dWorldStep(physics->world, 1.0 / physics->engine->tps);
|
||||
dJointGroupEmpty(physics->contact_group);
|
||||
}
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue