added in_pitch_min and in_pitch_max cvars to limit pitch (default: -90 to +90)
[divverent/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 link_s
34 {
35         struct link_s   *prev, *next;
36 } link_t;
37 */
38
39
40 void ClearLink (link_t *l);
41 void RemoveLink (link_t *l);
42 void InsertLinkBefore (link_t *l, link_t *before);
43 void InsertLinkAfter (link_t *l, link_t *after);
44
45 // (type *)STRUCT_FROM_LINK(link_t *link, type, member)
46 // ent = STRUCT_FROM_LINK(link,entity_t,order)
47 // FIXME: remove this mess!
48 //#define       STRUCT_FROM_LINK(l,t,m) ((t *)((byte *)l - (int)&(((t *)0)->m)))
49
50 #define EDICT_FROM_AREA(l) ((edict_t *)((byte *)l - (int)&(((edict_t *)0)->area)))
51
52 //============================================================================
53
54 // ClearLink is used for new headnodes
55 void ClearLink (link_t *l)
56 {
57         l->prev = l->next = l;
58 }
59
60 void RemoveLink (link_t *l)
61 {
62         l->next->prev = l->prev;
63         l->prev->next = l->next;
64 }
65
66 void InsertLinkBefore (link_t *l, link_t *before)
67 {
68         l->next = before;
69         l->prev = before->prev;
70         l->prev->next = l;
71         l->next->prev = l;
72 }
73 void InsertLinkAfter (link_t *l, link_t *after)
74 {
75         l->next = after->next;
76         l->prev = after;
77         l->prev->next = l;
78         l->next->prev = l;
79 }
80
81
82 typedef struct
83 {
84         vec3_t          boxmins, boxmaxs;// enclose the test object along entire move
85         float           *mins, *maxs;   // size of the moving object
86         vec3_t          mins2, maxs2;   // size when clipping against mosnters
87         float           *start, *end;
88         trace_t         trace;
89         int                     type;
90         edict_t         *passedict;
91 } moveclip_t;
92
93
94 /*
95 ===============================================================================
96
97 HULL BOXES
98
99 ===============================================================================
100 */
101
102
103 static  hull_t          box_hull;
104 static  dclipnode_t     box_clipnodes[6];
105 static  mplane_t        box_planes[6];
106
107 /*
108 ===================
109 SV_InitBoxHull
110
111 Set up the planes and clipnodes so that the six floats of a bounding box
112 can just be stored out and get a proper hull_t structure.
113 ===================
114 */
115 void SV_InitBoxHull (void)
116 {
117         int             i;
118         int             side;
119
120         box_hull.clipnodes = box_clipnodes;
121         box_hull.planes = box_planes;
122         box_hull.firstclipnode = 0;
123         box_hull.lastclipnode = 5;
124
125         for (i=0 ; i<6 ; i++)
126         {
127                 box_clipnodes[i].planenum = i;
128                 
129                 side = i&1;
130                 
131                 box_clipnodes[i].children[side] = CONTENTS_EMPTY;
132                 if (i != 5)
133                         box_clipnodes[i].children[side^1] = i + 1;
134                 else
135                         box_clipnodes[i].children[side^1] = CONTENTS_SOLID;
136                 
137                 box_planes[i].type = i>>1;
138                 box_planes[i].normal[i>>1] = 1;
139         }
140         
141 }
142
143
144 /*
145 ===================
146 SV_HullForBox
147
148 To keep everything totally uniform, bounding boxes are turned into small
149 BSP trees instead of being compared directly.
150 ===================
151 */
152 hull_t  *SV_HullForBox (vec3_t mins, vec3_t maxs)
153 {
154         box_planes[0].dist = maxs[0];
155         box_planes[1].dist = mins[0];
156         box_planes[2].dist = maxs[1];
157         box_planes[3].dist = mins[1];
158         box_planes[4].dist = maxs[2];
159         box_planes[5].dist = mins[2];
160
161         return &box_hull;
162 }
163
164
165
166 /*
167 ================
168 SV_HullForEntity
169
170 Returns a hull that can be used for testing or clipping an object of mins/maxs
171 size.
172 Offset is filled in to contain the adjustment that must be added to the
173 testing object's origin to get a point to use with the returned hull.
174 ================
175 */
176 hull_t *SV_HullForEntity (edict_t *ent, vec3_t mins, vec3_t maxs, vec3_t offset)
177 {
178         model_t         *model;
179         vec3_t          size;
180         vec3_t          hullmins, hullmaxs;
181         hull_t          *hull;
182
183 // decide which clipping hull to use, based on the size
184         if (ent->v.solid == SOLID_BSP)
185         {       // explicit hulls in the BSP model
186                 if (ent->v.movetype != MOVETYPE_PUSH)
187                         Host_Error ("SOLID_BSP without MOVETYPE_PUSH");
188
189                 model = sv.models[ (int)ent->v.modelindex ];
190                 Mod_CheckLoaded(model);
191
192                 // LordHavoc: fixed SOLID_BSP error message
193                 if (!model || model->type != mod_brush)
194                 {
195                         Con_Printf ("SOLID_BSP with a non bsp model, entity dump:\n");
196                         ED_Print (ent);
197                         Host_Error ("SOLID_BSP with a non bsp model\n");
198                 }
199
200                 VectorSubtract (maxs, mins, size);
201                 // LordHavoc: FIXME!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
202                 if (sv.worldmodel->ishlbsp)
203                 {
204                         if (size[0] < 3)
205                                 hull = &model->hulls[0]; // 0x0x0
206                         else if (size[0] <= 32)
207                         {
208                                 if (size[2] < 54) // pick the nearest of 36 or 72
209                                         hull = &model->hulls[3]; // 32x32x36
210                                 else
211                                         hull = &model->hulls[1]; // 32x32x72
212                         }
213                         else
214                                 hull = &model->hulls[2]; // 64x64x64
215                 }
216                 else
217                 {
218                         if (size[0] < 3)
219                                 hull = &model->hulls[0]; // 0x0x0
220                         else if (size[0] <= 32)
221                                 hull = &model->hulls[1]; // 32x32x56
222                         else
223                                 hull = &model->hulls[2]; // 64x64x88
224                 }
225
226 // calculate an offset value to center the origin
227                 VectorSubtract (hull->clip_mins, mins, offset);
228                 VectorAdd (offset, ent->v.origin, offset);
229         }
230         else
231         {       // create a temp hull from bounding box sizes
232
233                 VectorSubtract (ent->v.mins, maxs, hullmins);
234                 VectorSubtract (ent->v.maxs, mins, hullmaxs);
235                 hull = SV_HullForBox (hullmins, hullmaxs);
236
237                 VectorCopy (ent->v.origin, offset);
238         }
239
240
241         return hull;
242 }
243
244 /*
245 ===============================================================================
246
247 ENTITY AREA CHECKING
248
249 ===============================================================================
250 */
251
252 typedef struct areanode_s
253 {
254         int             axis;           // -1 = leaf node
255         float   dist;
256         struct areanode_s       *children[2];
257         link_t  trigger_edicts;
258         link_t  solid_edicts;
259 } areanode_t;
260
261 #define AREA_DEPTH      4
262 #define AREA_NODES      32
263
264 static  areanode_t      sv_areanodes[AREA_NODES];
265 static  int                     sv_numareanodes;
266
267 /*
268 ===============
269 SV_CreateAreaNode
270
271 ===============
272 */
273 areanode_t *SV_CreateAreaNode (int depth, vec3_t mins, vec3_t maxs)
274 {
275         areanode_t      *anode;
276         vec3_t          size;
277         vec3_t          mins1, maxs1, mins2, maxs2;
278
279         anode = &sv_areanodes[sv_numareanodes];
280         sv_numareanodes++;
281
282         ClearLink (&anode->trigger_edicts);
283         ClearLink (&anode->solid_edicts);
284
285         if (depth == AREA_DEPTH)
286         {
287                 anode->axis = -1;
288                 anode->children[0] = anode->children[1] = NULL;
289                 return anode;
290         }
291
292         VectorSubtract (maxs, mins, size);
293         if (size[0] > size[1])
294                 anode->axis = 0;
295         else
296                 anode->axis = 1;
297
298         anode->dist = 0.5 * (maxs[anode->axis] + mins[anode->axis]);
299         VectorCopy (mins, mins1);
300         VectorCopy (mins, mins2);
301         VectorCopy (maxs, maxs1);
302         VectorCopy (maxs, maxs2);
303
304         maxs1[anode->axis] = mins2[anode->axis] = anode->dist;
305
306         anode->children[0] = SV_CreateAreaNode (depth+1, mins2, maxs2);
307         anode->children[1] = SV_CreateAreaNode (depth+1, mins1, maxs1);
308
309         return anode;
310 }
311
312 /*
313 ===============
314 SV_ClearWorld
315
316 ===============
317 */
318 void SV_ClearWorld (void)
319 {
320         SV_InitBoxHull ();
321
322         memset (sv_areanodes, 0, sizeof(sv_areanodes));
323         sv_numareanodes = 0;
324         Mod_CheckLoaded(sv.worldmodel);
325         SV_CreateAreaNode (0, sv.worldmodel->normalmins, sv.worldmodel->normalmaxs);
326 }
327
328
329 /*
330 ===============
331 SV_UnlinkEdict
332
333 ===============
334 */
335 void SV_UnlinkEdict (edict_t *ent)
336 {
337         if (!ent->area.prev)
338                 return;         // not linked in anywhere
339         RemoveLink (&ent->area);
340         ent->area.prev = ent->area.next = NULL;
341 }
342
343
344 /*
345 ====================
346 SV_TouchLinks
347 ====================
348 */
349 void SV_TouchLinks ( edict_t *ent, areanode_t *node )
350 {
351         link_t          *l, *next;
352         edict_t         *touch;
353         int                     old_self, old_other;
354
355 loc0:
356 // touch linked edicts
357         for (l = node->trigger_edicts.next ; l != &node->trigger_edicts ; l = next)
358         {
359                 next = l->next;
360                 touch = EDICT_FROM_AREA(l);
361                 if (touch == ent)
362                         continue;
363                 if (!touch->v.touch || touch->v.solid != SOLID_TRIGGER)
364                         continue;
365                 if (ent->v.absmin[0] > touch->v.absmax[0]
366                  || ent->v.absmin[1] > touch->v.absmax[1]
367                  || ent->v.absmin[2] > touch->v.absmax[2]
368                  || ent->v.absmax[0] < touch->v.absmin[0]
369                  || ent->v.absmax[1] < touch->v.absmin[1]
370                  || ent->v.absmax[2] < touch->v.absmin[2])
371                         continue;
372                 old_self = pr_global_struct->self;
373                 old_other = pr_global_struct->other;
374
375                 pr_global_struct->self = EDICT_TO_PROG(touch);
376                 pr_global_struct->other = EDICT_TO_PROG(ent);
377                 pr_global_struct->time = sv.time;
378                 PR_ExecuteProgram (touch->v.touch, "");
379
380                 pr_global_struct->self = old_self;
381                 pr_global_struct->other = old_other;
382         }
383
384 // recurse down both sides
385         if (node->axis == -1)
386                 return;
387
388         // LordHavoc: optimized recursion
389 //      if (ent->v.absmax[node->axis] > node->dist) SV_TouchLinks (ent, node->children[0]);
390 //      if (ent->v.absmin[node->axis] < node->dist) SV_TouchLinks (ent, node->children[1]);
391         if (ent->v.absmax[node->axis] > node->dist)
392         {
393                 if (ent->v.absmin[node->axis] < node->dist)
394                         SV_TouchLinks(ent, node->children[1]); // order reversed to reduce code
395                 node = node->children[0];
396                 goto loc0;
397         }
398         else
399         {
400                 if (ent->v.absmin[node->axis] < node->dist)
401                 {
402                         node = node->children[1];
403                         goto loc0;
404                 }
405         }
406 }
407
408
409 /*
410 ===============
411 SV_LinkEdict
412
413 ===============
414 */
415 void SV_LinkEdict (edict_t *ent, qboolean touch_triggers)
416 {
417         areanode_t      *node;
418
419         if (ent->area.prev)
420                 SV_UnlinkEdict (ent);   // unlink from old position
421                 
422         if (ent == sv.edicts)
423                 return;         // don't add the world
424
425         if (ent->free)
426                 return;
427
428 // set the abs box
429
430 // LordHavoc: enabling rotating bmodels
431         if (ent->v.solid == SOLID_BSP && (ent->v.angles[0] || ent->v.angles[1] || ent->v.angles[2]))
432         {
433                 // expand for rotation
434                 float           max, v;
435                 int                     i;
436
437                 max = DotProduct(ent->v.mins, ent->v.mins);
438                 v = DotProduct(ent->v.maxs, ent->v.maxs);
439                 if (max < v)
440                         max = v;
441                 max = sqrt(max);
442                 /*
443                 max = 0;
444                 for (i=0 ; i<3 ; i++)
445                 {
446                         v = fabs(ent->v.mins[i]);
447                         if (max < v)
448                                 max = v;
449                         v = fabs(ent->v.maxs[i]);
450                         if (max < v)
451                                 max = v;
452                 }
453                 */
454                 for (i=0 ; i<3 ; i++)
455                 {
456                         ent->v.absmin[i] = ent->v.origin[i] - max;
457                         ent->v.absmax[i] = ent->v.origin[i] + max;
458                 }
459         }
460         else
461         {
462                 VectorAdd (ent->v.origin, ent->v.mins, ent->v.absmin);
463                 VectorAdd (ent->v.origin, ent->v.maxs, ent->v.absmax);
464         }
465
466 //
467 // to make items easier to pick up and allow them to be grabbed off
468 // of shelves, the abs sizes are expanded
469 //
470         if ((int)ent->v.flags & FL_ITEM)
471         {
472                 ent->v.absmin[0] -= 15;
473                 ent->v.absmin[1] -= 15;
474                 ent->v.absmax[0] += 15;
475                 ent->v.absmax[1] += 15;
476         }
477         else
478         {
479                 // because movement is clipped an epsilon away from an actual edge,
480                 // we must fully check even when bounding boxes don't quite touch
481                 ent->v.absmin[0] -= 1;
482                 ent->v.absmin[1] -= 1;
483                 ent->v.absmin[2] -= 1;
484                 ent->v.absmax[0] += 1;
485                 ent->v.absmax[1] += 1;
486                 ent->v.absmax[2] += 1;
487         }
488
489         if (ent->v.solid == SOLID_NOT)
490                 return;
491
492 // find the first node that the ent's box crosses
493         node = sv_areanodes;
494         while (1)
495         {
496                 if (node->axis == -1)
497                         break;
498                 if (ent->v.absmin[node->axis] > node->dist)
499                         node = node->children[0];
500                 else if (ent->v.absmax[node->axis] < node->dist)
501                         node = node->children[1];
502                 else
503                         break;          // crosses the node
504         }
505
506 // link it in
507
508         if (ent->v.solid == SOLID_TRIGGER)
509                 InsertLinkBefore (&ent->area, &node->trigger_edicts);
510         else
511                 InsertLinkBefore (&ent->area, &node->solid_edicts);
512
513 // if touch_triggers, touch all entities at this node and descend for more
514         if (touch_triggers)
515                 SV_TouchLinks ( ent, sv_areanodes );
516 }
517
518
519
520 /*
521 ===============================================================================
522
523 POINT TESTING IN HULLS
524
525 ===============================================================================
526 */
527
528 /*
529 ==================
530 SV_HullPointContents
531
532 ==================
533 */
534 int SV_HullPointContents (hull_t *hull, int num, vec3_t p)
535 {
536         while (num >= 0)
537                 num = hull->clipnodes[num].children[(hull->planes[hull->clipnodes[num].planenum].type < 3 ? p[hull->planes[hull->clipnodes[num].planenum].type] : DotProduct (hull->planes[hull->clipnodes[num].planenum].normal, p)) < hull->planes[hull->clipnodes[num].planenum].dist];
538
539         return num;
540 }
541
542 /*
543 ============
544 SV_TestEntityPosition
545
546 This could be a lot more efficient...
547 ============
548 */
549 edict_t *SV_TestEntityPosition (edict_t *ent)
550 {
551         trace_t trace;
552
553         trace = SV_Move (ent->v.origin, ent->v.mins, ent->v.maxs, ent->v.origin, MOVE_NORMAL, ent);
554
555         if (trace.startsolid)
556                 return sv.edicts;
557
558         return NULL;
559 }
560
561
562 /*
563 ===============================================================================
564
565 LINE TESTING IN HULLS
566
567 ===============================================================================
568 */
569
570 // 1/32 epsilon to keep floating point happy
571 #define DIST_EPSILON (0.03125)
572
573 #define HULLCHECKSTATE_EMPTY 0
574 #define HULLCHECKSTATE_SOLID 1
575 #define HULLCHECKSTATE_DONE 2
576
577 // LordHavoc: FIXME: this is not thread safe, if threading matters here, pass
578 // this as a struct to RecursiveHullCheck, RecursiveHullCheck_Impact, etc...
579 RecursiveHullCheckTraceInfo_t RecursiveHullCheckInfo;
580 #define RHC RecursiveHullCheckInfo
581
582 void SV_RecursiveHullCheck_Impact (mplane_t *plane, int side)
583 {
584         // LordHavoc: using doubles for extra accuracy
585         double t1, t2, frac;
586
587         // LordHavoc: now that we have found the impact, recalculate the impact
588         // point from scratch for maximum accuracy, with an epsilon bias on the
589         // surface distance
590         frac = plane->dist;
591         if (side)
592         {
593                 frac -= DIST_EPSILON;
594                 VectorNegate (plane->normal, RHC.trace->plane.normal);
595                 RHC.trace->plane.dist = -plane->dist;
596         }
597         else
598         {
599                 frac += DIST_EPSILON;
600                 VectorCopy (plane->normal, RHC.trace->plane.normal);
601                 RHC.trace->plane.dist = plane->dist;
602         }
603
604         if (plane->type < 3)
605         {
606                 t1 = RHC.start[plane->type] - frac;
607                 t2 = RHC.start[plane->type] + RHC.dist[plane->type] - frac;
608         }
609         else
610         {
611                 t1 = plane->normal[0] * RHC.start[0] + plane->normal[1] * RHC.start[1] + plane->normal[2] * RHC.start[2] - frac;
612                 t2 = plane->normal[0] * (RHC.start[0] + RHC.dist[0]) + plane->normal[1] * (RHC.start[1] + RHC.dist[1]) + plane->normal[2] * (RHC.start[2] + RHC.dist[2]) - frac;
613         }
614
615         frac = t1 / (t1 - t2);
616         frac = bound(0.0f, frac, 1.0);
617
618         RHC.trace->fraction = frac;
619         RHC.trace->endpos[0] = RHC.start[0] + frac * RHC.dist[0];
620         RHC.trace->endpos[1] = RHC.start[1] + frac * RHC.dist[1];
621         RHC.trace->endpos[2] = RHC.start[2] + frac * RHC.dist[2];
622 }
623
624 int SV_RecursiveHullCheck (int num, double p1f, double p2f, double p1[3], double p2[3])
625 {
626         dclipnode_t     *node;
627         int                     side;
628         double          midf, mid[3];
629         // LordHavoc: FIXME: this is not thread safe...  if threading matters here,
630         // remove the static prefixes
631         static int ret;
632         static mplane_t *plane;
633         static double t1, t2, frac;
634
635         // LordHavoc: a goto!  everyone flee in terror... :)
636 loc0:
637         // check for empty
638         if (num < 0)
639         {
640                 RHC.trace->endcontents = num;
641                 if (RHC.trace->startcontents)
642                 {
643                         if (num == RHC.trace->startcontents)
644                                 RHC.trace->allsolid = false;
645                         else
646                         {
647                                 // if the first leaf is solid, set startsolid
648                                 if (RHC.trace->allsolid)
649                                         RHC.trace->startsolid = true;
650                                 return HULLCHECKSTATE_SOLID;
651                         }
652                         return HULLCHECKSTATE_EMPTY;
653                 }
654                 else
655                 {
656                         if (num != CONTENTS_SOLID)
657                         {
658                                 RHC.trace->allsolid = false;
659                                 if (num == CONTENTS_EMPTY)
660                                         RHC.trace->inopen = true;
661                                 else
662                                         RHC.trace->inwater = true;
663                         }
664                         else
665                         {
666                                 // if the first leaf is solid, set startsolid
667                                 if (RHC.trace->allsolid)
668                                         RHC.trace->startsolid = true;
669                                 return HULLCHECKSTATE_SOLID;
670                         }
671                         return HULLCHECKSTATE_EMPTY;
672                 }
673         }
674
675         // find the point distances
676         node = RHC.hull->clipnodes + num;
677
678         plane = RHC.hull->planes + node->planenum;
679         if (plane->type < 3)
680         {
681                 t1 = p1[plane->type] - plane->dist;
682                 t2 = p2[plane->type] - plane->dist;
683         }
684         else
685         {
686                 t1 = DotProduct (plane->normal, p1) - plane->dist;
687                 t2 = DotProduct (plane->normal, p2) - plane->dist;
688         }
689
690         // LordHavoc: rearranged the side/frac code
691         if (t1 >= 0)
692         {
693                 if (t2 >= 0)
694                 {
695                         num = node->children[0];
696                         goto loc0;
697                 }
698                 // put the crosspoint DIST_EPSILON pixels on the near side
699                 side = 0;
700         }
701         else
702         {
703                 if (t2 < 0)
704                 {
705                         num = node->children[1];
706                         goto loc0;
707                 }
708                 // put the crosspoint DIST_EPSILON pixels on the near side
709                 side = 1;
710         }
711
712         frac = t1 / (t1 - t2);
713         frac = bound(0.0f, frac, 1.0);
714
715         midf = p1f + ((p2f - p1f) * frac);
716         mid[0] = RHC.start[0] + midf * RHC.dist[0];
717         mid[1] = RHC.start[1] + midf * RHC.dist[1];
718         mid[2] = RHC.start[2] + midf * RHC.dist[2];
719
720         // front side first
721         ret = SV_RecursiveHullCheck (node->children[side], p1f, midf, p1, mid);
722         if (ret != HULLCHECKSTATE_EMPTY)
723                 return ret; // solid or done
724         ret = SV_RecursiveHullCheck (node->children[!side], midf, p2f, mid, p2);
725         if (ret != HULLCHECKSTATE_SOLID)
726                 return ret; // empty or done
727
728         // front is air and back is solid, this is the impact point...
729         SV_RecursiveHullCheck_Impact(RHC.hull->planes + node->planenum, side);
730
731         return HULLCHECKSTATE_DONE;
732 }
733
734 /*
735 ==================
736 SV_ClipMoveToEntity
737
738 Handles selection or creation of a clipping hull, and offseting (and
739 eventually rotation) of the end points
740 ==================
741 */
742 trace_t SV_ClipMoveToEntity (edict_t *ent, vec3_t start, vec3_t mins, vec3_t maxs, vec3_t end)
743 {
744         trace_t trace;
745         vec3_t offset, forward, left, up;
746         double startd[3], endd[3], tempd[3];
747         hull_t *hull;
748
749 // fill in a default trace
750         memset (&trace, 0, sizeof(trace_t));
751         trace.fraction = 1;
752         trace.allsolid = true;
753
754 // get the clipping hull
755         hull = SV_HullForEntity (ent, mins, maxs, offset);
756
757         VectorSubtract(start, offset, startd);
758         VectorSubtract(end, offset, endd);
759
760         // rotate start and end into the models frame of reference
761         if (ent->v.solid == SOLID_BSP && (ent->v.angles[0] || ent->v.angles[1] || ent->v.angles[2]))
762         {
763                 AngleVectorsFLU (ent->v.angles, forward, left, up);
764                 VectorCopy(startd, tempd);
765                 startd[0] = DotProduct (tempd, forward);
766                 startd[1] = DotProduct (tempd, left);
767                 startd[2] = DotProduct (tempd, up);
768                 VectorCopy(endd, tempd);
769                 endd[0] = DotProduct (tempd, forward);
770                 endd[1] = DotProduct (tempd, left);
771                 endd[2] = DotProduct (tempd, up);
772         }
773
774         VectorCopy(end, trace.endpos);
775
776 // trace a line through the appropriate clipping hull
777         VectorCopy(startd, RecursiveHullCheckInfo.start);
778         VectorSubtract(endd, startd, RecursiveHullCheckInfo.dist);
779         RecursiveHullCheckInfo.hull = hull;
780         RecursiveHullCheckInfo.trace = &trace;
781         SV_RecursiveHullCheck (hull->firstclipnode, 0, 1, startd, endd);
782
783         // if we hit, unrotate endpos and normal, and store the entity we hit
784         if (trace.fraction != 1)
785         {
786                 // rotate endpos back to world frame of reference
787                 if (ent->v.solid == SOLID_BSP && (ent->v.angles[0] || ent->v.angles[1] || ent->v.angles[2]))
788                 {
789                         VectorNegate (ent->v.angles, offset);
790                         AngleVectorsFLU (offset, forward, left, up);
791
792                         VectorCopy (trace.endpos, tempd);
793                         trace.endpos[0] = DotProduct (tempd, forward);
794                         trace.endpos[1] = DotProduct (tempd, left);
795                         trace.endpos[2] = DotProduct (tempd, up);
796
797                         VectorCopy (trace.plane.normal, tempd);
798                         trace.plane.normal[0] = DotProduct (tempd, forward);
799                         trace.plane.normal[1] = DotProduct (tempd, left);
800                         trace.plane.normal[2] = DotProduct (tempd, up);
801                 }
802                 // fix offset
803                 VectorAdd (trace.endpos, offset, trace.endpos);
804                 trace.ent = ent;
805         }
806         else if (trace.startsolid)
807                 trace.ent = ent;
808
809         return trace;
810 }
811
812 //===========================================================================
813
814 /*
815 ====================
816 SV_ClipToLinks
817
818 Mins and maxs enclose the entire area swept by the move
819 ====================
820 */
821 void SV_ClipToLinks ( areanode_t *node, moveclip_t *clip )
822 {
823         link_t          *l, *next;
824         edict_t         *touch;
825         trace_t         trace;
826
827         if (clip->trace.allsolid)
828                 return;
829 loc0:
830 // touch linked edicts
831         for (l = node->solid_edicts.next ; l != &node->solid_edicts ; l = next)
832         {
833                 next = l->next;
834                 touch = EDICT_FROM_AREA(l);
835                 if (touch->v.solid == SOLID_NOT)
836                         continue;
837                 if (touch == clip->passedict)
838                         continue;
839                 if (touch->v.solid == SOLID_TRIGGER)
840                         Host_Error ("Trigger in clipping list");
841
842                 if (clip->type == MOVE_NOMONSTERS && touch->v.solid != SOLID_BSP)
843                         continue;
844
845                 if (clip->boxmins[0] > touch->v.absmax[0]
846                  || clip->boxmaxs[0] < touch->v.absmin[0]
847                  || clip->boxmins[1] > touch->v.absmax[1]
848                  || clip->boxmaxs[1] < touch->v.absmin[1]
849                  || clip->boxmins[2] > touch->v.absmax[2]
850                  || clip->boxmaxs[2] < touch->v.absmin[2])
851                         continue;
852
853                 if (clip->passedict)
854                 {
855                         if (clip->passedict->v.size[0] && !touch->v.size[0])
856                                 continue;       // points never interact
857                         if (PROG_TO_EDICT(touch->v.owner) == clip->passedict)
858                                 continue;       // don't clip against own missiles
859                         if (PROG_TO_EDICT(clip->passedict->v.owner) == touch)
860                                 continue;       // don't clip against owner
861                         // LordHavoc: corpse code
862                         if (clip->passedict->v.solid == SOLID_CORPSE && touch->v.solid == SOLID_SLIDEBOX)
863                                 continue;
864                         if (clip->passedict->v.solid == SOLID_SLIDEBOX && touch->v.solid == SOLID_CORPSE)
865                                 continue;
866                 }
867
868                 // might interact, so do an exact clip
869                 if ((int)touch->v.flags & FL_MONSTER)
870                         trace = SV_ClipMoveToEntity (touch, clip->start, clip->mins2, clip->maxs2, clip->end);
871                 else
872                         trace = SV_ClipMoveToEntity (touch, clip->start, clip->mins, clip->maxs, clip->end);
873                 if (trace.allsolid || trace.startsolid || trace.fraction < clip->trace.fraction)
874                 {
875                         trace.ent = touch;
876                         if (clip->trace.startsolid)
877                         {
878                                 clip->trace = trace;
879                                 clip->trace.startsolid = true;
880                         }
881                         else
882                                 clip->trace = trace;
883                 }
884                 if (clip->trace.allsolid)
885                         return;
886         }
887
888 // recurse down both sides
889         if (node->axis == -1)
890                 return;
891
892         // LordHavoc: optimized recursion
893 //      if (clip->boxmaxs[node->axis] > node->dist) SV_ClipToLinks(node->children[0], clip);
894 //      if (clip->boxmins[node->axis] < node->dist) SV_ClipToLinks(node->children[1], clip);
895         if (clip->boxmaxs[node->axis] > node->dist)
896         {
897                 if (clip->boxmins[node->axis] < node->dist)
898                         SV_ClipToLinks(node->children[1], clip);
899                 node = node->children[0];
900                 goto loc0;
901         }
902         else if (clip->boxmins[node->axis] < node->dist)
903         {
904                 node = node->children[1];
905                 goto loc0;
906         }
907 }
908
909
910 /*
911 ==================
912 SV_MoveBounds
913 ==================
914 */
915 void SV_MoveBounds (vec3_t start, vec3_t mins, vec3_t maxs, vec3_t end, vec3_t boxmins, vec3_t boxmaxs)
916 {
917 #if 0
918 // debug to test against everything
919 boxmins[0] = boxmins[1] = boxmins[2] = -9999;
920 boxmaxs[0] = boxmaxs[1] = boxmaxs[2] = 9999;
921 #else
922         int             i;
923
924         for (i=0 ; i<3 ; i++)
925         {
926                 if (end[i] > start[i])
927                 {
928                         boxmins[i] = start[i] + mins[i] - 1;
929                         boxmaxs[i] = end[i] + maxs[i] + 1;
930                 }
931                 else
932                 {
933                         boxmins[i] = end[i] + mins[i] - 1;
934                         boxmaxs[i] = start[i] + maxs[i] + 1;
935                 }
936         }
937 #endif
938 }
939
940 /*
941 ==================
942 SV_Move
943 ==================
944 */
945 trace_t SV_Move (vec3_t start, vec3_t mins, vec3_t maxs, vec3_t end, int type, edict_t *passedict)
946 {
947         moveclip_t      clip;
948         int                     i;
949
950         memset ( &clip, 0, sizeof ( moveclip_t ) );
951
952         clip.start = start;
953         clip.end = end;
954         clip.mins = mins;
955         clip.maxs = maxs;
956         clip.type = type;
957         clip.passedict = passedict;
958
959         if (type == MOVE_MISSILE)
960         {
961                 for (i=0 ; i<3 ; i++)
962                 {
963                         clip.mins2[i] = -15;
964                         clip.maxs2[i] = 15;
965                 }
966         }
967         else
968         {
969                 VectorCopy (clip.mins, clip.mins2);
970                 VectorCopy (clip.maxs, clip.maxs2);
971         }
972
973         // clip to world
974         clip.trace = SV_ClipMoveToEntity (sv.edicts, start, mins, maxs, end);
975
976         // clip to entities
977         if (!clip.trace.allsolid)
978         {
979                 // create the bounding box of the entire move
980                 SV_MoveBounds ( start, clip.mins2, clip.maxs2, end, clip.boxmins, clip.boxmaxs );
981
982                 SV_ClipToLinks ( sv_areanodes, &clip );
983         }
984
985         return clip.trace;
986 }