amd64 fixes
[btb/d2x.git] / 3d / points.c
1 /* $Id: points.c,v 1.7 2005-08-02 06:14:48 chris Exp $ */
2 /*
3 THE COMPUTER CODE CONTAINED HEREIN IS THE SOLE PROPERTY OF PARALLAX
4 SOFTWARE CORPORATION ("PARALLAX").  PARALLAX, IN DISTRIBUTING THE CODE TO
5 END-USERS, AND SUBJECT TO ALL OF THE TERMS AND CONDITIONS HEREIN, GRANTS A
6 ROYALTY-FREE, PERPETUAL LICENSE TO SUCH END-USERS FOR USE BY SUCH END-USERS
7 IN USING, DISPLAYING,  AND CREATING DERIVATIVE WORKS THEREOF, SO LONG AS
8 SUCH USE, DISPLAY OR CREATION IS FOR NON-COMMERCIAL, ROYALTY OR REVENUE
9 FREE PURPOSES.  IN NO EVENT SHALL THE END-USER USE THE COMPUTER CODE
10 CONTAINED HEREIN FOR REVENUE-BEARING PURPOSES.  THE END-USER UNDERSTANDS
11 AND AGREES TO THE TERMS HEREIN AND ACCEPTS THE SAME BY USE OF THIS FILE.  
12 COPYRIGHT 1993-1998 PARALLAX SOFTWARE CORPORATION.  ALL RIGHTS RESERVED.
13 */
14 /*
15  * 
16  * Routines for point definition, rotation, etc.
17  * 
18  */
19
20 #ifdef HAVE_CONFIG_H
21 #include <conf.h>
22 #endif
23
24 #ifdef RCS
25 static char rcsid[] = "$Id: points.c,v 1.7 2005-08-02 06:14:48 chris Exp $";
26 #endif
27
28 #include "3d.h"
29 #include "globvars.h"
30
31
32 //code a point.  fills in the p3_codes field of the point, and returns the codes
33 ubyte g3_code_point(g3s_point *p)
34 {
35         ubyte cc=0;
36
37         if (p->p3_x > p->p3_z)
38                 cc |= CC_OFF_RIGHT;
39
40         if (p->p3_y > p->p3_z)
41                 cc |= CC_OFF_TOP;
42
43         if (p->p3_x < -p->p3_z)
44                 cc |= CC_OFF_LEFT;
45
46         if (p->p3_y < -p->p3_z)
47                 cc |= CC_OFF_BOT;
48
49         if (p->p3_z < 0)
50                 cc |= CC_BEHIND;
51
52         return p->p3_codes = cc;
53
54 }
55
56 //rotates a point. returns codes.  does not check if already rotated
57 ubyte g3_rotate_point(g3s_point *dest,vms_vector *src)
58 {
59         vms_vector tempv;
60
61         vm_vec_sub(&tempv,src,&View_position);
62
63         vm_vec_rotate(&dest->p3_vec,&tempv,&View_matrix);
64
65         dest->p3_flags = 0;     //no projected
66
67         return g3_code_point(dest);
68
69 }
70
71 //checks for overflow & divides if ok, fillig in r
72 //returns true if div is ok, else false
73 int checkmuldiv(fix *r,fix a,fix b,fix c)
74 {
75         quadint q,qt;
76
77         q.low=q.high=0;
78         fixmulaccum(&q,a,b);
79
80         qt = q;
81         if (qt.high < 0)
82                 fixquadnegate(&qt);
83
84         qt.high *= 2;
85         if (qt.low > 0x7fff)
86                 qt.high++;
87
88         if (qt.high >= c)
89                 return 0;
90         else {
91                 *r = fixdivquadlong(q.low,q.high,c);
92                 return 1;
93         }
94 }
95
96 //projects a point
97 void g3_project_point(g3s_point *p)
98 {
99 #ifndef __powerc
100         fix tx,ty;
101
102         if (p->p3_flags & PF_PROJECTED || p->p3_codes & CC_BEHIND)
103                 return;
104
105         if (checkmuldiv(&tx,p->p3_x,Canv_w2,p->p3_z) && checkmuldiv(&ty,p->p3_y,Canv_h2,p->p3_z)) {
106                 p->p3_sx = Canv_w2 + tx;
107                 p->p3_sy = Canv_h2 - ty;
108                 p->p3_flags |= PF_PROJECTED;
109         }
110         else
111                 p->p3_flags |= PF_OVERFLOW;
112 #else
113         double fz;
114         
115         if ((p->p3_flags & PF_PROJECTED) || (p->p3_codes & CC_BEHIND))
116                 return;
117         
118         if ( p->p3_z <= 0 )     {
119                 p->p3_flags |= PF_OVERFLOW;
120                 return;
121         }
122
123         fz = f2fl(p->p3_z);
124         p->p3_sx = fl2f(fCanv_w2 + (f2fl(p->p3_x)*fCanv_w2 / fz));
125         p->p3_sy = fl2f(fCanv_h2 - (f2fl(p->p3_y)*fCanv_h2 / fz));
126
127         p->p3_flags |= PF_PROJECTED;
128 #endif
129 }
130
131 //from a 2d point, compute the vector through that point
132 void g3_point_2_vec(vms_vector *v,short sx,short sy)
133 {
134         vms_vector tempv;
135         vms_matrix tempm;
136
137         tempv.x =  fixmuldiv(fixdiv((sx<<16) - Canv_w2,Canv_w2),Matrix_scale.z,Matrix_scale.x);
138         tempv.y = -fixmuldiv(fixdiv((sy<<16) - Canv_h2,Canv_h2),Matrix_scale.z,Matrix_scale.y);
139         tempv.z = f1_0;
140
141         vm_vec_normalize(&tempv);
142
143         vm_copy_transpose_matrix(&tempm,&Unscaled_matrix);
144
145         vm_vec_rotate(v,&tempv,&tempm);
146
147 }
148
149 //delta rotation functions
150 vms_vector *g3_rotate_delta_x(vms_vector *dest,fix dx)
151 {
152         dest->x = fixmul(View_matrix.rvec.x,dx);
153         dest->y = fixmul(View_matrix.uvec.x,dx);
154         dest->z = fixmul(View_matrix.fvec.x,dx);
155
156         return dest;
157 }
158
159 vms_vector *g3_rotate_delta_y(vms_vector *dest,fix dy)
160 {
161         dest->x = fixmul(View_matrix.rvec.y,dy);
162         dest->y = fixmul(View_matrix.uvec.y,dy);
163         dest->z = fixmul(View_matrix.fvec.y,dy);
164
165         return dest;
166 }
167
168 vms_vector *g3_rotate_delta_z(vms_vector *dest,fix dz)
169 {
170         dest->x = fixmul(View_matrix.rvec.z,dz);
171         dest->y = fixmul(View_matrix.uvec.z,dz);
172         dest->z = fixmul(View_matrix.fvec.z,dz);
173
174         return dest;
175 }
176
177
178 vms_vector *g3_rotate_delta_vec(vms_vector *dest,vms_vector *src)
179 {
180         return vm_vec_rotate(dest,src,&View_matrix);
181 }
182
183 ubyte g3_add_delta_vec(g3s_point *dest,g3s_point *src,vms_vector *deltav)
184 {
185         vm_vec_add(&dest->p3_vec,&src->p3_vec,deltav);
186
187         dest->p3_flags = 0;             //not projected
188
189         return g3_code_point(dest);
190 }
191
192 //calculate the depth of a point - returns the z coord of the rotated point
193 fix g3_calc_point_depth(vms_vector *pnt)
194 {
195         quadint q;
196
197         q.low=q.high=0;
198         fixmulaccum(&q,(pnt->x - View_position.x),View_matrix.fvec.x);
199         fixmulaccum(&q,(pnt->y - View_position.y),View_matrix.fvec.y);
200         fixmulaccum(&q,(pnt->z - View_position.z),View_matrix.fvec.z);
201
202         return fixquadadjust(&q);
203 }
204
205
206