2 Copyright (C) 1996-1997 Id Software, Inc.
4 This program is free software; you can redistribute it and/or
5 modify it under the terms of the GNU General Public License
6 as published by the Free Software Foundation; either version 2
7 of the License, or (at your option) any later version.
9 This program is distributed in the hope that it will be useful,
10 but WITHOUT ANY WARRANTY; without even the implied warranty of
11 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
13 See the GNU General Public License for more details.
15 You should have received a copy of the GNU General Public License
16 along with this program; if not, write to the Free Software
17 Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
20 // world.c -- world query functions
26 entities never clip against themselves, or their owner
28 line of sight checks trace->crosscontent, but bullets don't
35 vec3_t boxmins, boxmaxs;// enclose the test object along entire move
36 float *mins, *maxs; // size of the moving object
37 vec3_t mins2, maxs2; // size when clipping against mosnters
46 ===============================================================================
50 ===============================================================================
54 static hull_t box_hull;
55 static dclipnode_t box_clipnodes[6];
56 static mplane_t box_planes[6];
62 Set up the planes and clipnodes so that the six floats of a bounding box
63 can just be stored out and get a proper hull_t structure.
66 void SV_InitBoxHull (void)
71 box_hull.clipnodes = box_clipnodes;
72 box_hull.planes = box_planes;
73 box_hull.firstclipnode = 0;
74 box_hull.lastclipnode = 5;
78 box_clipnodes[i].planenum = i;
82 box_clipnodes[i].children[side] = CONTENTS_EMPTY;
84 box_clipnodes[i].children[side^1] = i + 1;
86 box_clipnodes[i].children[side^1] = CONTENTS_SOLID;
88 box_planes[i].type = i>>1;
89 box_planes[i].normal[i>>1] = 1;
99 To keep everything totally uniform, bounding boxes are turned into small
100 BSP trees instead of being compared directly.
103 hull_t *SV_HullForBox (vec3_t mins, vec3_t maxs)
105 box_planes[0].dist = maxs[0];
106 box_planes[1].dist = mins[0];
107 box_planes[2].dist = maxs[1];
108 box_planes[3].dist = mins[1];
109 box_planes[4].dist = maxs[2];
110 box_planes[5].dist = mins[2];
121 Returns a hull that can be used for testing or clipping an object of mins/maxs
123 Offset is filled in to contain the adjustment that must be added to the
124 testing object's origin to get a point to use with the returned hull.
127 extern qboolean hlbsp;
128 hull_t *SV_HullForEntity (edict_t *ent, vec3_t mins, vec3_t maxs, vec3_t offset)
132 vec3_t hullmins, hullmaxs;
135 // decide which clipping hull to use, based on the size
136 if (ent->v.solid == SOLID_BSP)
137 { // explicit hulls in the BSP model
138 if (ent->v.movetype != MOVETYPE_PUSH)
139 Host_Error ("SOLID_BSP without MOVETYPE_PUSH");
141 model = sv.models[ (int)ent->v.modelindex ];
143 // LordHavoc: fixed SOLID_BSP error message
144 if (!model || model->type != mod_brush)
146 Con_Printf ("SOLID_BSP with a non bsp model, entity dump:\n");
148 Host_Error ("SOLID_BSP with a non bsp model\n");
151 VectorSubtract (maxs, mins, size);
152 // LordHavoc: FIXME!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
156 hull = &model->hulls[0]; // 0x0x0
157 else if (size[0] <= 32)
159 if (size[2] < 54) // pick the nearest of 36 or 72
160 hull = &model->hulls[3]; // 32x32x36
162 hull = &model->hulls[1]; // 32x32x72
165 hull = &model->hulls[2]; // 64x64x64
170 hull = &model->hulls[0]; // 0x0x0
171 else if (size[0] <= 32)
172 hull = &model->hulls[1]; // 32x32x56
174 hull = &model->hulls[2]; // 64x64x88
177 // calculate an offset value to center the origin
178 VectorSubtract (hull->clip_mins, mins, offset);
179 VectorAdd (offset, ent->v.origin, offset);
182 { // create a temp hull from bounding box sizes
184 VectorSubtract (ent->v.mins, maxs, hullmins);
185 VectorSubtract (ent->v.maxs, mins, hullmaxs);
186 hull = SV_HullForBox (hullmins, hullmaxs);
188 VectorCopy (ent->v.origin, offset);
196 ===============================================================================
200 ===============================================================================
203 typedef struct areanode_s
205 int axis; // -1 = leaf node
207 struct areanode_s *children[2];
208 link_t trigger_edicts;
213 #define AREA_NODES 32
215 static areanode_t sv_areanodes[AREA_NODES];
216 static int sv_numareanodes;
224 areanode_t *SV_CreateAreaNode (int depth, vec3_t mins, vec3_t maxs)
228 vec3_t mins1, maxs1, mins2, maxs2;
230 anode = &sv_areanodes[sv_numareanodes];
233 ClearLink (&anode->trigger_edicts);
234 ClearLink (&anode->solid_edicts);
236 if (depth == AREA_DEPTH)
239 anode->children[0] = anode->children[1] = NULL;
243 VectorSubtract (maxs, mins, size);
244 if (size[0] > size[1])
249 anode->dist = 0.5 * (maxs[anode->axis] + mins[anode->axis]);
250 VectorCopy (mins, mins1);
251 VectorCopy (mins, mins2);
252 VectorCopy (maxs, maxs1);
253 VectorCopy (maxs, maxs2);
255 maxs1[anode->axis] = mins2[anode->axis] = anode->dist;
257 anode->children[0] = SV_CreateAreaNode (depth+1, mins2, maxs2);
258 anode->children[1] = SV_CreateAreaNode (depth+1, mins1, maxs1);
269 void SV_ClearWorld (void)
273 memset (sv_areanodes, 0, sizeof(sv_areanodes));
275 SV_CreateAreaNode (0, sv.worldmodel->mins, sv.worldmodel->maxs);
285 void SV_UnlinkEdict (edict_t *ent)
288 return; // not linked in anywhere
289 RemoveLink (&ent->area);
290 ent->area.prev = ent->area.next = NULL;
299 void SV_TouchLinks ( edict_t *ent, areanode_t *node )
303 int old_self, old_other;
306 // touch linked edicts
307 for (l = node->trigger_edicts.next ; l != &node->trigger_edicts ; l = next)
310 touch = EDICT_FROM_AREA(l);
313 if (!touch->v.touch || touch->v.solid != SOLID_TRIGGER)
315 if (ent->v.absmin[0] > touch->v.absmax[0]
316 || ent->v.absmin[1] > touch->v.absmax[1]
317 || ent->v.absmin[2] > touch->v.absmax[2]
318 || ent->v.absmax[0] < touch->v.absmin[0]
319 || ent->v.absmax[1] < touch->v.absmin[1]
320 || ent->v.absmax[2] < touch->v.absmin[2] )
322 old_self = pr_global_struct->self;
323 old_other = pr_global_struct->other;
325 pr_global_struct->self = EDICT_TO_PROG(touch);
326 pr_global_struct->other = EDICT_TO_PROG(ent);
327 pr_global_struct->time = sv.time;
328 PR_ExecuteProgram (touch->v.touch);
330 pr_global_struct->self = old_self;
331 pr_global_struct->other = old_other;
334 // recurse down both sides
335 if (node->axis == -1)
338 // LordHavoc: optimized recursion
339 // if (ent->v.absmax[node->axis] > node->dist) SV_TouchLinks (ent, node->children[0]);
340 // if (ent->v.absmin[node->axis] < node->dist) SV_TouchLinks (ent, node->children[1]);
341 if (ent->v.absmax[node->axis] > node->dist)
343 if (ent->v.absmin[node->axis] < node->dist)
344 SV_TouchLinks(ent, node->children[1]); // order reversed to reduce code
345 node = node->children[0];
350 if (ent->v.absmin[node->axis] < node->dist)
352 node = node->children[1];
365 void SV_FindTouchedLeafs (edict_t *ent, mnode_t *node)
367 mplane_t *splitplane;
373 if (node->contents == CONTENTS_SOLID)
376 // add an efrag if the node is a leaf
378 if ( node->contents < 0)
380 if (ent->num_leafs == MAX_ENT_LEAFS)
383 leaf = (mleaf_t *)node;
384 leafnum = leaf - sv.worldmodel->leafs - 1;
386 ent->leafnums[ent->num_leafs] = leafnum;
393 splitplane = node->plane;
394 sides = BOX_ON_PLANE_SIDE(ent->v.absmin, ent->v.absmax, splitplane);
396 // recurse down the contacted sides
397 // LordHavoc: optimized recursion
398 // if (sides & 1) SV_FindTouchedLeafs (ent, node->children[0]);
399 // if (sides & 2) SV_FindTouchedLeafs (ent, node->children[1]);
403 node = node->children[0];
406 node = node->children[1];
409 if (node->children[0]->contents != CONTENTS_SOLID)
410 SV_FindTouchedLeafs (ent, node->children[0]);
411 node = node->children[1];
422 void SV_LinkEdict (edict_t *ent, qboolean touch_triggers)
427 SV_UnlinkEdict (ent); // unlink from old position
429 if (ent == sv.edicts)
430 return; // don't add the world
437 // LordHavoc: enabling rotating bmodels
438 if (ent->v.solid == SOLID_BSP && (ent->v.angles[0] || ent->v.angles[1] || ent->v.angles[2]) )
439 { // expand for rotation
444 for (i=0 ; i<3 ; i++)
446 v =fabs( ent->v.mins[i]);
449 v =fabs( ent->v.maxs[i]);
453 for (i=0 ; i<3 ; i++)
455 ent->v.absmin[i] = ent->v.origin[i] - max;
456 ent->v.absmax[i] = ent->v.origin[i] + max;
461 VectorAdd (ent->v.origin, ent->v.mins, ent->v.absmin);
462 VectorAdd (ent->v.origin, ent->v.maxs, ent->v.absmax);
466 // to make items easier to pick up and allow them to be grabbed off
467 // of shelves, the abs sizes are expanded
469 if ((int)ent->v.flags & FL_ITEM)
471 ent->v.absmin[0] -= 15;
472 ent->v.absmin[1] -= 15;
473 ent->v.absmax[0] += 15;
474 ent->v.absmax[1] += 15;
477 { // because movement is clipped an epsilon away from an actual edge,
478 // we must fully check even when bounding boxes don't quite touch
479 ent->v.absmin[0] -= 1;
480 ent->v.absmin[1] -= 1;
481 ent->v.absmin[2] -= 1;
482 ent->v.absmax[0] += 1;
483 ent->v.absmax[1] += 1;
484 ent->v.absmax[2] += 1;
489 if (ent->v.modelindex)
490 SV_FindTouchedLeafs (ent, sv.worldmodel->nodes);
492 if (ent->v.solid == SOLID_NOT)
495 // find the first node that the ent's box crosses
499 if (node->axis == -1)
501 if (ent->v.absmin[node->axis] > node->dist)
502 node = node->children[0];
503 else if (ent->v.absmax[node->axis] < node->dist)
504 node = node->children[1];
506 break; // crosses the node
511 if (ent->v.solid == SOLID_TRIGGER)
512 InsertLinkBefore (&ent->area, &node->trigger_edicts);
514 InsertLinkBefore (&ent->area, &node->solid_edicts);
516 // if touch_triggers, touch all entities at this node and descend for more
518 SV_TouchLinks ( ent, sv_areanodes );
524 ===============================================================================
526 POINT TESTING IN HULLS
528 ===============================================================================
531 // SV_HullPointContents moved to cpu_noasm.c
535 SV_TestEntityPosition
537 This could be a lot more efficient...
540 edict_t *SV_TestEntityPosition (edict_t *ent)
544 trace = SV_Move (ent->v.origin, ent->v.mins, ent->v.maxs, ent->v.origin, 0, ent);
546 if (trace.startsolid)
554 ===============================================================================
556 LINE TESTING IN HULLS
558 ===============================================================================
561 // 1/32 epsilon to keep floating point happy
562 #define DIST_EPSILON (0.03125)
566 SV_RecursiveHullCheck
570 qboolean SV_RecursiveHullCheck (hull_t *hull, int num, float p1f, float p2f, vec3_t p1, vec3_t p2, trace_t *trace)
585 if (num != CONTENTS_SOLID)
587 trace->allsolid = false;
588 if (num == CONTENTS_EMPTY)
589 trace->inopen = true;
591 trace->inwater = true;
594 trace->startsolid = true;
595 return true; // empty
598 if (num < hull->firstclipnode || num > hull->lastclipnode)
599 Sys_Error ("SV_RecursiveHullCheck: bad node number");
602 // find the point distances
604 node = hull->clipnodes + num;
605 plane = hull->planes + node->planenum;
607 t1 = PlaneDiff(p1, plane);
608 t2 = PlaneDiff(p2, plane);
611 if (t1 >= 0 && t2 >= 0)
612 // LordHavoc: optimized recursion
613 // return SV_RecursiveHullCheck (hull, node->children[0], p1f, p2f, p1, p2, trace);
615 num = node->children[0];
618 if (t1 < 0 && t2 < 0)
619 // return SV_RecursiveHullCheck (hull, node->children[1], p1f, p2f, p1, p2, trace);
621 num = node->children[1];
625 if ( (t1 >= DIST_EPSILON && t2 >= DIST_EPSILON) || (t2 > t1 && t1 >= 0) )
626 return SV_RecursiveHullCheck (hull, node->children[0], p1f, p2f, p1, p2, trace);
627 if ( (t1 <= -DIST_EPSILON && t2 <= -DIST_EPSILON) || (t2 < t1 && t1 <= 0) )
628 return SV_RecursiveHullCheck (hull, node->children[1], p1f, p2f, p1, p2, trace);
631 // put the crosspoint DIST_EPSILON pixels on the near side
633 frac = bound(0, (t1 + DIST_EPSILON)/(t1-t2), 1);
635 frac = bound(0, (t1 - DIST_EPSILON)/(t1-t2), 1);
637 midf = p1f + (p2f - p1f)*frac;
638 mid[0] = p1[0] + frac*(p2[0] - p1[0]);
639 mid[1] = p1[1] + frac*(p2[1] - p1[1]);
640 mid[2] = p1[2] + frac*(p2[2] - p1[2]);
644 // move up to the node
645 if (!SV_RecursiveHullCheck (hull, node->children[side], p1f, midf, p1, mid, trace) )
649 if (SV_HullPointContents (hull, node->children[side], mid) == CONTENTS_SOLID)
651 Con_Printf ("mid PointInHullSolid\n");
656 if (SV_HullPointContents (hull, node->children[side^1], mid) != CONTENTS_SOLID)
658 return SV_RecursiveHullCheck (hull, node->children[side^1], midf, p2f, mid, p2, trace);
659 // mid would need to be duplicated during recursion...
664 num = node->children[side^1];
670 return false; // never got out of the solid area
673 // the other side of the node is solid, this is the impact point
677 VectorCopy (plane->normal, trace->plane.normal);
678 trace->plane.dist = plane->dist;
682 // LordHavoc: unrolled vector operation because the compiler can't be sure vec3_origin is 0
683 // VectorSubtract (vec3_origin, plane->normal, trace->plane.normal);
684 trace->plane.normal[0] = -plane->normal[0];
685 trace->plane.normal[1] = -plane->normal[1];
686 trace->plane.normal[2] = -plane->normal[2];
687 trace->plane.dist = -plane->dist;
690 while (SV_HullPointContents (hull, hull->firstclipnode, mid) == CONTENTS_SOLID)
691 { // shouldn't really happen, but does occasionally
695 trace->fraction = midf;
696 VectorCopy (mid, trace->endpos);
697 Con_DPrintf ("backup past 0\n");
700 midf = p1f + (p2f - p1f)*frac;
701 for (i=0 ; i<3 ; i++)
702 mid[i] = p1[i] + frac*(p2[i] - p1[i]);
705 trace->fraction = midf;
706 VectorCopy (mid, trace->endpos);
711 qboolean SV_TestLine (hull_t *hull, int num, vec3_t p1, vec3_t p2)
722 return num != CONTENTS_SOLID;
724 if (num < hull->firstclipnode || num > hull->lastclipnode)
725 Sys_Error ("SV_RecursiveHullCheck: bad node number");
728 // find the point distances
730 node = hull->clipnodes + num;
731 plane = hull->planes + node->planenum;
733 t1 = PlaneDiff(p1, plane);
734 t2 = PlaneDiff(p2, plane);
736 if (t1 >= 0 && t2 >= 0)
738 num = node->children[0];
741 if (t1 < 0 && t2 < 0)
743 num = node->children[1];
747 // put the crosspoint DIST_EPSILON pixels on the near side
751 frac = bound(0, (t1 + DIST_EPSILON)/(t1-t2), 1);
753 frac = bound(0, (t1 - DIST_EPSILON)/(t1-t2), 1);
755 mid[0] = p1[0] + frac*(p2[0] - p1[0]);
756 mid[1] = p1[1] + frac*(p2[1] - p1[1]);
757 mid[2] = p1[2] + frac*(p2[2] - p1[2]);
759 if (node->children[side] < 0)
761 if (node->children[side] == CONTENTS_SOLID)
763 return SV_TestLine(hull, node->children[!side], mid, p2);
764 // num = node->children[!side];
765 // VectorCopy(mid, p1);
768 else if (SV_TestLine(hull, node->children[side], p1, mid))
770 return SV_TestLine(hull, node->children[!side], mid, p2);
771 // num = node->children[!side];
772 // VectorCopy(mid, p1);
784 Handles selection or creation of a clipping hull, and offseting (and
785 eventually rotation) of the end points
788 trace_t SV_ClipMoveToEntity (edict_t *ent, vec3_t start, vec3_t mins, vec3_t maxs, vec3_t end)
792 vec3_t start_l, end_l;
795 // fill in a default trace
796 memset (&trace, 0, sizeof(trace_t));
798 trace.allsolid = true;
799 VectorCopy (end, trace.endpos);
801 // get the clipping hull
802 hull = SV_HullForEntity (ent, mins, maxs, offset);
804 VectorSubtract (start, offset, start_l);
805 VectorSubtract (end, offset, end_l);
807 // LordHavoc: enabling rotating bmodels
808 // rotate start and end into the models frame of reference
809 if (ent->v.solid == SOLID_BSP &&
810 (ent->v.angles[0] || ent->v.angles[1] || ent->v.angles[2]) )
812 vec3_t forward, right, up;
815 AngleVectors (ent->v.angles, forward, right, up);
817 VectorCopy (start_l, temp);
818 start_l[0] = DotProduct (temp, forward);
819 start_l[1] = -DotProduct (temp, right);
820 start_l[2] = DotProduct (temp, up);
822 VectorCopy (end_l, temp);
823 end_l[0] = DotProduct (temp, forward);
824 end_l[1] = -DotProduct (temp, right);
825 end_l[2] = DotProduct (temp, up);
828 // trace a line through the apropriate clipping hull
829 SV_RecursiveHullCheck (hull, hull->firstclipnode, 0, 1, start_l, end_l, &trace);
831 // LordHavoc: enabling rotating bmodels
832 // rotate endpos back to world frame of reference
833 if (ent->v.solid == SOLID_BSP &&
834 (ent->v.angles[0] || ent->v.angles[1] || ent->v.angles[2]) )
837 vec3_t forward, right, up;
840 if (trace.fraction != 1)
842 VectorSubtract (vec3_origin, ent->v.angles, a);
843 AngleVectors (a, forward, right, up);
845 VectorCopy (trace.endpos, temp);
846 trace.endpos[0] = DotProduct (temp, forward);
847 trace.endpos[1] = -DotProduct (temp, right);
848 trace.endpos[2] = DotProduct (temp, up);
850 VectorCopy (trace.plane.normal, temp);
851 trace.plane.normal[0] = DotProduct (temp, forward);
852 trace.plane.normal[1] = -DotProduct (temp, right);
853 trace.plane.normal[2] = DotProduct (temp, up);
857 // fix trace up by the offset
858 if (trace.fraction != 1)
859 VectorAdd (trace.endpos, offset, trace.endpos);
861 // did we clip the move?
862 if (trace.fraction < 1 || trace.startsolid )
868 //===========================================================================
874 Mins and maxs enclose the entire area swept by the move
877 void SV_ClipToLinks ( areanode_t *node, moveclip_t *clip )
884 // touch linked edicts
885 for (l = node->solid_edicts.next ; l != &node->solid_edicts ; l = next)
888 touch = EDICT_FROM_AREA(l);
889 if (touch->v.solid == SOLID_NOT)
891 if (touch == clip->passedict)
893 if (touch->v.solid == SOLID_TRIGGER)
894 Sys_Error ("Trigger in clipping list");
896 if (clip->type == MOVE_NOMONSTERS && touch->v.solid != SOLID_BSP)
899 if (clip->boxmins[0] > touch->v.absmax[0]
900 || clip->boxmins[1] > touch->v.absmax[1]
901 || clip->boxmins[2] > touch->v.absmax[2]
902 || clip->boxmaxs[0] < touch->v.absmin[0]
903 || clip->boxmaxs[1] < touch->v.absmin[1]
904 || clip->boxmaxs[2] < touch->v.absmin[2] )
907 if (clip->passedict!=0 && clip->passedict->v.size[0] && !touch->v.size[0])
908 continue; // points never interact
910 // might intersect, so do an exact clip
911 if (clip->trace.allsolid)
915 if (PROG_TO_EDICT(touch->v.owner) == clip->passedict)
916 continue; // don't clip against own missiles
917 if (PROG_TO_EDICT(clip->passedict->v.owner) == touch)
918 continue; // don't clip against owner
919 // LordHavoc: corpse code
920 if (clip->passedict->v.solid == SOLID_CORPSE && touch->v.solid == SOLID_SLIDEBOX)
922 if (clip->passedict->v.solid == SOLID_SLIDEBOX && touch->v.solid == SOLID_CORPSE)
926 if ((int)touch->v.flags & FL_MONSTER)
927 trace = SV_ClipMoveToEntity (touch, clip->start, clip->mins2, clip->maxs2, clip->end);
929 trace = SV_ClipMoveToEntity (touch, clip->start, clip->mins, clip->maxs, clip->end);
930 if (trace.allsolid || trace.startsolid ||
931 trace.fraction < clip->trace.fraction)
934 if (clip->trace.startsolid)
937 clip->trace.startsolid = true;
942 else if (trace.startsolid)
943 clip->trace.startsolid = true;
946 // recurse down both sides
947 if (node->axis == -1)
950 // LordHavoc: optimized recursion
951 // if (clip->boxmaxs[node->axis] > node->dist) SV_ClipToLinks(node->children[0], clip);
952 // if (clip->boxmins[node->axis] < node->dist) SV_ClipToLinks(node->children[1], clip);
953 if (clip->boxmaxs[node->axis] > node->dist)
955 if (clip->boxmins[node->axis] < node->dist)
956 SV_ClipToLinks(node->children[1], clip);
957 node = node->children[0];
960 else if (clip->boxmins[node->axis] < node->dist)
962 node = node->children[1];
973 void SV_MoveBounds (vec3_t start, vec3_t mins, vec3_t maxs, vec3_t end, vec3_t boxmins, vec3_t boxmaxs)
976 // debug to test against everything
977 boxmins[0] = boxmins[1] = boxmins[2] = -9999;
978 boxmaxs[0] = boxmaxs[1] = boxmaxs[2] = 9999;
982 for (i=0 ; i<3 ; i++)
984 if (end[i] > start[i])
986 boxmins[i] = start[i] + mins[i] - 1;
987 boxmaxs[i] = end[i] + maxs[i] + 1;
991 boxmins[i] = end[i] + mins[i] - 1;
992 boxmaxs[i] = start[i] + maxs[i] + 1;
1003 trace_t SV_Move (vec3_t start, vec3_t mins, vec3_t maxs, vec3_t end, int type, edict_t *passedict)
1008 memset ( &clip, 0, sizeof ( moveclip_t ) );
1011 clip.trace = SV_ClipMoveToEntity ( sv.edicts, start, mins, maxs, end );
1018 clip.passedict = passedict;
1020 if (type == MOVE_MISSILE)
1022 for (i=0 ; i<3 ; i++)
1024 clip.mins2[i] = -15;
1030 VectorCopy (mins, clip.mins2);
1031 VectorCopy (maxs, clip.maxs2);
1034 // create the bounding box of the entire move
1035 SV_MoveBounds ( start, clip.mins2, clip.maxs2, end, clip.boxmins, clip.boxmaxs );
1038 SV_ClipToLinks ( sv_areanodes, &clip );