]> de.git.xonotic.org Git - xonotic/darkplaces.git/blob - sv_user.c
optimized AngleVectors calls (pass NULL for vectors that should not be generated)
[xonotic/darkplaces.git] / sv_user.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 // sv_user.c -- server code for moving users
21
22 #include "quakedef.h"
23
24 edict_t *sv_player;
25
26 extern  cvar_t  sv_friction;
27 cvar_t  sv_edgefriction = {"edgefriction", "2"};
28 cvar_t  sv_predict = {"sv_predict", "1"};
29 extern  cvar_t  sv_stopspeed;
30
31 static  vec3_t          forward, right, up;
32
33 vec3_t  wishdir;
34 float   wishspeed;
35
36 // world
37 float   *angles;
38 float   *origin;
39 float   *velocity;
40
41 qboolean        onground;
42
43 usercmd_t       cmd;
44
45 cvar_t  sv_idealpitchscale = {"sv_idealpitchscale","0.8"};
46
47
48 /*
49 ===============
50 SV_SetIdealPitch
51 ===============
52 */
53 #define MAX_FORWARD     6
54 void SV_SetIdealPitch (void)
55 {
56         float   angleval, sinval, cosval;
57         trace_t tr;
58         vec3_t  top, bottom;
59         float   z[MAX_FORWARD];
60         int             i, j;
61         int             step, dir, steps;
62
63         if (!((int)sv_player->v.flags & FL_ONGROUND))
64                 return;
65                 
66         angleval = sv_player->v.angles[YAW] * M_PI*2 / 360;
67         sinval = sin(angleval);
68         cosval = cos(angleval);
69
70         for (i=0 ; i<MAX_FORWARD ; i++)
71         {
72                 top[0] = sv_player->v.origin[0] + cosval*(i+3)*12;
73                 top[1] = sv_player->v.origin[1] + sinval*(i+3)*12;
74                 top[2] = sv_player->v.origin[2] + sv_player->v.view_ofs[2];
75                 
76                 bottom[0] = top[0];
77                 bottom[1] = top[1];
78                 bottom[2] = top[2] - 160;
79                 
80                 tr = SV_Move (top, vec3_origin, vec3_origin, bottom, 1, sv_player);
81                 if (tr.allsolid)
82                         return; // looking at a wall, leave ideal the way is was
83
84                 if (tr.fraction == 1)
85                         return; // near a dropoff
86                 
87                 z[i] = top[2] + tr.fraction*(bottom[2]-top[2]);
88         }
89         
90         dir = 0;
91         steps = 0;
92         for (j=1 ; j<i ; j++)
93         {
94                 step = z[j] - z[j-1];
95                 if (step > -ON_EPSILON && step < ON_EPSILON)
96                         continue;
97
98                 if (dir && ( step-dir > ON_EPSILON || step-dir < -ON_EPSILON ) )
99                         return;         // mixed changes
100
101                 steps++;        
102                 dir = step;
103         }
104         
105         if (!dir)
106         {
107                 sv_player->v.idealpitch = 0;
108                 return;
109         }
110         
111         if (steps < 2)
112                 return;
113         sv_player->v.idealpitch = -dir * sv_idealpitchscale.value;
114 }
115
116
117 /*
118 ==================
119 SV_UserFriction
120
121 ==================
122 */
123 void SV_UserFriction (void)
124 {
125         float   *vel;
126         float   speed, newspeed, control;
127         vec3_t  start, stop;
128         float   friction;
129         trace_t trace;
130         
131         vel = velocity;
132         
133         speed = sqrt(vel[0]*vel[0] +vel[1]*vel[1]);
134         if (!speed)
135                 return;
136
137 // if the leading edge is over a dropoff, increase friction
138         start[0] = stop[0] = origin[0] + vel[0]/speed*16;
139         start[1] = stop[1] = origin[1] + vel[1]/speed*16;
140         start[2] = origin[2] + sv_player->v.mins[2];
141         stop[2] = start[2] - 34;
142
143         trace = SV_Move (start, vec3_origin, vec3_origin, stop, true, sv_player);
144
145         if (trace.fraction == 1.0)
146                 friction = sv_friction.value*sv_edgefriction.value;
147         else
148                 friction = sv_friction.value;
149
150 // apply friction       
151         control = speed < sv_stopspeed.value ? sv_stopspeed.value : speed;
152         newspeed = speed - sv.frametime*control*friction;
153         
154         if (newspeed < 0)
155                 newspeed = 0;
156         else
157                 newspeed /= speed;
158
159         vel[0] = vel[0] * newspeed;
160         vel[1] = vel[1] * newspeed;
161         vel[2] = vel[2] * newspeed;
162 }
163
164 /*
165 ==============
166 SV_Accelerate
167 ==============
168 */
169 cvar_t  sv_maxspeed = {"sv_maxspeed", "320", false, true};
170 cvar_t  sv_accelerate = {"sv_accelerate", "10"};
171 #if 0
172 void SV_Accelerate (vec3_t wishvel)
173 {
174         int                     i;
175         float           addspeed, accelspeed;
176         vec3_t          pushvec;
177
178         if (wishspeed == 0)
179                 return;
180
181         VectorSubtract (wishvel, velocity, pushvec);
182         addspeed = VectorNormalize (pushvec);
183
184         accelspeed = sv_accelerate.value*sv.frametime*addspeed;
185         if (accelspeed > addspeed)
186                 accelspeed = addspeed;
187         
188         for (i=0 ; i<3 ; i++)
189                 velocity[i] += accelspeed*pushvec[i];   
190 }
191 #endif
192 void SV_Accelerate (void)
193 {
194         int                     i;
195         float           addspeed, accelspeed, currentspeed;
196
197         currentspeed = DotProduct (velocity, wishdir);
198         addspeed = wishspeed - currentspeed;
199         if (addspeed <= 0)
200                 return;
201         accelspeed = sv_accelerate.value*sv.frametime*wishspeed;
202         if (accelspeed > addspeed)
203                 accelspeed = addspeed;
204         
205         for (i=0 ; i<3 ; i++)
206                 velocity[i] += accelspeed*wishdir[i];   
207 }
208
209 void SV_AirAccelerate (vec3_t wishveloc)
210 {
211         int                     i;
212         float           addspeed, wishspd, accelspeed, currentspeed;
213                 
214         wishspd = VectorNormalizeLength (wishveloc);
215         if (wishspd > 30)
216                 wishspd = 30;
217         currentspeed = DotProduct (velocity, wishveloc);
218         addspeed = wishspd - currentspeed;
219         if (addspeed <= 0)
220                 return;
221 //      accelspeed = sv_accelerate.value * sv.frametime;
222         accelspeed = sv_accelerate.value*wishspeed * sv.frametime;
223         if (accelspeed > addspeed)
224                 accelspeed = addspeed;
225         
226         for (i=0 ; i<3 ; i++)
227                 velocity[i] += accelspeed*wishveloc[i]; 
228 }
229
230
231 void DropPunchAngle (void)
232 {
233         float   len;
234         eval_t  *val;
235         
236         len = VectorNormalizeLength (sv_player->v.punchangle);
237         
238         len -= 10*sv.frametime;
239         if (len < 0)
240                 len = 0;
241         VectorScale (sv_player->v.punchangle, len, sv_player->v.punchangle);
242         
243         if ((val = GETEDICTFIELDVALUE(sv_player, eval_punchvector)))
244         {
245                 len = VectorNormalizeLength (val->vector);
246                 
247                 len -= 20*sv.frametime;
248                 if (len < 0)
249                         len = 0;
250                 VectorScale (val->vector, len, val->vector);
251         }
252 }
253
254 /*
255 ===================
256 SV_WaterMove
257
258 ===================
259 */
260 void SV_WaterMove (void)
261 {
262         int             i;
263         vec3_t  wishvel;
264         float   speed, newspeed, wishspeed, addspeed, accelspeed;
265
266 //
267 // user intentions
268 //
269         AngleVectors (sv_player->v.v_angle, forward, right, up);
270
271         for (i=0 ; i<3 ; i++)
272                 wishvel[i] = forward[i]*cmd.forwardmove + right[i]*cmd.sidemove;
273
274         if (!cmd.forwardmove && !cmd.sidemove && !cmd.upmove)
275                 wishvel[2] -= 60;               // drift towards bottom
276         else
277                 wishvel[2] += cmd.upmove;
278
279         wishspeed = Length(wishvel);
280         if (wishspeed > sv_maxspeed.value)
281         {
282                 VectorScale (wishvel, sv_maxspeed.value/wishspeed, wishvel);
283                 wishspeed = sv_maxspeed.value;
284         }
285         wishspeed *= 0.7;
286
287 //
288 // water friction
289 //
290         speed = Length (velocity);
291         if (speed)
292         {
293                 newspeed = speed - sv.frametime * speed * sv_friction.value;
294                 if (newspeed < 0)
295                         newspeed = 0;   
296                 VectorScale (velocity, newspeed/speed, velocity);
297         }
298         else
299                 newspeed = 0;
300         
301 //
302 // water acceleration
303 //
304         if (!wishspeed)
305                 return;
306
307         addspeed = wishspeed - newspeed;
308         if (addspeed <= 0)
309                 return;
310
311         VectorNormalize (wishvel);
312         accelspeed = sv_accelerate.value * wishspeed * sv.frametime;
313         if (accelspeed > addspeed)
314                 accelspeed = addspeed;
315
316         for (i=0 ; i<3 ; i++)
317                 velocity[i] += accelspeed * wishvel[i];
318 }
319
320 void SV_WaterJump (void)
321 {
322         if (sv.time > sv_player->v.teleport_time
323         || !sv_player->v.waterlevel)
324         {
325                 sv_player->v.flags = (int)sv_player->v.flags & ~FL_WATERJUMP;
326                 sv_player->v.teleport_time = 0;
327         }
328         sv_player->v.velocity[0] = sv_player->v.movedir[0];
329         sv_player->v.velocity[1] = sv_player->v.movedir[1];
330 }
331
332
333 /*
334 ===================
335 SV_AirMove
336
337 ===================
338 */
339 void SV_AirMove (void)
340 {
341         int                     i;
342         vec3_t          wishvel;
343         float           fmove, smove;
344
345         // LordHavoc: correct quake movement speed bug when looking up/down
346         wishvel[0] = wishvel[2] = 0;
347         wishvel[1] = sv_player->v.angles[1];
348         AngleVectors (wishvel, forward, right, up);
349 //      AngleVectors (sv_player->v.angles, forward, right, up);
350
351         fmove = cmd.forwardmove;
352         smove = cmd.sidemove;
353         
354 // hack to not let you back into teleporter
355         if (sv.time < sv_player->v.teleport_time && fmove < 0)
356                 fmove = 0;
357                 
358         for (i=0 ; i<3 ; i++)
359                 wishvel[i] = forward[i]*fmove + right[i]*smove;
360
361         if ( (int)sv_player->v.movetype != MOVETYPE_WALK)
362                 wishvel[2] = cmd.upmove;
363         else
364                 wishvel[2] = 0;
365
366         VectorCopy (wishvel, wishdir);
367         wishspeed = VectorNormalizeLength(wishdir);
368         if (wishspeed > sv_maxspeed.value)
369         {
370                 VectorScale (wishvel, sv_maxspeed.value/wishspeed, wishvel);
371                 wishspeed = sv_maxspeed.value;
372         }
373         
374         if ( sv_player->v.movetype == MOVETYPE_NOCLIP)
375         {       // noclip
376                 VectorCopy (wishvel, velocity);
377         }
378         else if ( onground )
379         {
380                 SV_UserFriction ();
381                 SV_Accelerate ();
382         }
383         else
384         {       // not on ground, so little effect on velocity
385                 SV_AirAccelerate (wishvel);
386         }               
387 }
388
389 /*
390 ===================
391 SV_ClientThink
392
393 the move fields specify an intended velocity in pix/sec
394 the angle fields specify an exact angular motion in degrees
395 ===================
396 */
397 void SV_ClientThink (void)
398 {
399         vec3_t          v_angle;
400
401         if (sv_player->v.movetype == MOVETYPE_NONE)
402                 return;
403         
404         onground = (int)sv_player->v.flags & FL_ONGROUND;
405
406         origin = sv_player->v.origin;
407         velocity = sv_player->v.velocity;
408
409         DropPunchAngle ();
410         
411 //
412 // if dead, behave differently
413 //
414         if (sv_player->v.health <= 0)
415                 return;
416
417 //
418 // angles
419 // show 1/3 the pitch angle and all the roll angle
420         cmd = host_client->cmd;
421         angles = sv_player->v.angles;
422         
423         VectorAdd (sv_player->v.v_angle, sv_player->v.punchangle, v_angle);
424         angles[ROLL] = V_CalcRoll (sv_player->v.angles, sv_player->v.velocity)*4;
425         if (!sv_player->v.fixangle)
426         {
427                 // LordHavoc: pitch was ugly to begin with...  removed except in water
428                 if (sv_player->v.waterlevel >= 2)
429                         angles[PITCH] = -v_angle[PITCH]/3;
430                 else
431                         angles[PITCH] = 0;
432                 angles[YAW] = v_angle[YAW];
433         }
434
435         if ( (int)sv_player->v.flags & FL_WATERJUMP )
436         {
437                 SV_WaterJump ();
438                 return;
439         }
440 //
441 // walk
442 //
443         if ( (sv_player->v.waterlevel >= 2)     && (sv_player->v.movetype != MOVETYPE_NOCLIP) )
444         {
445                 SV_WaterMove ();
446                 return;
447         }
448
449         SV_AirMove ();  
450 }
451
452
453 /*
454 ===================
455 SV_ReadClientMove
456 ===================
457 */
458 void SV_ReadClientMove (usercmd_t *move)
459 {
460         int             i;
461         vec3_t  angle;
462         int             bits;
463         eval_t  *val;
464         float   total;
465         
466 // read ping time
467         host_client->ping_times[host_client->num_pings%NUM_PING_TIMES]
468                 = sv.time - MSG_ReadFloat ();
469         host_client->num_pings++;
470         for (i=0, total = 0;i < NUM_PING_TIMES;i++)
471                 total += host_client->ping_times[i];
472         host_client->ping = total / NUM_PING_TIMES; // can be used for prediction
473         host_client->latency = 0;
474         if (sv_predict.value && (svs.maxclients > 1) && (!sv.paused)) // if paused or a local game, don't predict
475                 host_client->latency = host_client->ping;
476         if ((val = GETEDICTFIELDVALUE(host_client->edict, eval_ping)))
477                 val->_float = host_client->ping * 1000.0;
478
479 // read current angles
480         if (dpprotocol)
481         {
482                 for (i=0 ; i<3 ; i++)
483                         angle[i] = MSG_ReadPreciseAngle ();
484         }
485         else
486         {
487                 for (i=0 ; i<3 ; i++)
488                         angle[i] = MSG_ReadAngle ();
489         }
490
491         VectorCopy (angle, host_client->edict->v.v_angle);
492                 
493 // read movement
494         move->forwardmove = MSG_ReadShort ();
495         move->sidemove = MSG_ReadShort ();
496         move->upmove = MSG_ReadShort ();
497         if ((val = GETEDICTFIELDVALUE(host_client->edict, eval_movement)))
498         {
499                 val->vector[0] = move->forwardmove;
500                 val->vector[1] = move->sidemove;
501                 val->vector[2] = move->upmove;
502         }
503         
504 // read buttons
505         bits = MSG_ReadByte ();
506         host_client->edict->v.button0 = bits & 1;
507         host_client->edict->v.button2 = (bits & 2)>>1;
508         // LordHavoc: added 6 new buttons
509         if ((val = GETEDICTFIELDVALUE(host_client->edict, eval_button3))) val->_float = ((bits >> 2) & 1);
510         if ((val = GETEDICTFIELDVALUE(host_client->edict, eval_button4))) val->_float = ((bits >> 3) & 1);
511         if ((val = GETEDICTFIELDVALUE(host_client->edict, eval_button5))) val->_float = ((bits >> 4) & 1);
512         if ((val = GETEDICTFIELDVALUE(host_client->edict, eval_button6))) val->_float = ((bits >> 5) & 1);
513         if ((val = GETEDICTFIELDVALUE(host_client->edict, eval_button7))) val->_float = ((bits >> 6) & 1);
514         if ((val = GETEDICTFIELDVALUE(host_client->edict, eval_button8))) val->_float = ((bits >> 7) & 1);
515
516         i = MSG_ReadByte ();
517         if (i)
518                 host_client->edict->v.impulse = i;
519 }
520
521 /*
522 ===================
523 SV_ReadClientMessage
524
525 Returns false if the client should be killed
526 ===================
527 */
528 qboolean SV_ReadClientMessage (void)
529 {
530         int             ret;
531         int             cmd;
532         char            *s;
533         
534         do
535         {
536 nextmsg:
537                 ret = NET_GetMessage (host_client->netconnection);
538                 if (ret == -1)
539                 {
540                         Sys_Printf ("SV_ReadClientMessage: NET_GetMessage failed\n");
541                         return false;
542                 }
543                 if (!ret)
544                         return true;
545                                         
546                 MSG_BeginReading ();
547                 
548                 while (1)
549                 {
550                         if (!host_client->active)
551                                 return false;   // a command caused an error
552
553                         if (msg_badread)
554                         {
555                                 Sys_Printf ("SV_ReadClientMessage: badread\n");
556                                 return false;
557                         }       
558         
559                         cmd = MSG_ReadChar ();
560                         
561                         switch (cmd)
562                         {
563                         case -1:
564                                 goto nextmsg;           // end of message
565                                 
566                         default:
567                                 Sys_Printf ("SV_ReadClientMessage: unknown command char\n");
568                                 return false;
569                                                         
570                         case clc_nop:
571 //                              Sys_Printf ("clc_nop\n");
572                                 break;
573                                 
574                         case clc_stringcmd:     
575                                 s = MSG_ReadString ();
576                                 ret = 0;
577                                 if (Q_strncasecmp(s, "status", 6) == 0
578                                  || Q_strncasecmp(s, "name", 4) == 0
579                                  || Q_strncasecmp(s, "say", 3) == 0
580                                  || Q_strncasecmp(s, "say_team", 8) == 0
581                                  || Q_strncasecmp(s, "tell", 4) == 0
582                                  || Q_strncasecmp(s, "color", 5) == 0
583                                  || Q_strncasecmp(s, "kill", 4) == 0
584                                  || Q_strncasecmp(s, "pause", 5) == 0
585                                  || Q_strncasecmp(s, "spawn", 5) == 0
586                                  || Q_strncasecmp(s, "begin", 5) == 0
587                                  || Q_strncasecmp(s, "prespawn", 8) == 0
588                                  || Q_strncasecmp(s, "kick", 4) == 0
589                                  || Q_strncasecmp(s, "ping", 4) == 0
590                                  || Q_strncasecmp(s, "ban", 3) == 0
591                                  || Q_strncasecmp(s, "pmodel", 6) == 0
592                                  || (nehahra && (Q_strncasecmp(s, "max", 3) == 0 || Q_strncasecmp(s, "monster", 7) == 0 || Q_strncasecmp(s, "scrag", 5) == 0 || Q_strncasecmp(s, "gimme", 5) == 0 || Q_strncasecmp(s, "wraith", 6) == 0))
593                                  || (!nehahra && (Q_strncasecmp(s, "god", 3) == 0 || Q_strncasecmp(s, "notarget", 8) == 0 || Q_strncasecmp(s, "fly", 3) == 0 || Q_strncasecmp(s, "give", 4) == 0 || Q_strncasecmp(s, "noclip", 6) == 0)))
594                                 {
595                                         ret = 1;
596                                         Cmd_ExecuteString (s, src_client);
597                                 }
598                                 else
599                                         Con_DPrintf("%s tried to %s\n", host_client->name, s);
600                                 /*
601                                 if (ret == 2)
602                                         Cbuf_InsertText (s);
603                                 else if (ret == 1)
604                                         Cmd_ExecuteString (s, src_client);
605                                 else
606                                         Con_DPrintf("%s tried to %s\n", host_client->name, s);
607                                 */
608                                 break;
609                                 
610                         case clc_disconnect:
611 //                              Sys_Printf ("SV_ReadClientMessage: client disconnected\n");
612                                 return false;
613                         
614                         case clc_move:
615                                 SV_ReadClientMove (&host_client->cmd);
616                                 break;
617                         }
618                 }
619         } while (ret == 1);
620         
621         return true;
622 }
623
624
625 /*
626 ==================
627 SV_RunClients
628 ==================
629 */
630 extern dfunction_t *SV_PlayerPhysicsQC;
631 void SV_RunClients (void)
632 {
633         int                             i;
634
635         for (i=0, host_client = svs.clients ; i<svs.maxclients ; i++, host_client++)
636         {
637                 if (!host_client->active)
638                         continue;
639         
640                 sv_player = host_client->edict;
641
642                 if (!SV_ReadClientMessage ())
643                 {
644                         SV_DropClient (false);  // client misbehaved...
645                         continue;
646                 }
647
648                 if (!host_client->spawned)
649                 {
650                 // clear client movement until a new packet is received
651                         memset (&host_client->cmd, 0, sizeof(host_client->cmd));
652                         continue;
653                 }
654
655 // always pause in single player if in console or menus
656                 if (!sv.paused && (svs.maxclients > 1 || key_dest == key_game) )
657                 {
658                         // LordHavoc: QuakeC replacement for SV_ClientThink (player movement)
659                         if (SV_PlayerPhysicsQC)
660                         {
661                                 pr_global_struct->time = sv.time;
662                                 pr_global_struct->self = EDICT_TO_PROG(sv_player);
663                                 PR_ExecuteProgram ((func_t)(SV_PlayerPhysicsQC - pr_functions), "");
664                         }
665                         else
666                                 SV_ClientThink ();
667                 }
668         }
669 }
670