bmodel rotation physics now work
[xonotic/darkplaces.git] / world.c
1 /*
2 Copyright (C) 1996-1997 Id Software, Inc.
3
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.
8
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.  
12
13 See the GNU General Public License for more details.
14
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.
18
19 */
20 // world.c -- world query functions
21
22 #include "quakedef.h"
23
24 /*
25
26 entities never clip against themselves, or their owner
27
28 line of sight checks trace->crosscontent, but bullets don't
29
30 */
31
32
33 typedef struct
34 {
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
38         float           *start, *end;
39         trace_t         trace;
40         int                     type;
41         edict_t         *passedict;
42 } moveclip_t;
43
44
45 /*
46 ===============================================================================
47
48 HULL BOXES
49
50 ===============================================================================
51 */
52
53
54 static  hull_t          box_hull;
55 static  dclipnode_t     box_clipnodes[6];
56 static  mplane_t        box_planes[6];
57
58 /*
59 ===================
60 SV_InitBoxHull
61
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.
64 ===================
65 */
66 void SV_InitBoxHull (void)
67 {
68         int             i;
69         int             side;
70
71         box_hull.clipnodes = box_clipnodes;
72         box_hull.planes = box_planes;
73         box_hull.firstclipnode = 0;
74         box_hull.lastclipnode = 5;
75
76         for (i=0 ; i<6 ; i++)
77         {
78                 box_clipnodes[i].planenum = i;
79                 
80                 side = i&1;
81                 
82                 box_clipnodes[i].children[side] = CONTENTS_EMPTY;
83                 if (i != 5)
84                         box_clipnodes[i].children[side^1] = i + 1;
85                 else
86                         box_clipnodes[i].children[side^1] = CONTENTS_SOLID;
87                 
88                 box_planes[i].type = i>>1;
89                 box_planes[i].normal[i>>1] = 1;
90         }
91         
92 }
93
94
95 /*
96 ===================
97 SV_HullForBox
98
99 To keep everything totally uniform, bounding boxes are turned into small
100 BSP trees instead of being compared directly.
101 ===================
102 */
103 hull_t  *SV_HullForBox (vec3_t mins, vec3_t maxs)
104 {
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];
111
112         return &box_hull;
113 }
114
115
116
117 /*
118 ================
119 SV_HullForEntity
120
121 Returns a hull that can be used for testing or clipping an object of mins/maxs
122 size.
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.
125 ================
126 */
127 extern qboolean hlbsp;
128 hull_t *SV_HullForEntity (edict_t *ent, vec3_t mins, vec3_t maxs, vec3_t offset)
129 {
130         model_t         *model;
131         vec3_t          size;
132         vec3_t          hullmins, hullmaxs;
133         hull_t          *hull;
134
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");
140
141                 model = sv.models[ (int)ent->v.modelindex ];
142
143                 // LordHavoc: fixed SOLID_BSP error message
144                 if (!model || model->type != mod_brush)
145                 {
146                         Con_Printf ("SOLID_BSP with a non bsp model, entity dump:\n");
147                         ED_Print (ent);
148                         Host_Error ("SOLID_BSP with a non bsp model\n");
149                 }
150
151                 VectorSubtract (maxs, mins, size);
152                 // LordHavoc: FIXME!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
153                 if (hlbsp)
154                 {
155                         if (size[0] < 3)
156                                 hull = &model->hulls[0]; // 0x0x0
157                         else if (size[0] <= 32)
158                         {
159                                 if (size[2] < 54) // pick the nearest of 36 or 72
160                                         hull = &model->hulls[3]; // 32x32x36
161                                 else
162                                         hull = &model->hulls[1]; // 32x32x72
163                         }
164                         else
165                                 hull = &model->hulls[2]; // 64x64x64
166                 }
167                 else
168                 {
169                         if (size[0] < 3)
170                                 hull = &model->hulls[0]; // 0x0x0
171                         else if (size[0] <= 32)
172                                 hull = &model->hulls[1]; // 32x32x56
173                         else
174                                 hull = &model->hulls[2]; // 64x64x88
175                 }
176
177 // calculate an offset value to center the origin
178                 VectorSubtract (hull->clip_mins, mins, offset);
179                 VectorAdd (offset, ent->v.origin, offset);
180         }
181         else
182         {       // create a temp hull from bounding box sizes
183
184                 VectorSubtract (ent->v.mins, maxs, hullmins);
185                 VectorSubtract (ent->v.maxs, mins, hullmaxs);
186                 hull = SV_HullForBox (hullmins, hullmaxs);
187                 
188                 VectorCopy (ent->v.origin, offset);
189         }
190
191
192         return hull;
193 }
194
195 /*
196 ===============================================================================
197
198 ENTITY AREA CHECKING
199
200 ===============================================================================
201 */
202
203 typedef struct areanode_s
204 {
205         int             axis;           // -1 = leaf node
206         float   dist;
207         struct areanode_s       *children[2];
208         link_t  trigger_edicts;
209         link_t  solid_edicts;
210 } areanode_t;
211
212 #define AREA_DEPTH      4
213 #define AREA_NODES      32
214
215 static  areanode_t      sv_areanodes[AREA_NODES];
216 static  int                     sv_numareanodes;
217
218 /*
219 ===============
220 SV_CreateAreaNode
221
222 ===============
223 */
224 areanode_t *SV_CreateAreaNode (int depth, vec3_t mins, vec3_t maxs)
225 {
226         areanode_t      *anode;
227         vec3_t          size;
228         vec3_t          mins1, maxs1, mins2, maxs2;
229
230         anode = &sv_areanodes[sv_numareanodes];
231         sv_numareanodes++;
232
233         ClearLink (&anode->trigger_edicts);
234         ClearLink (&anode->solid_edicts);
235         
236         if (depth == AREA_DEPTH)
237         {
238                 anode->axis = -1;
239                 anode->children[0] = anode->children[1] = NULL;
240                 return anode;
241         }
242         
243         VectorSubtract (maxs, mins, size);
244         if (size[0] > size[1])
245                 anode->axis = 0;
246         else
247                 anode->axis = 1;
248         
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);       
254         
255         maxs1[anode->axis] = mins2[anode->axis] = anode->dist;
256         
257         anode->children[0] = SV_CreateAreaNode (depth+1, mins2, maxs2);
258         anode->children[1] = SV_CreateAreaNode (depth+1, mins1, maxs1);
259
260         return anode;
261 }
262
263 /*
264 ===============
265 SV_ClearWorld
266
267 ===============
268 */
269 void SV_ClearWorld (void)
270 {
271         SV_InitBoxHull ();
272         
273         memset (sv_areanodes, 0, sizeof(sv_areanodes));
274         sv_numareanodes = 0;
275         SV_CreateAreaNode (0, sv.worldmodel->mins, sv.worldmodel->maxs);
276 }
277
278
279 /*
280 ===============
281 SV_UnlinkEdict
282
283 ===============
284 */
285 void SV_UnlinkEdict (edict_t *ent)
286 {
287         if (!ent->area.prev)
288                 return;         // not linked in anywhere
289         RemoveLink (&ent->area);
290         ent->area.prev = ent->area.next = NULL;
291 }
292
293
294 /*
295 ====================
296 SV_TouchLinks
297 ====================
298 */
299 void SV_TouchLinks ( edict_t *ent, areanode_t *node )
300 {
301         link_t          *l, *next;
302         edict_t         *touch;
303         int                     old_self, old_other;
304
305 loc0:
306 // touch linked edicts
307         for (l = node->trigger_edicts.next ; l != &node->trigger_edicts ; l = next)
308         {
309                 next = l->next;
310                 touch = EDICT_FROM_AREA(l);
311                 if (touch == ent)
312                         continue;
313                 if (!touch->v.touch || touch->v.solid != SOLID_TRIGGER)
314                         continue;
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] )
321                         continue;
322                 old_self = pr_global_struct->self;
323                 old_other = pr_global_struct->other;
324
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);
329
330                 pr_global_struct->self = old_self;
331                 pr_global_struct->other = old_other;
332         }
333         
334 // recurse down both sides
335         if (node->axis == -1)
336                 return;
337         
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)
342         {
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];
346                 goto loc0;
347         }
348         else
349         {
350                 if (ent->v.absmin[node->axis] < node->dist)
351                 {
352                         node = node->children[1];
353                         goto loc0;
354                 }
355         }
356 }
357
358
359 /*
360 ===============
361 SV_FindTouchedLeafs
362
363 ===============
364 */
365 void SV_FindTouchedLeafs (edict_t *ent, mnode_t *node)
366 {
367         mplane_t        *splitplane;
368         mleaf_t         *leaf;
369         int                     sides;
370         int                     leafnum;
371
372 loc0:
373         if (node->contents == CONTENTS_SOLID)
374                 return;
375         
376 // add an efrag if the node is a leaf
377
378         if ( node->contents < 0)
379         {
380                 if (ent->num_leafs == MAX_ENT_LEAFS)
381                         return;
382
383                 leaf = (mleaf_t *)node;
384                 leafnum = leaf - sv.worldmodel->leafs - 1;
385
386                 ent->leafnums[ent->num_leafs] = leafnum;
387                 ent->num_leafs++;                       
388                 return;
389         }
390         
391 // NODE_MIXED
392
393         splitplane = node->plane;
394         sides = BOX_ON_PLANE_SIDE(ent->v.absmin, ent->v.absmax, splitplane);
395         
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]);
400         switch (sides)
401         {
402         case 1:
403                 node = node->children[0];
404                 goto loc0;
405         case 2:
406                 node = node->children[1];
407                 goto loc0;
408         default: // 3
409                 if (node->children[0]->contents != CONTENTS_SOLID)
410                         SV_FindTouchedLeafs (ent, node->children[0]);
411                 node = node->children[1];
412                 goto loc0;
413         }
414 }
415
416 /*
417 ===============
418 SV_LinkEdict
419
420 ===============
421 */
422 void SV_LinkEdict (edict_t *ent, qboolean touch_triggers)
423 {
424         areanode_t      *node;
425
426         if (ent->area.prev)
427                 SV_UnlinkEdict (ent);   // unlink from old position
428                 
429         if (ent == sv.edicts)
430                 return;         // don't add the world
431
432         if (ent->free)
433                 return;
434
435 // set the abs box
436
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
440                 float           max, v;
441                 int                     i;
442
443                 max = DotProduct(ent->v.mins, ent->v.mins);
444                 v = DotProduct(ent->v.maxs, ent->v.maxs);
445                 if (max < v)
446                         max = v;
447                 max = sqrt(max);
448                 /*
449                 max = 0;
450                 for (i=0 ; i<3 ; i++)
451                 {
452                         v = fabs(ent->v.mins[i]);
453                         if (max < v)
454                                 max = v;
455                         v = fabs(ent->v.maxs[i]);
456                         if (max < v)
457                                 max = v;
458                 }
459                 */
460                 for (i=0 ; i<3 ; i++)
461                 {
462                         ent->v.absmin[i] = ent->v.origin[i] - max;
463                         ent->v.absmax[i] = ent->v.origin[i] + max;
464                 }
465         }
466         else
467         {
468                 VectorAdd (ent->v.origin, ent->v.mins, ent->v.absmin);  
469                 VectorAdd (ent->v.origin, ent->v.maxs, ent->v.absmax);
470         }
471
472 //
473 // to make items easier to pick up and allow them to be grabbed off
474 // of shelves, the abs sizes are expanded
475 //
476         if ((int)ent->v.flags & FL_ITEM)
477         {
478                 ent->v.absmin[0] -= 15;
479                 ent->v.absmin[1] -= 15;
480                 ent->v.absmax[0] += 15;
481                 ent->v.absmax[1] += 15;
482         }
483         else
484         {       // because movement is clipped an epsilon away from an actual edge,
485                 // we must fully check even when bounding boxes don't quite touch
486                 ent->v.absmin[0] -= 1;
487                 ent->v.absmin[1] -= 1;
488                 ent->v.absmin[2] -= 1;
489                 ent->v.absmax[0] += 1;
490                 ent->v.absmax[1] += 1;
491                 ent->v.absmax[2] += 1;
492         }
493
494 // link to PVS leafs
495         ent->num_leafs = 0;
496         if (ent->v.modelindex)
497                 SV_FindTouchedLeafs (ent, sv.worldmodel->nodes);
498
499         if (ent->v.solid == SOLID_NOT)
500                 return;
501
502 // find the first node that the ent's box crosses
503         node = sv_areanodes;
504         while (1)
505         {
506                 if (node->axis == -1)
507                         break;
508                 if (ent->v.absmin[node->axis] > node->dist)
509                         node = node->children[0];
510                 else if (ent->v.absmax[node->axis] < node->dist)
511                         node = node->children[1];
512                 else
513                         break;          // crosses the node
514         }
515
516 // link it in   
517
518         if (ent->v.solid == SOLID_TRIGGER)
519                 InsertLinkBefore (&ent->area, &node->trigger_edicts);
520         else
521                 InsertLinkBefore (&ent->area, &node->solid_edicts);
522         
523 // if touch_triggers, touch all entities at this node and descend for more
524         if (touch_triggers)
525                 SV_TouchLinks ( ent, sv_areanodes );
526 }
527
528
529
530 /*
531 ===============================================================================
532
533 POINT TESTING IN HULLS
534
535 ===============================================================================
536 */
537
538 // SV_HullPointContents moved to cpu_noasm.c
539
540 /*
541 ============
542 SV_TestEntityPosition
543
544 This could be a lot more efficient...
545 ============
546 */
547 edict_t *SV_TestEntityPosition (edict_t *ent)
548 {
549         trace_t trace;
550
551         trace = SV_Move (ent->v.origin, ent->v.mins, ent->v.maxs, ent->v.origin, 0, ent);
552         
553         if (trace.startsolid)
554                 return sv.edicts;
555                 
556         return NULL;
557 }
558
559
560 /*
561 ===============================================================================
562
563 LINE TESTING IN HULLS
564
565 ===============================================================================
566 */
567
568 // 1/32 epsilon to keep floating point happy
569 #define DIST_EPSILON    (0.03125)
570
571 /*
572 ==================
573 SV_RecursiveHullCheck
574
575 ==================
576 */
577 /*
578 qboolean SV_RecursiveHullCheck (hull_t *hull, int num, float p1f, float p2f, vec3_t p1, vec3_t p2, trace_t *trace)
579 {
580         dclipnode_t     *node;
581         mplane_t        *plane;
582         float           t1, t2;
583         float           frac;
584         int                     i;
585         vec3_t          mid;
586         int                     side;
587         float           midf;
588
589 loc0:
590 // check for empty
591         if (num < 0)
592         {
593                 if (num != CONTENTS_SOLID)
594                 {
595                         trace->allsolid = false;
596                         if (num == CONTENTS_EMPTY)
597                                 trace->inopen = true;
598                         else
599                                 trace->inwater = true;
600                 }
601                 else
602                         trace->startsolid = true;
603                 return true;            // empty
604         }
605
606         if (num < hull->firstclipnode || num > hull->lastclipnode)
607                 Sys_Error ("SV_RecursiveHullCheck: bad node number");
608
609 //
610 // find the point distances
611 //
612         node = hull->clipnodes + num;
613         plane = hull->planes + node->planenum;
614
615         t1 = PlaneDiff(p1, plane);
616         t2 = PlaneDiff(p2, plane);
617         
618 #if 1
619         if (t1 >= 0 && t2 >= 0)
620         // LordHavoc: optimized recursion
621 //              return SV_RecursiveHullCheck (hull, node->children[0], p1f, p2f, p1, p2, trace);
622         {
623                 num = node->children[0];
624                 goto loc0;
625         }
626         if (t1 < 0 && t2 < 0)
627 //              return SV_RecursiveHullCheck (hull, node->children[1], p1f, p2f, p1, p2, trace);
628         {
629                 num = node->children[1];
630                 goto loc0;
631         }
632 #else
633         if ( (t1 >= DIST_EPSILON && t2 >= DIST_EPSILON) || (t2 > t1 && t1 >= 0) )
634                 return SV_RecursiveHullCheck (hull, node->children[0], p1f, p2f, p1, p2, trace);
635         if ( (t1 <= -DIST_EPSILON && t2 <= -DIST_EPSILON) || (t2 < t1 && t1 <= 0) )
636                 return SV_RecursiveHullCheck (hull, node->children[1], p1f, p2f, p1, p2, trace);
637 #endif
638
639 // put the crosspoint DIST_EPSILON pixels on the near side
640         if (t1 < 0)
641                 frac = bound(0, (t1 + DIST_EPSILON)/(t1-t2), 1);
642         else
643                 frac = bound(0, (t1 - DIST_EPSILON)/(t1-t2), 1);
644                 
645         midf = p1f + (p2f - p1f)*frac;
646         mid[0] = p1[0] + frac*(p2[0] - p1[0]);
647         mid[1] = p1[1] + frac*(p2[1] - p1[1]);
648         mid[2] = p1[2] + frac*(p2[2] - p1[2]);
649
650         side = (t1 < 0);
651
652 // move up to the node
653         if (!SV_RecursiveHullCheck (hull, node->children[side], p1f, midf, p1, mid, trace) )
654                 return false;
655
656 #ifdef PARANOID
657         if (SV_HullPointContents (hull, node->children[side], mid) == CONTENTS_SOLID)
658         {
659                 Con_Printf ("mid PointInHullSolid\n");
660                 return false;
661         }
662 #endif
663
664         if (SV_HullPointContents (hull, node->children[side^1], mid) != CONTENTS_SOLID)
665 // go past the node
666                 return SV_RecursiveHullCheck (hull, node->children[side^1], midf, p2f, mid, p2, trace);
667         // mid would need to be duplicated during recursion...
668 */
669         /*
670         {
671                 p1f = midf;
672                 p1 = mid;
673                 num = node->children[side^1];
674                 goto loc0;
675         }
676         */
677 /*
678
679         if (trace->allsolid)
680                 return false;           // never got out of the solid area
681         
682 //==================
683 // the other side of the node is solid, this is the impact point
684 //==================
685         if (!side)
686         {
687                 VectorCopy (plane->normal, trace->plane.normal);
688                 trace->plane.dist = plane->dist;
689         }
690         else
691         {
692                 // LordHavoc: unrolled vector operation because the compiler can't be sure vec3_origin is 0
693 //              VectorSubtract (vec3_origin, plane->normal, trace->plane.normal);
694                 trace->plane.normal[0] = -plane->normal[0];
695                 trace->plane.normal[1] = -plane->normal[1];
696                 trace->plane.normal[2] = -plane->normal[2];
697                 trace->plane.dist = -plane->dist;
698         }
699
700         while (SV_HullPointContents (hull, hull->firstclipnode, mid) == CONTENTS_SOLID)
701         { // shouldn't really happen, but does occasionally
702                 frac -= 0.1;
703                 if (frac < 0)
704                 {
705                         trace->fraction = midf;
706                         VectorCopy (mid, trace->endpos);
707                         Con_DPrintf ("backup past 0\n");
708                         return false;
709                 }
710                 midf = p1f + (p2f - p1f)*frac;
711                 for (i=0 ; i<3 ; i++)
712                         mid[i] = p1[i] + frac*(p2[i] - p1[i]);
713         }
714
715         trace->fraction = midf;
716         VectorCopy (mid, trace->endpos);
717
718         return false;
719 }
720 */
721
722 // LordHavoc: backported from my optimizations to PM_RecursiveHullCheck in QuakeForge newtree (QW)
723 qboolean SV_RecursiveHullCheck (hull_t *hull, int num, float p1f, float p2f, vec3_t p1, vec3_t p2, trace_t *trace)
724 {
725         dclipnode_t     *node;
726         mplane_t        *plane;
727         float           t1, t2;
728         float           frac;
729         int                     i;
730         vec3_t          mid;
731         int                     side;
732         float           midf;
733
734         // LordHavoc: a goto!  everyone flee in terror... :)
735 loc0:
736 // check for empty
737         if (num < 0)
738         {
739                 if (num != CONTENTS_SOLID)
740                 {
741                         trace->allsolid = false;
742                         if (num == CONTENTS_EMPTY)
743                                 trace->inopen = true;
744                         else
745                                 trace->inwater = true;
746                 }
747                 else
748                         trace->startsolid = true;
749                 return true;            // empty
750         }
751
752         // LordHavoc: this can be eliminated by validating in the loader...  but Mercury told me not to bother
753         if (num < hull->firstclipnode || num > hull->lastclipnode)
754                 Sys_Error ("SV_RecursiveHullCheck: bad node number");
755
756 // find the point distances
757         node = hull->clipnodes + num;
758         plane = hull->planes + node->planenum;
759
760         if (plane->type < 3)
761         {
762                 t1 = p1[plane->type] - plane->dist;
763                 t2 = p2[plane->type] - plane->dist;
764         }
765         else
766         {
767                 t1 = DotProduct (plane->normal, p1) - plane->dist;
768                 t2 = DotProduct (plane->normal, p2) - plane->dist;
769         }
770
771         // LordHavoc: recursion optimization
772         if (t1 >= 0 && t2 >= 0)
773         {
774                 num = node->children[0];
775                 goto loc0;
776         }
777         if (t1 < 0 && t2 < 0)
778         {
779                 num = node->children[1];
780                 goto loc0;
781         }
782
783 // put the crosspoint DIST_EPSILON pixels on the near side
784         side = (t1 < 0);
785         if (side)
786                 frac = bound(0, (t1 + DIST_EPSILON) / (t1 - t2), 1);
787         else
788                 frac = bound(0, (t1 - DIST_EPSILON) / (t1 - t2), 1);
789                 
790         midf = p1f + (p2f - p1f)*frac;
791         for (i=0 ; i<3 ; i++)
792                 mid[i] = p1[i] + frac*(p2[i] - p1[i]);
793
794 // move up to the node
795         if (!SV_RecursiveHullCheck (hull, node->children[side], p1f, midf, p1, mid, trace) )
796                 return false;
797
798 #ifdef PARANOID
799         if (SV_HullPointContents (pm_hullmodel, mid, node->children[side]) == CONTENTS_SOLID)
800         {
801                 Con_Printf ("mid PointInHullSolid\n");
802                 return false;
803         }
804 #endif
805
806         // LordHavoc: warning to the clumsy, this recursion can not be optimized because mid would need to be duplicated on a stack
807         if (SV_HullPointContents (hull, node->children[side^1], mid) != CONTENTS_SOLID)
808 // go past the node
809                 return SV_RecursiveHullCheck (hull, node->children[side^1], midf, p2f, mid, p2, trace);
810         
811         if (trace->allsolid)
812                 return false;           // never got out of the solid area
813                 
814 //==================
815 // the other side of the node is solid, this is the impact point
816 //==================
817         if (!side)
818         {
819                 VectorCopy (plane->normal, trace->plane.normal);
820                 trace->plane.dist = plane->dist;
821         }
822         else
823         {
824                 // LordHavoc: vec3_origin is evil; the compiler can not rely on it being '0 0 0'
825 //              VectorSubtract (vec3_origin, plane->normal, trace->plane.normal);
826                 trace->plane.normal[0] = -plane->normal[0];
827                 trace->plane.normal[1] = -plane->normal[1];
828                 trace->plane.normal[2] = -plane->normal[2];
829                 trace->plane.dist = -plane->dist;
830         }
831
832         while (SV_HullPointContents (hull, hull->firstclipnode, mid) == CONTENTS_SOLID)
833         { // shouldn't really happen, but does occasionally
834                 frac -= 0.1;
835                 if (frac < 0)
836                 {
837                         trace->fraction = midf;
838                         VectorCopy (mid, trace->endpos);
839                         Con_DPrintf ("backup past 0\n");
840                         return false;
841                 }
842                 midf = p1f + (p2f - p1f)*frac;
843                 for (i=0 ; i<3 ; i++)
844                         mid[i] = p1[i] + frac*(p2[i] - p1[i]);
845         }
846
847         trace->fraction = midf;
848         VectorCopy (mid, trace->endpos);
849
850         return false;
851 }
852
853 qboolean SV_TestLine (hull_t *hull, int num, vec3_t p1, vec3_t p2)
854 {
855         dclipnode_t     *node;
856         mplane_t        *plane;
857         float           t1, t2, frac;
858         vec3_t          mid;
859         int                     side;
860
861 loc0:
862 // check for empty
863         if (num < 0)
864                 return num != CONTENTS_SOLID;
865
866         if (num < hull->firstclipnode || num > hull->lastclipnode)
867                 Sys_Error ("SV_RecursiveHullCheck: bad node number");
868
869 //
870 // find the point distances
871 //
872         node = hull->clipnodes + num;
873         plane = hull->planes + node->planenum;
874
875         t1 = PlaneDiff(p1, plane);
876         t2 = PlaneDiff(p2, plane);
877         
878         if (t1 >= 0 && t2 >= 0)
879         {
880                 num = node->children[0];
881                 goto loc0;
882         }
883         if (t1 < 0 && t2 < 0)
884         {
885                 num = node->children[1];
886                 goto loc0;
887         }
888
889 // put the crosspoint DIST_EPSILON pixels on the near side
890         side = (t1 < 0);
891
892         if (side)
893                 frac = bound(0, (t1 + DIST_EPSILON)/(t1-t2), 1);
894         else
895                 frac = bound(0, (t1 - DIST_EPSILON)/(t1-t2), 1);
896                 
897         mid[0] = p1[0] + frac*(p2[0] - p1[0]);
898         mid[1] = p1[1] + frac*(p2[1] - p1[1]);
899         mid[2] = p1[2] + frac*(p2[2] - p1[2]);
900
901         if (node->children[side] < 0)
902         {
903                 if (node->children[side] == CONTENTS_SOLID)
904                         return false;
905                 return SV_TestLine(hull, node->children[!side], mid, p2);
906         }
907         else if (SV_TestLine(hull, node->children[side], p1, mid))
908                 return SV_TestLine(hull, node->children[!side], mid, p2);
909         else
910                 return false;
911 }
912
913
914 /*
915 ==================
916 SV_ClipMoveToEntity
917
918 Handles selection or creation of a clipping hull, and offseting (and
919 eventually rotation) of the end points
920 ==================
921 */
922 trace_t SV_ClipMoveToEntity (edict_t *ent, vec3_t start, vec3_t mins, vec3_t maxs, vec3_t end)
923 {
924         trace_t         trace;
925         vec3_t          offset;
926         vec3_t          start_l, end_l;
927         hull_t          *hull;
928
929 // fill in a default trace
930         memset (&trace, 0, sizeof(trace_t));
931         trace.fraction = 1;
932         trace.allsolid = true;
933         VectorCopy (end, trace.endpos);
934
935 // get the clipping hull
936         hull = SV_HullForEntity (ent, mins, maxs, offset);
937
938         VectorSubtract (start, offset, start_l);
939         VectorSubtract (end, offset, end_l);
940
941 // LordHavoc: enabling rotating bmodels
942         // rotate start and end into the models frame of reference
943         if (ent->v.solid == SOLID_BSP && (ent->v.angles[0] || ent->v.angles[1] || ent->v.angles[2]))
944         {
945                 vec3_t  forward, right, up;
946                 vec3_t  temp;
947
948                 AngleVectors (ent->v.angles, forward, right, up);
949
950                 VectorCopy (start_l, temp);
951                 start_l[0] = DotProduct (temp, forward);
952                 start_l[1] = -DotProduct (temp, right);
953                 start_l[2] = DotProduct (temp, up);
954
955                 VectorCopy (end_l, temp);
956                 end_l[0] = DotProduct (temp, forward);
957                 end_l[1] = -DotProduct (temp, right);
958                 end_l[2] = DotProduct (temp, up);
959         }
960
961 // trace a line through the apropriate clipping hull
962         SV_RecursiveHullCheck (hull, hull->firstclipnode, 0, 1, start_l, end_l, &trace);
963
964 // LordHavoc: enabling rotating bmodels
965         // rotate endpos back to world frame of reference
966         if (ent->v.solid == SOLID_BSP && (ent->v.angles[0] || ent->v.angles[1] || ent->v.angles[2]))
967         {
968                 vec3_t  a;
969                 vec3_t  forward, right, up;
970                 vec3_t  temp;
971
972                 if (trace.fraction != 1)
973                 {
974                         VectorSubtract (vec3_origin, ent->v.angles, a);
975                         AngleVectors (a, forward, right, up);
976
977                         VectorCopy (trace.endpos, temp);
978                         trace.endpos[0] = DotProduct (temp, forward);
979                         trace.endpos[1] = -DotProduct (temp, right);
980                         trace.endpos[2] = DotProduct (temp, up);
981
982                         VectorCopy (trace.plane.normal, temp);
983                         trace.plane.normal[0] = DotProduct (temp, forward);
984                         trace.plane.normal[1] = -DotProduct (temp, right);
985                         trace.plane.normal[2] = DotProduct (temp, up);
986                 }
987         }
988
989 // fix trace up by the offset
990         if (trace.fraction != 1)
991                 VectorAdd (trace.endpos, offset, trace.endpos);
992
993 // did we clip the move?
994         if (trace.fraction < 1 || trace.startsolid  )
995                 trace.ent = ent;
996
997         return trace;
998 }
999
1000 //===========================================================================
1001
1002 /*
1003 ====================
1004 SV_ClipToLinks
1005
1006 Mins and maxs enclose the entire area swept by the move
1007 ====================
1008 */
1009 void SV_ClipToLinks ( areanode_t *node, moveclip_t *clip )
1010 {
1011         link_t          *l, *next;
1012         edict_t         *touch;
1013         trace_t         trace;
1014
1015 loc0:
1016 // touch linked edicts
1017         for (l = node->solid_edicts.next ; l != &node->solid_edicts ; l = next)
1018         {
1019                 next = l->next;
1020                 touch = EDICT_FROM_AREA(l);
1021                 if (touch->v.solid == SOLID_NOT)
1022                         continue;
1023                 if (touch == clip->passedict)
1024                         continue;
1025                 if (touch->v.solid == SOLID_TRIGGER)
1026                         Sys_Error ("Trigger in clipping list");
1027
1028                 if (clip->type == MOVE_NOMONSTERS && touch->v.solid != SOLID_BSP)
1029                         continue;
1030
1031                 if (clip->boxmins[0] > touch->v.absmax[0]
1032                 || clip->boxmins[1] > touch->v.absmax[1]
1033                 || clip->boxmins[2] > touch->v.absmax[2]
1034                 || clip->boxmaxs[0] < touch->v.absmin[0]
1035                 || clip->boxmaxs[1] < touch->v.absmin[1]
1036                 || clip->boxmaxs[2] < touch->v.absmin[2] )
1037                         continue;
1038
1039                 if (clip->passedict!=0 && clip->passedict->v.size[0] && !touch->v.size[0])
1040                         continue;       // points never interact
1041
1042         // might intersect, so do an exact clip
1043                 if (clip->trace.allsolid)
1044                         return;
1045                 if (clip->passedict)
1046                 {
1047                         if (PROG_TO_EDICT(touch->v.owner) == clip->passedict)
1048                                 continue;       // don't clip against own missiles
1049                         if (PROG_TO_EDICT(clip->passedict->v.owner) == touch)
1050                                 continue;       // don't clip against owner
1051                         // LordHavoc: corpse code
1052                         if (clip->passedict->v.solid == SOLID_CORPSE && touch->v.solid == SOLID_SLIDEBOX)
1053                                 continue;
1054                         if (clip->passedict->v.solid == SOLID_SLIDEBOX && touch->v.solid == SOLID_CORPSE)
1055                                 continue;
1056                 }
1057
1058                 if ((int)touch->v.flags & FL_MONSTER)
1059                         trace = SV_ClipMoveToEntity (touch, clip->start, clip->mins2, clip->maxs2, clip->end);
1060                 else
1061                         trace = SV_ClipMoveToEntity (touch, clip->start, clip->mins, clip->maxs, clip->end);
1062                 if (trace.allsolid || trace.startsolid ||
1063                 trace.fraction < clip->trace.fraction)
1064                 {
1065                         trace.ent = touch;
1066                         if (clip->trace.startsolid)
1067                         {
1068                                 clip->trace = trace;
1069                                 clip->trace.startsolid = true;
1070                         }
1071                         else
1072                                 clip->trace = trace;
1073                 }
1074                 else if (trace.startsolid)
1075                         clip->trace.startsolid = true;
1076         }
1077         
1078 // recurse down both sides
1079         if (node->axis == -1)
1080                 return;
1081
1082         // LordHavoc: optimized recursion
1083 //      if (clip->boxmaxs[node->axis] > node->dist) SV_ClipToLinks(node->children[0], clip);
1084 //      if (clip->boxmins[node->axis] < node->dist) SV_ClipToLinks(node->children[1], clip);
1085         if (clip->boxmaxs[node->axis] > node->dist)
1086         {
1087                 if (clip->boxmins[node->axis] < node->dist)
1088                         SV_ClipToLinks(node->children[1], clip);
1089                 node = node->children[0];
1090                 goto loc0;
1091         }
1092         else if (clip->boxmins[node->axis] < node->dist)
1093         {
1094                 node = node->children[1];
1095                 goto loc0;
1096         }
1097 }
1098
1099
1100 /*
1101 ==================
1102 SV_MoveBounds
1103 ==================
1104 */
1105 void SV_MoveBounds (vec3_t start, vec3_t mins, vec3_t maxs, vec3_t end, vec3_t boxmins, vec3_t boxmaxs)
1106 {
1107 #if 0
1108 // debug to test against everything
1109 boxmins[0] = boxmins[1] = boxmins[2] = -9999;
1110 boxmaxs[0] = boxmaxs[1] = boxmaxs[2] = 9999;
1111 #else
1112         int             i;
1113         
1114         for (i=0 ; i<3 ; i++)
1115         {
1116                 if (end[i] > start[i])
1117                 {
1118                         boxmins[i] = start[i] + mins[i] - 1;
1119                         boxmaxs[i] = end[i] + maxs[i] + 1;
1120                 }
1121                 else
1122                 {
1123                         boxmins[i] = end[i] + mins[i] - 1;
1124                         boxmaxs[i] = start[i] + maxs[i] + 1;
1125                 }
1126         }
1127 #endif
1128 }
1129
1130 /*
1131 ==================
1132 SV_Move
1133 ==================
1134 */
1135 trace_t SV_Move (vec3_t start, vec3_t mins, vec3_t maxs, vec3_t end, int type, edict_t *passedict)
1136 {
1137         moveclip_t      clip;
1138         int                     i;
1139
1140         memset ( &clip, 0, sizeof ( moveclip_t ) );
1141
1142 // clip to world
1143         clip.trace = SV_ClipMoveToEntity ( sv.edicts, start, mins, maxs, end );
1144
1145         clip.start = start;
1146         clip.end = end;
1147         clip.mins = mins;
1148         clip.maxs = maxs;
1149         clip.type = type;
1150         clip.passedict = passedict;
1151
1152         if (type == MOVE_MISSILE)
1153         {
1154                 for (i=0 ; i<3 ; i++)
1155                 {
1156                         clip.mins2[i] = -15;
1157                         clip.maxs2[i] = 15;
1158                 }
1159         }
1160         else
1161         {
1162                 VectorCopy (mins, clip.mins2);
1163                 VectorCopy (maxs, clip.maxs2);
1164         }
1165         
1166 // create the bounding box of the entire move
1167         SV_MoveBounds ( start, clip.mins2, clip.maxs2, end, clip.boxmins, clip.boxmaxs );
1168
1169 // clip to entities
1170         SV_ClipToLinks ( sv_areanodes, &clip );
1171
1172         return clip.trace;
1173 }