Fix bug

test_sdl.c

@@ -349,7 +349,7 @@ int main()
   addBody(TPE_SHAPE_CUBOID,1500,1500,1500);
   addBody(TPE_SHAPE_CUBOID,5000,512,5000);
 
-bodies[0].body.mass = 10 * TPE_FRACTIONS_PER_UNIT;
+bodies[0].body.mass = TPE_FRACTIONS_PER_UNIT * 3;
 bodies[1].body.mass = TPE_INFINITY;
 
   //-------
@@ -368,7 +368,7 @@ bodies[1].body.mass = TPE_INFINITY;
 
 bodies[0].body.position = TPE_vec4(0,3000,0,0);
 bodies[1].body.position = TPE_vec4(0,-1000,0,0);
-bodies[0].body.velocity = TPE_vec4(0,0,0,0);
+bodies[0].body.velocity = TPE_vec4(0,100,0,0);
 
 //TPE_bodyApplyImpulse(&(bodies[0].body),TPE_vec4(256,0,0,0),TPE_vec4(-1,-1,-1,0));
 
@@ -380,7 +380,7 @@ bodies[0].body.velocity = TPE_vec4(0,0,0,0);
 //TPE_bodySetRotation(&(bodies[1].body),TPE_vec4(210,50,1,0),5);
 
 TPE_Vec4 qqq;
-TPE_rotationToQuaternion(TPE_vec4(80,500,113,0),60,&qqq);
+TPE_rotationToQuaternion(TPE_vec4(80,100,113,0),80,&qqq);
 
 //qqq = TPE_vec4(350,270,100,224);
 

tinyphysicsengine.h

@@ -1397,7 +1397,8 @@ void TPE_resolveCollision(TPE_Body *body1 ,TPE_Body *body2,
     TPE_nonZero(e1 + e2);
 
   energyMultiplier = 
-    (energyMultiplier * TPE_FRACTIONS_PER_UNIT) / TPE_nonZero(e1);
+    e1 != 0 ?
+      (energyMultiplier * TPE_FRACTIONS_PER_UNIT) / e1 : TPE_FRACTIONS_PER_UNIT;
 
   if (energyMultiplier > TPE_FRACTIONS_PER_UNIT + 2 || // TODO: magic const.
     energyMultiplier < TPE_FRACTIONS_PER_UNIT - 2)