2 #include "../physics.qh"
5 #include "../../client/defs.qh"
8 #include "movetypes.qh"
9 #include "../../lib/csqcmodel/common.qh"
10 #include "../../server/t_items.qh"
13 #include "../../server/autocvars.qh"
16 void _Movetype_WallFriction(entity this, vector stepnormal) // SV_WallFriction
20 makevectors(this.v_angle);
21 d = (stepnormal * v_forward) + 0.5;
25 i = (stepnormal * this.move_velocity);
26 into = i * stepnormal;
27 side = this.move_velocity - into;
28 this.move_velocity_x = side.x * (1 * d);
29 this.move_velocity_y = side.y * (1 * d);
33 vector planes[MAX_CLIP_PLANES];
34 int _Movetype_FlyMove(entity this, float dt, bool applygravity, vector stepnormal, float stepheight) // SV_FlyMove
36 int blocked = 0, bumpcount;
37 int i, j, numplanes = 0;
38 float time_left = dt, grav = 0;
40 vector primal_velocity, original_velocity, restore_velocity;
42 for(i = 0; i < MAX_CLIP_PLANES; ++i)
47 this.move_didgravity = 1;
48 grav = dt * (PHYS_ENTGRAVITY(this) ? PHYS_ENTGRAVITY(this) : 1) * PHYS_GRAVITY;
50 if(!GAMEPLAYFIX_NOGRAVITYONGROUND || !(this.move_flags & FL_ONGROUND))
52 if(GRAVITY_UNAFFECTED_BY_TICRATE)
53 this.move_velocity_z -= grav * 0.5;
55 this.move_velocity_z -= grav;
59 original_velocity = primal_velocity = restore_velocity = this.move_velocity;
61 for(bumpcount = 0;bumpcount < MAX_CLIP_PLANES;bumpcount++)
63 if(this.move_velocity == '0 0 0')
66 push = this.move_velocity * time_left;
67 vector prev_origin = this.move_origin;
68 _Movetype_PushEntity(this, push, true);
69 if(trace_startsolid && this.move_origin != prev_origin)
71 // we got teleported by a touch function
72 // let's abort the move
77 // this code is used by MOVETYPE_WALK and MOVETYPE_STEP and SV_UnstickEntity
78 // abort move if we're stuck in the world (and didn't make it out)
79 if(trace_startsolid && trace_allsolid)
81 this.move_velocity = restore_velocity;
85 if(trace_fraction == 1)
88 float my_trace_fraction = trace_fraction;
89 vector my_trace_plane_normal = trace_plane_normal;
91 if(trace_plane_normal_z)
93 if(trace_plane_normal_z > 0.7)
100 //dprint("_Movetype_FlyMove: !trace_ent\n");
104 this.move_flags |= FL_ONGROUND;
105 this.move_groundentity = trace_ent;
110 // step - handle it immediately
111 vector org = this.move_origin;
112 vector steppush = '0 0 1' * stepheight;
114 _Movetype_PushEntity(this, steppush, true);
115 if(trace_startsolid && this.move_origin != org)
120 _Movetype_PushEntity(this, push, true);
121 if(trace_startsolid && this.move_origin != org)
126 float trace2_fraction = trace_fraction;
127 steppush = '0 0 1' * (org_z - this.move_origin_z);
128 _Movetype_PushEntity(this, steppush, true);
129 if(trace_startsolid && this.move_origin != org)
135 // accept the new position if it made some progress...
136 if(fabs(this.move_origin_x - org_x) >= 0.03125 || fabs(this.move_origin_y - org_y) >= 0.03125)
138 trace_endpos = this.move_origin;
139 time_left *= 1 - trace2_fraction;
144 this.move_origin = org;
148 // step - return it to caller
150 // save the trace for player extrafriction
152 stepnormal = trace_plane_normal;
155 if(my_trace_fraction >= 0.001)
157 // actually covered some distance
158 original_velocity = this.move_velocity;
162 time_left *= 1 - my_trace_fraction;
164 // clipped to another plane
165 if(numplanes >= MAX_CLIP_PLANES)
167 // this shouldn't really happen
168 this.move_velocity = '0 0 0';
173 planes[numplanes] = my_trace_plane_normal;
176 // modify original_velocity so it parallels all of the clip planes
177 vector new_velocity = '0 0 0';
178 for (i = 0;i < numplanes;i++)
180 new_velocity = _Movetype_ClipVelocity(original_velocity, planes[i], 1);
181 for (j = 0;j < numplanes;j++)
186 if((new_velocity * planes[j]) < 0)
196 // go along this plane
197 this.move_velocity = new_velocity;
201 // go along the crease
204 this.move_velocity = '0 0 0';
208 vector dir = cross(planes[0], planes[1]);
209 // LordHavoc: thanks to taniwha of QuakeForge for pointing out this fix for slowed falling in corners
210 float ilength = sqrt((dir * dir));
212 ilength = 1.0 / ilength;
216 float d = (dir * this.move_velocity);
217 this.move_velocity = dir * d;
220 // if current velocity is against the original velocity,
221 // stop dead to avoid tiny occilations in sloping corners
222 if((this.move_velocity * primal_velocity) <= 0)
224 this.move_velocity = '0 0 0';
229 // LordHavoc: this came from QW and allows you to get out of water more easily
230 if(GAMEPLAYFIX_EASIERWATERJUMP && (this.move_flags & FL_WATERJUMP) && !(blocked & 8))
231 this.move_velocity = primal_velocity;
235 if(!GAMEPLAYFIX_NOGRAVITYONGROUND || !(this.move_flags & FL_ONGROUND))
237 if(GRAVITY_UNAFFECTED_BY_TICRATE)
238 this.move_velocity_z -= grav * 0.5f;
245 void _Movetype_CheckVelocity(entity this) // SV_CheckVelocity
247 // if(vlen(this.move_velocity) < 0.0001)
248 // this.move_velocity = '0 0 0';
251 bool _Movetype_CheckWater(entity ent) // SV_CheckWater
253 vector point = ent.move_origin;
254 point.z += (ent.mins.z + 1);
256 int nativecontents = pointcontents(point);
257 if(ent.move_watertype && ent.move_watertype != nativecontents)
259 // dprintf("_Movetype_CheckWater(): Original: '%d', New: '%d'\n", ent.move_watertype, nativecontents);
260 if(ent.contentstransition)
261 ent.contentstransition(ent.move_watertype, nativecontents);
264 ent.move_waterlevel = 0;
265 ent.move_watertype = CONTENT_EMPTY;
267 int supercontents = Mod_Q1BSP_SuperContentsFromNativeContents(nativecontents);
268 if(supercontents & DPCONTENTS_LIQUIDSMASK)
270 ent.move_watertype = nativecontents;
271 ent.move_waterlevel = 1;
272 point.y = (ent.origin.y + ((ent.mins.z + ent.maxs.y) * 0.5));
273 if(Mod_Q1BSP_SuperContentsFromNativeContents(pointcontents(point)) & DPCONTENTS_LIQUIDSMASK)
275 ent.move_waterlevel = 2;
276 point.y = ent.origin.y + ent.view_ofs.y;
277 if(Mod_Q1BSP_SuperContentsFromNativeContents(pointcontents(point)) & DPCONTENTS_LIQUIDSMASK)
278 ent.move_waterlevel = 3;
282 return ent.move_waterlevel > 1;
285 void _Movetype_CheckWaterTransition(entity ent) // SV_CheckWaterTransition
287 int contents = pointcontents(ent.move_origin);
289 if(!ent.move_watertype)
292 if(!autocvar_cl_gameplayfix_fixedcheckwatertransition)
294 ent.move_watertype = contents;
295 ent.move_waterlevel = 1;
299 else if(ent.move_watertype != contents)
301 // dprintf("_Movetype_CheckWaterTransition(): Origin: %s, Direct: '%d', Original: '%d', New: '%d'\n", vtos(ent.move_origin), pointcontents(ent.move_origin), ent.move_watertype, contents);
302 if(ent.contentstransition)
303 ent.contentstransition(ent.move_watertype, contents);
306 if(contents <= CONTENT_WATER)
308 ent.move_watertype = contents;
309 ent.move_waterlevel = 1;
313 ent.move_watertype = CONTENT_EMPTY;
314 ent.move_waterlevel = (autocvar_cl_gameplayfix_fixedcheckwatertransition ? 0 : contents);
318 void _Movetype_Impact(entity this, entity oth) // SV_Impact
320 entity oldother = other;
326 WITH(entity, self, this, this.move_touch());
335 WITH(entity, self, oth, oth.move_touch());
341 void _Movetype_LinkEdict_TouchAreaGrid(entity this) // SV_LinkEdict_TouchAreaGrid
343 entity oldother = other;
345 for (entity e = findradius(0.5 * (this.absmin + this.absmax), 0.5 * vlen(this.absmax - this.absmin)); e; e = e.chain)
347 if(e.move_touch && boxesoverlap(e.absmin, e.absmax, this.absmin, this.absmax))
351 trace_allsolid = false;
352 trace_startsolid = false;
354 trace_inwater = false;
356 trace_endpos = e.origin;
357 trace_plane_normal = '0 0 1';
358 trace_plane_dist = 0;
361 WITH(entity, self, e, e.move_touch());
368 void _Movetype_LinkEdict(entity this, bool touch_triggers) // SV_LinkEdict
371 if(this.solid == SOLID_BSP)
373 // TODO set the absolute bbox
382 mi += this.move_origin;
383 ma += this.move_origin;
385 if(this.move_flags & FL_ITEM)
408 _Movetype_LinkEdict_TouchAreaGrid(this);
411 bool _Movetype_TestEntityPosition(entity this, vector ofs) // SV_TestEntityPosition
413 // vector org = this.move_origin + ofs;
415 int cont = this.dphitcontentsmask;
416 this.dphitcontentsmask = DPCONTENTS_SOLID;
417 tracebox(this.move_origin, this.mins, this.maxs, this.move_origin, MOVE_NOMONSTERS, this);
418 this.dphitcontentsmask = cont;
423 if(vlen(trace_endpos - this.move_origin) > 0.0001)
424 this.move_origin = trace_endpos;
428 bool _Movetype_UnstickEntity(entity this) // SV_UnstickEntity
430 if(!_Movetype_TestEntityPosition(this, '0 0 0')) return true;
431 if(!_Movetype_TestEntityPosition(this, '-1 0 0')) goto success;
432 if(!_Movetype_TestEntityPosition(this, '1 0 0')) goto success;
433 if(!_Movetype_TestEntityPosition(this, '0 -1 0')) goto success;
434 if(!_Movetype_TestEntityPosition(this, '0 1 0')) goto success;
435 if(!_Movetype_TestEntityPosition(this, '-1 -1 0')) goto success;
436 if(!_Movetype_TestEntityPosition(this, '1 -1 0')) goto success;
437 if(!_Movetype_TestEntityPosition(this, '-1 1 0')) goto success;
438 if(!_Movetype_TestEntityPosition(this, '1 1 0')) goto success;
439 for (int i = 1; i <= 17; ++i)
441 if(!_Movetype_TestEntityPosition(this, '0 0 -1' * i)) goto success;
442 if(!_Movetype_TestEntityPosition(this, '0 0 1' * i)) goto success;
444 LOG_TRACEF("Can't unstick an entity (edict: %d, classname: %s, origin: %s)\n",
445 num_for_edict(this), this.classname, vtos(this.move_origin));
448 LOG_TRACEF("Sucessfully unstuck an entity (edict: %d, classname: %s, origin: %s)\n",
449 num_for_edict(this), this.classname, vtos(this.move_origin));
450 _Movetype_LinkEdict(this, true);
454 vector _Movetype_ClipVelocity(vector vel, vector norm, float f) // SV_ClipVelocity
456 vel -= ((vel * norm) * norm) * f;
458 if(vel.x > -0.1 && vel.x < 0.1) vel.x = 0;
459 if(vel.y > -0.1 && vel.y < 0.1) vel.y = 0;
460 if(vel.z > -0.1 && vel.z < 0.1) vel.z = 0;
465 void _Movetype_PushEntityTrace(entity this, vector push)
467 vector end = this.move_origin + push;
469 if(this.move_nomonsters)
470 type = max(0, this.move_nomonsters);
471 else if(this.move_movetype == MOVETYPE_FLYMISSILE)
473 else if(this.solid == SOLID_TRIGGER || this.solid == SOLID_NOT)
474 type = MOVE_NOMONSTERS;
478 tracebox(this.move_origin, this.mins, this.maxs, end, type, this);
481 float _Movetype_PushEntity(entity this, vector push, bool failonstartsolid) // SV_PushEntity
483 _Movetype_PushEntityTrace(this, push);
485 if(trace_startsolid && failonstartsolid)
486 return trace_fraction;
488 this.move_origin = trace_endpos;
490 if(trace_fraction < 1)
491 if(this.solid >= SOLID_TRIGGER && (!(this.move_flags & FL_ONGROUND) || (this.move_groundentity != trace_ent)))
492 _Movetype_Impact(this, trace_ent);
494 return trace_fraction;
500 // matrix version of makevectors, sets v_forward, v_right and v_up
501 void makevectors_matrix(vector myangles) // AngleVectorsFLU
503 v_forward = v_right = v_up = '0 0 0';
505 float y = myangles.y * (M_PI * 2 / 360);
508 float p = myangles.x * (M_PI * 2 / 360);
513 v_forward.x = cp * cy;
514 v_forward.y = cp * sy;
521 float r = myangles.z * (M_PI * 2 / 360);
526 v_right.x = sr * sp * cy + cr * -sy;
527 v_right.y = sr * sp * sy + cr * cy;
532 v_up.x = cr * sp * cy + -sr * -sy;
533 v_up.y = cr * sp * sy + -sr * cy;
555 void _Movetype_Physics_Frame(entity this, float movedt)
557 this.move_didgravity = -1;
558 switch (this.move_movetype)
561 case MOVETYPE_FAKEPUSH:
562 _Movetype_Physics_Pusher(this, movedt);
566 case MOVETYPE_FOLLOW:
567 _Movetype_Physics_Follow(this);
569 case MOVETYPE_NOCLIP:
570 _Movetype_CheckWater(this);
571 this.move_origin = this.move_origin + TICRATE * this.move_velocity;
572 this.move_angles = this.move_angles + TICRATE * this.move_avelocity;
573 _Movetype_LinkEdict(this, false);
576 _Movetype_Physics_Step(this, movedt);
579 _Movetype_Physics_Walk(this, movedt);
582 case MOVETYPE_BOUNCE:
583 case MOVETYPE_BOUNCEMISSILE:
584 case MOVETYPE_FLYMISSILE:
586 _Movetype_Physics_Toss(this, movedt);
591 void Movetype_Physics_NoMatchServer(entity this) // optimized
593 float movedt = time - this.move_time;
594 this.move_time = time;
596 _Movetype_Physics_Frame(this, movedt);
600 this.avelocity = this.move_avelocity;
601 this.velocity = this.move_velocity;
602 this.angles = this.move_angles;
603 setorigin(this, this.move_origin);
606 void Movetype_Physics_MatchServer(entity this, bool sloppy)
608 Movetype_Physics_MatchTicrate(this, TICRATE, sloppy);
611 void Movetype_Physics_MatchTicrate(entity this, float tr, bool sloppy) // SV_Physics_Entity
615 Movetype_Physics_NoMatchServer(this);
619 float dt = time - this.move_time;
621 int n = max(0, floor(dt / tr));
623 this.move_time += n * tr;
625 if(!this.move_didgravity)
626 this.move_didgravity = ((this.move_movetype == MOVETYPE_BOUNCE || this.move_movetype == MOVETYPE_TOSS) && !(this.move_flags & FL_ONGROUND));
628 for (int i = 0; i < n; ++i)
630 _Movetype_Physics_Frame(this, tr);
635 this.avelocity = this.move_avelocity;
637 if(dt > 0 && this.move_movetype != MOVETYPE_NONE && !(this.move_flags & FL_ONGROUND))
639 // now continue the move from move_time to time
640 this.velocity = this.move_velocity;
642 if(this.move_didgravity > 0)
644 this.velocity_z -= (GRAVITY_UNAFFECTED_BY_TICRATE ? 0.5 : 1)
646 * (this.gravity ? this.gravity : 1)
650 this.angles = this.move_angles + dt * this.avelocity;
652 if(sloppy || this.move_movetype == MOVETYPE_NOCLIP)
654 setorigin(this, this.move_origin + dt * this.velocity);
658 _Movetype_PushEntityTrace(this, dt * this.velocity);
659 if(!trace_startsolid)
660 setorigin(this, trace_endpos);
663 if(this.move_didgravity > 0 && GRAVITY_UNAFFECTED_BY_TICRATE)
664 this.velocity_z -= 0.5 * dt * (this.gravity ? this.gravity : 1) * PHYS_GRAVITY;
668 this.velocity = this.move_velocity;
669 this.angles = this.move_angles;
670 setorigin(this, this.move_origin);