]> de.git.xonotic.org Git - xonotic/darkplaces.git/blobdiff - sv_phys.c
fix for lift blocking due to imprecision at very low frame times (slowmo)
[xonotic/darkplaces.git] / sv_phys.c
index 5d8db602e082184359b51c7f9c1d8f983550fca3..99605cc26c05258af59b2a2ae6867d200b9178c0 100644 (file)
--- a/sv_phys.c
+++ b/sv_phys.c
@@ -39,12 +39,14 @@ solid_edge items only clip against bsp models.
 
 */
 
-cvar_t sv_friction = {CVAR_NOTIFY, "sv_friction","4"};
-cvar_t sv_stopspeed = {0, "sv_stopspeed","100"};
-cvar_t sv_gravity = {CVAR_NOTIFY, "sv_gravity","800"};
-cvar_t sv_maxvelocity = {0, "sv_maxvelocity","2000"};
-cvar_t sv_nostep = {0, "sv_nostep","0"};
-cvar_t sv_stepheight = {0, "sv_stepheight", "18"};
+cvar_t sv_friction = {CVAR_NOTIFY, "sv_friction","4"};
+cvar_t sv_stopspeed = {CVAR_NOTIFY, "sv_stopspeed","100"};
+cvar_t sv_gravity = {CVAR_NOTIFY, "sv_gravity","800"};
+cvar_t sv_maxvelocity = {CVAR_NOTIFY, "sv_maxvelocity","2000"};
+cvar_t sv_nostep = {CVAR_NOTIFY, "sv_nostep","0"};
+cvar_t sv_stepheight = {CVAR_NOTIFY, "sv_stepheight", "18"};
+cvar_t sv_jumpstep = {CVAR_NOTIFY, "sv_jumpstep", "1"};
+cvar_t sv_wallfriction = {CVAR_NOTIFY, "sv_wallfriction", "1"};
 
 #define        MOVE_EPSILON    0.01
 
@@ -53,6 +55,8 @@ void SV_Physics_Toss (edict_t *ent);
 void SV_Phys_Init (void)
 {
        Cvar_RegisterVariable(&sv_stepheight);
+       Cvar_RegisterVariable(&sv_jumpstep);
+       Cvar_RegisterVariable(&sv_wallfriction);
 }
 
 /*
@@ -62,19 +66,19 @@ SV_CheckAllEnts
 */
 void SV_CheckAllEnts (void)
 {
-       int                     e;
-       edict_t         *check;
+       int e;
+       edict_t *check;
 
-// see if any solid entities are inside the final position
+       // see if any solid entities are inside the final position
        check = NEXT_EDICT(sv.edicts);
-       for (e=1 ; e<sv.num_edicts ; e++, check = NEXT_EDICT(check))
+       for (e = 1;e < sv.num_edicts;e++, check = NEXT_EDICT(check))
        {
                if (check->free)
                        continue;
                if (check->v.movetype == MOVETYPE_PUSH
-               || check->v.movetype == MOVETYPE_NONE
-               || check->v.movetype == MOVETYPE_FOLLOW
-               || check->v.movetype == MOVETYPE_NOCLIP)
+                || check->v.movetype == MOVETYPE_NONE
+                || check->v.movetype == MOVETYPE_FOLLOW
+                || check->v.movetype == MOVETYPE_NOCLIP)
                        continue;
 
                if (SV_TestEntityPosition (check))
@@ -89,8 +93,8 @@ SV_CheckVelocity
 */
 void SV_CheckVelocity (edict_t *ent)
 {
-       int             i;
-       float   wishspeed;
+       int i;
+       float wishspeed;
 
 //
 // bound velocity
@@ -132,16 +136,17 @@ Returns false if the entity removed itself.
 */
 qboolean SV_RunThink (edict_t *ent)
 {
-       float   thinktime;
+       float thinktime;
 
        thinktime = ent->v.nextthink;
        if (thinktime <= 0 || thinktime > sv.time + sv.frametime)
                return true;
-               
+
+       // don't let things stay in the past.
+       // it is possible to start that way by a trigger with a local time.
        if (thinktime < sv.time)
-               thinktime = sv.time;    // don't let things stay in the past.
-                                                               // it is possible to start that way
-                                                               // by a trigger with a local time.
+               thinktime = sv.time;
+
        ent->v.nextthink = 0;
        pr_global_struct->time = thinktime;
        pr_global_struct->self = EDICT_TO_PROG(ent);
@@ -159,7 +164,7 @@ Two entities have touched, so run their touch functions
 */
 void SV_Impact (edict_t *e1, edict_t *e2)
 {
-       int             old_self, old_other;
+       int old_self, old_other;
 
        old_self = pr_global_struct->self;
        old_other = pr_global_struct->other;
@@ -192,25 +197,25 @@ Slide off of the impacting object
 returns the blocked flags (1 = floor, 2 = step / wall)
 ==================
 */
-#define        STOP_EPSILON    0.1
-
+#define STOP_EPSILON 0.1
 int ClipVelocity (vec3_t in, vec3_t normal, vec3_t out, float overbounce)
 {
-       float   backoff;
-       float   change;
-       int             i, blocked;
+       int i, blocked;
+       float backoff, change;
 
        blocked = 0;
+       // flag if it's a floor
        if (normal[2] > 0)
-               blocked |= 1;           // floor
+               blocked |= 1;
+       // flag if it's a step
        if (!normal[2])
-               blocked |= 2;           // step
+               blocked |= 2;
 
        backoff = DotProduct (in, normal) * overbounce;
 
-       for (i=0 ; i<3 ; i++)
+       for (i = 0;i < 3;i++)
        {
-               change = normal[i]*backoff;
+               change = normal[i] * backoff;
                out[i] = in[i] - change;
                if (out[i] > -STOP_EPSILON && out[i] < STOP_EPSILON)
                        out[i] = 0;
@@ -233,20 +238,13 @@ If steptrace is not NULL, the trace of any vertical wall hit will be stored
 ============
 */
 // LordHavoc: increased from 5 to 20
-#define        MAX_CLIP_PLANES 20
+#define MAX_CLIP_PLANES 20
 int SV_FlyMove (edict_t *ent, float time, trace_t *steptrace)
 {
-       int                     bumpcount, numbumps;
-       vec3_t          dir;
-       float           d;
-       int                     numplanes;
-       vec3_t          planes[MAX_CLIP_PLANES];
-       vec3_t          primal_velocity, original_velocity, new_velocity;
-       int                     i, j;
-       trace_t         trace;
-       vec3_t          end;
-       float           time_left;
-       int                     blocked, impact;
+       int i, j, blocked, impact, numplanes, bumpcount, numbumps;
+       float d, time_left;
+       vec3_t dir, end, planes[MAX_CLIP_PLANES], primal_velocity, original_velocity, new_velocity;
+       trace_t trace;
 
        numbumps = 4;
 
@@ -276,14 +274,16 @@ int SV_FlyMove (edict_t *ent, float time, trace_t *steptrace)
                }
 
                if (trace.fraction > 0)
-               {       // actually covered some distance
+               {
+                       // actually covered some distance
                        VectorCopy (trace.endpos, ent->v.origin);
                        VectorCopy (ent->v.velocity, original_velocity);
                        numplanes = 0;
                }
 
+               // break if it moved the entire distance
                if (trace.fraction == 1)
-                        break;         // moved the entire distance
+                        break;
 
                if (!trace.ent)
                        Host_Error ("SV_FlyMove: !trace.ent");
@@ -303,31 +303,37 @@ int SV_FlyMove (edict_t *ent, float time, trace_t *steptrace)
 
                if (trace.plane.normal[2] > 0.7)
                {
-                       blocked |= 1;           // floor
+                       // floor
+                       blocked |= 1;
                        ent->v.flags =  (int)ent->v.flags | FL_ONGROUND;
                        ent->v.groundentity = EDICT_TO_PROG(trace.ent);
                }
                if (!trace.plane.normal[2])
                {
-                       blocked |= 2;           // step
+                       // step
+                       blocked |= 2;
+                       // save the trace for player extrafriction
                        if (steptrace)
-                               *steptrace = trace;     // save for player extrafriction
+                               *steptrace = trace;
                }
 
-//
-// run the impact function
-//
+               // run the impact function
                if (impact)
+               {
                        SV_Impact (ent, trace.ent);
-               if (ent->free)
-                       break;          // removed by the impact function
+
+                       // break if removed by the impact function
+                       if (ent->free)
+                               break;
+               }
 
 
                time_left -= time_left * trace.fraction;
 
-       // cliped to another plane
+               // clipped to another plane
                if (numplanes >= MAX_CLIP_PLANES)
-               {       // this shouldn't really happen
+               {
+                       // this shouldn't really happen
                        VectorClear(ent->v.velocity);
                        return 3;
                }
@@ -335,28 +341,29 @@ int SV_FlyMove (edict_t *ent, float time, trace_t *steptrace)
                VectorCopy (trace.plane.normal, planes[numplanes]);
                numplanes++;
 
-//
-// modify original_velocity so it parallels all of the clip planes
-//
+               // modify original_velocity so it parallels all of the clip planes
                for (i=0 ; i<numplanes ; i++)
                {
                        ClipVelocity (original_velocity, planes[i], new_velocity, 1);
                        for (j=0 ; j<numplanes ; j++)
                                if (j != i)
                                {
+                                       // not ok
                                        if (DotProduct (new_velocity, planes[j]) < 0)
-                                               break;  // not ok
+                                               break;
                                }
                        if (j == numplanes)
                                break;
                }
 
                if (i != numplanes)
-               {       // go along this plane
+               {
+                       // go along this plane
                        VectorCopy (new_velocity, ent->v.velocity);
                }
                else
-               {       // go along the crease
+               {
+                       // go along the crease
                        if (numplanes != 2)
                        {
                                VectorClear(ent->v.velocity);
@@ -369,10 +376,8 @@ int SV_FlyMove (edict_t *ent, float time, trace_t *steptrace)
                        VectorScale (dir, d, ent->v.velocity);
                }
 
-//
-// if original velocity is against the original velocity, stop dead
-// to avoid tiny occilations in sloping corners
-//
+               // if original velocity is against the original velocity,
+               // stop dead to avoid tiny occilations in sloping corners
                if (DotProduct (ent->v.velocity, primal_velocity) <= 0)
                {
                        VectorClear(ent->v.velocity);
@@ -392,9 +397,8 @@ SV_AddGravity
 */
 void SV_AddGravity (edict_t *ent)
 {
-       float   ent_gravity;
-
-       eval_t  *val;
+       float ent_gravity;
+       eval_t *val;
 
        val = GETEDICTFIELDVALUE(ent, eval_gravity);
        if (val!=0 && val->_float)
@@ -422,15 +426,15 @@ Does not change the entities velocity at all
 */
 trace_t SV_PushEntity (edict_t *ent, vec3_t push, vec3_t pushangles)
 {
-       trace_t trace;
-       vec3_t  end;
+       trace_t trace;
+       vec3_t end;
 
        VectorAdd (ent->v.origin, push, end);
 
        if (ent->v.movetype == MOVETYPE_FLYMISSILE)
                trace = SV_Move (ent->v.origin, ent->v.mins, ent->v.maxs, end, MOVE_MISSILE, ent);
        else if (ent->v.solid == SOLID_TRIGGER || ent->v.solid == SOLID_NOT)
-       // only clip against bmodels
+               // only clip against bmodels
                trace = SV_Move (ent->v.origin, ent->v.mins, ent->v.maxs, end, MOVE_NOMONSTERS, ent);
        else
                trace = SV_Move (ent->v.origin, ent->v.mins, ent->v.maxs, end, MOVE_NORMAL, ent);
@@ -458,7 +462,7 @@ void SV_PushMove (edict_t *pusher, float movetime)
        int                     i, e, index;
        edict_t         *check;
        float           savesolid, movetime2, pushltime;
-       vec3_t          mins, maxs, move, move1, moveangle, /*entorig, entang, */pushorig, pushang, a, forward, left, up, org, org2;
+       vec3_t          mins, maxs, move, move1, moveangle, pushorig, pushang, a, forward, left, up, org, org2;
        int                     num_moved;
        edict_t         *moved_edict[MAX_EDICTS];
        vec3_t          moved_from[MAX_EDICTS], moved_fromangles[MAX_EDICTS];
@@ -619,38 +623,48 @@ void SV_PushMove (edict_t *pusher, float movetime)
                // if it is still inside the pusher, block
                if (SV_TestEntityPosition (check))
                {
-                       // fail the move
-                       if (check->v.mins[0] == check->v.maxs[0])
-                               continue;
-                       if (check->v.solid == SOLID_NOT || check->v.solid == SOLID_TRIGGER)
+                       // try moving the contacted entity a tiny bit further to account for precision errors
+                       pusher->v.solid = SOLID_NOT;
+                       VectorScale(move, 0.1, move);
+                       trace = SV_PushEntity (check, move, vec3_origin);
+                       pusher->v.solid = savesolid;
+                       if (SV_TestEntityPosition (check))
                        {
-                               // corpse
-                               check->v.mins[0] = check->v.mins[1] = 0;
-                               VectorCopy (check->v.mins, check->v.maxs);
-                               continue;
-                       }
+                               // still inside pusher, so it's really blocked
 
-                       VectorCopy (pushorig, pusher->v.origin);
-                       VectorCopy (pushang, pusher->v.angles);
-                       pusher->v.ltime = pushltime;
-                       SV_LinkEdict (pusher, false);
+                               // fail the move
+                               if (check->v.mins[0] == check->v.maxs[0])
+                                       continue;
+                               if (check->v.solid == SOLID_NOT || check->v.solid == SOLID_TRIGGER)
+                               {
+                                       // corpse
+                                       check->v.mins[0] = check->v.mins[1] = 0;
+                                       VectorCopy (check->v.mins, check->v.maxs);
+                                       continue;
+                               }
 
-                       // move back any entities we already moved
-                       for (i=0 ; i<num_moved ; i++)
-                       {
-                               VectorCopy (moved_from[i], moved_edict[i]->v.origin);
-                               VectorCopy (moved_fromangles[i], moved_edict[i]->v.angles);
-                               SV_LinkEdict (moved_edict[i], false);
-                       }
+                               VectorCopy (pushorig, pusher->v.origin);
+                               VectorCopy (pushang, pusher->v.angles);
+                               pusher->v.ltime = pushltime;
+                               SV_LinkEdict (pusher, false);
 
-                       // if the pusher has a "blocked" function, call it, otherwise just stay in place until the obstacle is gone
-                       if (pusher->v.blocked)
-                       {
-                               pr_global_struct->self = EDICT_TO_PROG(pusher);
-                               pr_global_struct->other = EDICT_TO_PROG(check);
-                               PR_ExecuteProgram (pusher->v.blocked, "");
+                               // move back any entities we already moved
+                               for (i=0 ; i<num_moved ; i++)
+                               {
+                                       VectorCopy (moved_from[i], moved_edict[i]->v.origin);
+                                       VectorCopy (moved_fromangles[i], moved_edict[i]->v.angles);
+                                       SV_LinkEdict (moved_edict[i], false);
+                               }
+
+                               // if the pusher has a "blocked" function, call it, otherwise just stay in place until the obstacle is gone
+                               if (pusher->v.blocked)
+                               {
+                                       pr_global_struct->self = EDICT_TO_PROG(pusher);
+                                       pr_global_struct->other = EDICT_TO_PROG(check);
+                                       PR_ExecuteProgram (pusher->v.blocked, "");
+                               }
+                               return;
                        }
-                       return;
                }
        }
 }
@@ -663,9 +677,7 @@ SV_Physics_Pusher
 */
 void SV_Physics_Pusher (edict_t *ent)
 {
-       float   thinktime;
-       float   oldltime;
-       float   movetime;
+       float thinktime, oldltime, movetime;
 
        oldltime = ent->v.ltime;
 
@@ -680,7 +692,8 @@ void SV_Physics_Pusher (edict_t *ent)
                movetime = sv.frametime;
 
        if (movetime)
-               SV_PushMove (ent, movetime);    // advances ent->v.ltime if not blocked
+               // advances ent->v.ltime if not blocked
+               SV_PushMove (ent, movetime);
 
        if (thinktime > oldltime && thinktime <= ent->v.ltime)
        {
@@ -714,9 +727,8 @@ clipping hull.
 */
 void SV_CheckStuck (edict_t *ent)
 {
-       int             i, j;
-       int             z;
-       vec3_t  org;
+       int i, j, z;
+       vec3_t org;
 
        if (!SV_TestEntityPosition(ent))
        {
@@ -747,7 +759,7 @@ void SV_CheckStuck (edict_t *ent)
                                        return;
                                }
                        }
-                       
+
        VectorCopy (org, ent->v.origin);
        Con_DPrintf ("player is stuck.\n");
 }
@@ -760,27 +772,27 @@ SV_CheckWater
 */
 qboolean SV_CheckWater (edict_t *ent)
 {
-       vec3_t  point;
-       int             cont;
+       int cont;
+       vec3_t point;
 
        point[0] = ent->v.origin[0];
        point[1] = ent->v.origin[1];
        point[2] = ent->v.origin[2] + ent->v.mins[2] + 1;
-       
+
        ent->v.waterlevel = 0;
        ent->v.watertype = CONTENTS_EMPTY;
-       cont = SV_PointContents (point);
+       cont = Mod_PointContents(point, sv.worldmodel);
        if (cont <= CONTENTS_WATER)
        {
                ent->v.watertype = cont;
                ent->v.waterlevel = 1;
                point[2] = ent->v.origin[2] + (ent->v.mins[2] + ent->v.maxs[2])*0.5;
-               cont = SV_PointContents (point);
+               cont = Mod_PointContents(point, sv.worldmodel);
                if (cont <= CONTENTS_WATER)
                {
                        ent->v.waterlevel = 2;
                        point[2] = ent->v.origin[2] + ent->v.view_ofs[2];
-                       cont = SV_PointContents (point);
+                       cont = Mod_PointContents(point, sv.worldmodel);
                        if (cont <= CONTENTS_WATER)
                                ent->v.waterlevel = 3;
                }
@@ -797,22 +809,21 @@ SV_WallFriction
 */
 void SV_WallFriction (edict_t *ent, trace_t *trace)
 {
-       vec3_t          forward;
-       float           d, i;
-       vec3_t          into, side;
+       float d, i;
+       vec3_t forward, into, side;
 
        AngleVectors (ent->v.v_angle, forward, NULL, NULL);
        d = DotProduct (trace->plane.normal, forward);
-       
+
        d += 0.5;
        if (d >= 0)
                return;
 
-// cut the tangential velocity
+       // cut the tangential velocity
        i = DotProduct (trace->plane.normal, ent->v.velocity);
        VectorScale (trace->plane.normal, i, into);
        VectorSubtract (ent->v.velocity, into, side);
-       
+
        ent->v.velocity[0] = side[0] * (1 + d);
        ent->v.velocity[1] = side[1] * (1 + d);
 }
@@ -831,50 +842,47 @@ This is a hack, but in the interest of good gameplay...
 */
 int SV_TryUnstick (edict_t *ent, vec3_t oldvel)
 {
-       int             i;
-       vec3_t  oldorg;
-       vec3_t  dir;
-       int             clip;
-       trace_t steptrace;
+       int i, clip;
+       vec3_t oldorg, dir;
+       trace_t steptrace;
 
        VectorCopy (ent->v.origin, oldorg);
        VectorClear (dir);
 
        for (i=0 ; i<8 ; i++)
        {
-// try pushing a little in an axial direction
+               // try pushing a little in an axial direction
                switch (i)
                {
-                       case 0: dir[0] = 2; dir[1] = 0; break;
-                       case 1: dir[0] = 0; dir[1] = 2; break;
-                       case 2: dir[0] = -2; dir[1] = 0; break;
-                       case 3: dir[0] = 0; dir[1] = -2; break;
-                       case 4: dir[0] = 2; dir[1] = 2; break;
-                       case 5: dir[0] = -2; dir[1] = 2; break;
-                       case 6: dir[0] = 2; dir[1] = -2; break;
-                       case 7: dir[0] = -2; dir[1] = -2; break;
+                       case 0: dir[0] = 2; dir[1] = 0; break;
+                       case 1: dir[0] = 0; dir[1] = 2; break;
+                       case 2: dir[0] = -2; dir[1] = 0; break;
+                       case 3: dir[0] = 0; dir[1] = -2; break;
+                       case 4: dir[0] = 2; dir[1] = 2; break;
+                       case 5: dir[0] = -2; dir[1] = 2; break;
+                       case 6: dir[0] = 2; dir[1] = -2; break;
+                       case 7: dir[0] = -2; dir[1] = -2; break;
                }
 
                SV_PushEntity (ent, dir, vec3_origin);
 
-// retry the original move
+               // retry the original move
                ent->v.velocity[0] = oldvel[0];
                ent->v.velocity[1] = oldvel[1];
                ent->v.velocity[2] = 0;
                clip = SV_FlyMove (ent, 0.1, &steptrace);
 
-               if ( fabs(oldorg[1] - ent->v.origin[1]) > 4
-               || fabs(oldorg[0] - ent->v.origin[0]) > 4 )
-               {
+               if (fabs(oldorg[1] - ent->v.origin[1]) > 4
+                || fabs(oldorg[0] - ent->v.origin[0]) > 4)
                        return clip;
-               }
 
-// go back to the original pos and try again
+               // go back to the original pos and try again
                VectorCopy (oldorg, ent->v.origin);
        }
-       
+
+       // still not moving
        VectorClear (ent->v.velocity);
-       return 7;               // still not moving
+       return 7;
 }
 
 /*
@@ -886,16 +894,11 @@ Only used by players
 */
 void SV_WalkMove (edict_t *ent)
 {
-       vec3_t          upmove, downmove;
-       vec3_t          oldorg, oldvel;
-       vec3_t          nosteporg, nostepvel;
-       int                     clip;
-       int                     oldonground;
-       trace_t         steptrace, downtrace;
+       int clip, oldonground;
+       vec3_t upmove, downmove, oldorg, oldvel, nosteporg, nostepvel;
+       trace_t steptrace, downtrace;
 
-//
-// do a regular slide move unless it looks like you ran into a step
-//
+       // do a regular slide move unless it looks like you ran into a step
        oldonground = (int)ent->v.flags & FL_ONGROUND;
        ent->v.flags = (int)ent->v.flags & ~FL_ONGROUND;
 
@@ -904,14 +907,20 @@ void SV_WalkMove (edict_t *ent)
 
        clip = SV_FlyMove (ent, sv.frametime, &steptrace);
 
+       // if move didn't block on a step, return
        if ( !(clip & 2) )
-               return;         // move didn't block on a step
+               return;
 
-       if (!oldonground && ent->v.waterlevel == 0)
-               return;         // don't stair up while jumping
+       if (ent->v.movetype != MOVETYPE_FLY)
+       {
+               if (!oldonground && ent->v.waterlevel == 0 && !sv_jumpstep.integer)
+                       // don't stair up while jumping
+                       return;
 
-       if (ent->v.movetype != MOVETYPE_WALK)
-               return;         // gibbed by a trigger
+               if (ent->v.movetype != MOVETYPE_WALK)
+                       // gibbed by a trigger
+                       return;
+       }
 
        if (sv_nostep.integer)
                return;
@@ -922,46 +931,46 @@ void SV_WalkMove (edict_t *ent)
        VectorCopy (ent->v.origin, nosteporg);
        VectorCopy (ent->v.velocity, nostepvel);
 
-//
-// try moving up and forward to go up a step
-//
-       VectorCopy (oldorg, ent->v.origin);     // back to start pos
+       // try moving up and forward to go up a step
+       // back to start pos
+       VectorCopy (oldorg, ent->v.origin);
 
        VectorClear (upmove);
        VectorClear (downmove);
        upmove[2] = sv_stepheight.value;
        downmove[2] = -sv_stepheight.value + oldvel[2]*sv.frametime;
 
-// move up
-       SV_PushEntity (ent, upmove, vec3_origin);       // FIXME: don't link?
+       // move up
+       // FIXME: don't link?
+       SV_PushEntity (ent, upmove, vec3_origin);
 
-// move forward
+       // move forward
        ent->v.velocity[0] = oldvel[0];
-       ent->v. velocity[1] = oldvel[1];
-       ent->v. velocity[2] = 0;
+       ent->v.velocity[1] = oldvel[1];
+       ent->v.velocity[2] = 0;
        clip = SV_FlyMove (ent, sv.frametime, &steptrace);
-
-// check for stuckness, possibly due to the limited precision of floats
-// in the clipping hulls
-       if (clip)
-       {
-               if ( fabs(oldorg[1] - ent->v.origin[1]) < 0.03125
-               && fabs(oldorg[0] - ent->v.origin[0]) < 0.03125 )
-               {       // stepping up didn't make any progress
-                       clip = SV_TryUnstick (ent, oldvel);
-               }
-       }
-
-// extra friction based on view angle
-       if ( clip & 2 )
+       ent->v.velocity[2] += oldvel[2];
+
+       // check for stuckness, possibly due to the limited precision of floats
+       // in the clipping hulls
+       if (clip
+        && fabs(oldorg[1] - ent->v.origin[1]) < 0.03125
+        && fabs(oldorg[0] - ent->v.origin[0]) < 0.03125)
+               // stepping up didn't make any progress
+               clip = SV_TryUnstick (ent, oldvel);
+
+       // extra friction based on view angle
+       if (clip & 2 && sv_wallfriction.integer)
                SV_WallFriction (ent, &steptrace);
 
-// move down
-       downtrace = SV_PushEntity (ent, downmove, vec3_origin); // FIXME: don't link?
+       // move down
+       // FIXME: don't link?
+       downtrace = SV_PushEntity (ent, downmove, vec3_origin);
 
        if (downtrace.plane.normal[2] > 0.7)
        {
-               if (ent->v.solid == SOLID_BSP)
+               // LordHavoc: disabled this so you can walk on monsters/players
+               //if (ent->v.solid == SOLID_BSP)
                {
                        ent->v.flags =  (int)ent->v.flags | FL_ONGROUND;
                        ent->v.groundentity = EDICT_TO_PROG(downtrace.ent);
@@ -969,9 +978,9 @@ void SV_WalkMove (edict_t *ent)
        }
        else
        {
-// if the push down didn't end up on good ground, use the move without
-// the step up.  This happens near wall / slope combinations, and can
-// cause the player to hop up higher on a slope too steep to climb
+               // if the push down didn't end up on good ground, use the move without
+               // the step up.  This happens near wall / slope combinations, and can
+               // cause the player to hop up higher on a slope too steep to climb
                VectorCopy (nosteporg, ent->v.origin);
                VectorCopy (nostepvel, ent->v.velocity);
        }
@@ -985,26 +994,20 @@ SV_Physics_Client
 Player character actions
 ================
 */
-void SV_Physics_Client (edict_t        *ent, int num)
+void SV_Physics_Client (edict_t *ent, int num)
 {
-       if ( ! svs.clients[num-1].active )
+       if (!svs.clients[num-1].active)
                return;         // unconnected slot
 
-//
-// call standard client pre-think
-//
+       // call standard client pre-think
        pr_global_struct->time = sv.time;
        pr_global_struct->self = EDICT_TO_PROG(ent);
        PR_ExecuteProgram (pr_global_struct->PlayerPreThink, "QC function PlayerPreThink is missing");
 
-//
-// do a move
-//
+       // do a move
        SV_CheckVelocity (ent);
 
-//
-// decide which move function to call
-//
+       // decide which move function to call
        switch ((int)ent->v.movetype)
        {
        case MOVETYPE_NONE:
@@ -1030,7 +1033,8 @@ void SV_Physics_Client (edict_t   *ent, int num)
                if (!SV_RunThink (ent))
                        return;
                SV_CheckWater (ent);
-               SV_FlyMove (ent, sv.frametime, NULL);
+               //SV_FlyMove (ent, sv.frametime, NULL);
+               SV_WalkMove (ent);
                break;
 
        case MOVETYPE_NOCLIP:
@@ -1038,15 +1042,14 @@ void SV_Physics_Client (edict_t *ent, int num)
                        return;
                SV_CheckWater (ent);
                VectorMA (ent->v.origin, sv.frametime, ent->v.velocity, ent->v.origin);
+               VectorMA (ent->v.angles, sv.frametime, ent->v.avelocity, ent->v.angles);
                break;
 
        default:
                Host_Error ("SV_Physics_client: bad movetype %i", (int)ent->v.movetype);
        }
 
-//
-// call standard player post-think
-//
+       // call standard player post-think
        SV_LinkEdict (ent, true);
 
        pr_global_struct->time = sv.time;
@@ -1067,9 +1070,11 @@ void SV_Physics_Follow (edict_t *ent)
 {
        vec3_t vf, vr, vu, angles, v;
        edict_t *e;
-// regular thinking
+
+       // regular thinking
        if (!SV_RunThink (ent))
                return;
+
        // LordHavoc: implemented rotation on MOVETYPE_FOLLOW objects
        e = PROG_TO_EDICT(ent->v.aiment);
        if (e->v.angles[0] == ent->v.punchangle[0] && e->v.angles[1] == ent->v.punchangle[1] && e->v.angles[2] == ent->v.punchangle[2])
@@ -1107,7 +1112,7 @@ A moving object that doesn't obey physics
 */
 void SV_Physics_Noclip (edict_t *ent)
 {
-// regular thinking
+       // regular thinking
        if (!SV_RunThink (ent))
                return;
 
@@ -1133,10 +1138,11 @@ SV_CheckWaterTransition
 */
 void SV_CheckWaterTransition (edict_t *ent)
 {
-       int             cont;
-       cont = SV_PointContents (ent->v.origin);
+       int cont;
+       cont = Mod_PointContents(ent->v.origin, sv.worldmodel);
        if (!ent->v.watertype)
-       {       // just spawned here
+       {
+               // just spawned here
                ent->v.watertype = cont;
                ent->v.waterlevel = 1;
                return;
@@ -1144,19 +1150,19 @@ void SV_CheckWaterTransition (edict_t *ent)
 
        if (cont <= CONTENTS_WATER)
        {
-               if (ent->v.watertype == CONTENTS_EMPTY)
-               {       // just crossed into water
+               if (ent->v.watertype == CONTENTS_EMPTY && cont != CONTENTS_LAVA)
+                       // just crossed into water
                        SV_StartSound (ent, 0, "misc/h2ohit1.wav", 255, 1);
-               }
+
                ent->v.watertype = cont;
                ent->v.waterlevel = 1;
        }
        else
        {
-               if (ent->v.watertype != CONTENTS_EMPTY)
-               {       // just crossed into water
+               if (ent->v.watertype != CONTENTS_EMPTY && ent->v.watertype != CONTENTS_LAVA)
+                       // just crossed into water
                        SV_StartSound (ent, 0, "misc/h2ohit1.wav", 255, 1);
-               }
+
                ent->v.watertype = CONTENTS_EMPTY;
                ent->v.waterlevel = cont;
        }
@@ -1171,9 +1177,9 @@ Toss, bounce, and fly movement.  When onground, do nothing.
 */
 void SV_Physics_Toss (edict_t *ent)
 {
-       trace_t trace;
-       vec3_t  move;
-       edict_t *groundentity;
+       trace_t trace;
+       vec3_t move;
+       edict_t *groundentity;
 
        // regular thinking
        if (!SV_RunThink (ent))
@@ -1182,12 +1188,18 @@ void SV_Physics_Toss (edict_t *ent)
 // if onground, return without moving
        if ((int)ent->v.flags & FL_ONGROUND)
        {
+               VectorClear(ent->v.velocity);
                if (ent->v.groundentity == 0)
                        return;
+               // if ent was supported by a brush model on previous frame,
+               // and groundentity is now freed, set groundentity to 0 (floating)
                groundentity = PROG_TO_EDICT(ent->v.groundentity);
-               if (groundentity != NULL && groundentity->v.solid == SOLID_BSP)
+               if (groundentity->v.solid == SOLID_BSP)
+               {
                        ent->suspendedinairflag = true;
-               else if (ent->suspendedinairflag && (groundentity == NULL || groundentity->free))
+                       return;
+               }
+               else if (ent->suspendedinairflag && groundentity->free)
                {
                        // leave it suspended in the air
                        ent->v.groundentity = 0;
@@ -1200,9 +1212,7 @@ void SV_Physics_Toss (edict_t *ent)
        SV_CheckVelocity (ent);
 
 // add gravity
-       if (ent->v.movetype != MOVETYPE_FLY
-        && ent->v.movetype != MOVETYPE_BOUNCEMISSILE // LordHavoc: enabled MOVETYPE_BOUNCEMISSILE
-        && ent->v.movetype != MOVETYPE_FLYMISSILE)
+       if (ent->v.movetype == MOVETYPE_TOSS || ent->v.movetype == MOVETYPE_BOUNCE)
                SV_AddGravity (ent);
 
 // move angles
@@ -1213,40 +1223,41 @@ void SV_Physics_Toss (edict_t *ent)
        trace = SV_PushEntity (ent, move, vec3_origin);
        if (ent->free)
                return;
-       if (trace.fraction == 1)
-               return;
 
-       if (ent->v.movetype == MOVETYPE_BOUNCEMISSILE)
+       if (trace.fraction < 1)
        {
-               ClipVelocity (ent->v.velocity, trace.plane.normal, ent->v.velocity, 2.0);
-               ent->v.flags = (int)ent->v.flags & ~FL_ONGROUND;
-       }
-       else if (ent->v.movetype == MOVETYPE_BOUNCE)
-       {
-               ClipVelocity (ent->v.velocity, trace.plane.normal, ent->v.velocity, 1.5);
-               // LordHavoc: fixed grenades not bouncing when fired down a slope
-               if (trace.plane.normal[2] > 0.7 && DotProduct(trace.plane.normal, ent->v.velocity) < 60)
+               if (ent->v.movetype == MOVETYPE_BOUNCEMISSILE)
                {
-                       ent->v.flags = (int)ent->v.flags | FL_ONGROUND;
-                       ent->v.groundentity = EDICT_TO_PROG(trace.ent);
-                       VectorClear (ent->v.velocity);
-                       VectorClear (ent->v.avelocity);
-               }
-               else
+                       ClipVelocity (ent->v.velocity, trace.plane.normal, ent->v.velocity, 2.0);
                        ent->v.flags = (int)ent->v.flags & ~FL_ONGROUND;
-       }
-       else
-       {
-               ClipVelocity (ent->v.velocity, trace.plane.normal, ent->v.velocity, 1.0);
-               if (trace.plane.normal[2] > 0.7)
+               }
+               else if (ent->v.movetype == MOVETYPE_BOUNCE)
                {
-                       ent->v.flags = (int)ent->v.flags | FL_ONGROUND;
-                       ent->v.groundentity = EDICT_TO_PROG(trace.ent);
-                       VectorClear (ent->v.velocity);
-                       VectorClear (ent->v.avelocity);
+                       ClipVelocity (ent->v.velocity, trace.plane.normal, ent->v.velocity, 1.5);
+                       // LordHavoc: fixed grenades not bouncing when fired down a slope
+                       if (trace.plane.normal[2] > 0.7 && DotProduct(trace.plane.normal, ent->v.velocity) < 60)
+                       {
+                               ent->v.flags = (int)ent->v.flags | FL_ONGROUND;
+                               ent->v.groundentity = EDICT_TO_PROG(trace.ent);
+                               VectorClear (ent->v.velocity);
+                               VectorClear (ent->v.avelocity);
+                       }
+                       else
+                               ent->v.flags = (int)ent->v.flags & ~FL_ONGROUND;
                }
                else
-                       ent->v.flags = (int)ent->v.flags & ~FL_ONGROUND;
+               {
+                       ClipVelocity (ent->v.velocity, trace.plane.normal, ent->v.velocity, 1.0);
+                       if (trace.plane.normal[2] > 0.7)
+                       {
+                               ent->v.flags = (int)ent->v.flags | FL_ONGROUND;
+                               ent->v.groundentity = EDICT_TO_PROG(trace.ent);
+                               VectorClear (ent->v.velocity);
+                               VectorClear (ent->v.avelocity);
+                       }
+                       else
+                               ent->v.flags = (int)ent->v.flags & ~FL_ONGROUND;
+               }
        }
 
 // check for in water
@@ -1283,7 +1294,7 @@ void SV_Physics_Step (edict_t *ent)
        {
                if (flags & FL_FLY)
                        fall = false;
-               else if ((flags & FL_SWIM) && SV_PointContents(ent->v.origin) != CONTENTS_EMPTY)
+               else if ((flags & FL_SWIM) && Mod_PointContents(ent->v.origin, sv.worldmodel) != CONTENTS_EMPTY)
                        fall = false;
        }
        if (fall && (flags & FL_ONGROUND) && ent->v.groundentity == 0)
@@ -1330,8 +1341,8 @@ SV_Physics
 */
 void SV_Physics (void)
 {
-       int             i;
-       edict_t *ent;
+       int i;
+       edict_t *ent;
 
 // let the progs know that a new frame has started
        pr_global_struct->self = EDICT_TO_PROG(sv.edicts);
@@ -1419,12 +1430,11 @@ void SV_Physics (void)
 trace_t SV_Trace_Toss (edict_t *tossent, edict_t *ignore)
 {
        int i;
-       edict_t tempent, *tent;
-       trace_t trace;
-       vec3_t  move;
-       vec3_t  end;
-       float   gravity, savesolid;
-       eval_t  *val;
+       float gravity, savesolid;
+       vec3_t move, end;
+       edict_t tempent, *tent;
+       eval_t *val;
+       trace_t trace;
 
        memcpy(&tempent, tossent, sizeof(edict_t));
        tent = &tempent;