1
2 /*
3 * Mesa 3-D graphics library
4 * Version: 5.1
5 *
6 * Copyright (C) 1999-2003 Brian Paul All Rights Reserved.
7 *
8 * Permission is hereby granted, free of charge, to any person obtaining a
9 * copy of this software and associated documentation files (the "Software"),
10 * to deal in the Software without restriction, including without limitation
11 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
12 * and/or sell copies of the Software, and to permit persons to whom the
13 * Software is furnished to do so, subject to the following conditions:
14 *
15 * The above copyright notice and this permission notice shall be included
16 * in all copies or substantial portions of the Software.
17 *
18 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
19 * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
20 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
21 * BRIAN PAUL BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN
22 * AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
23 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
24 */
25
26 /*
27 * New (3.1) transformation code written by Keith Whitwell.
28 */
29
30 /* Functions to tranform a vector of normals. This includes applying
31 * the transformation matrix, rescaling and normalization.
32 */
33
34 /*
35 * mat - the 4x4 transformation matrix
36 * scale - uniform scale factor of the transformation matrix (not always used)
37 * in - the source vector of normals
38 * lengths - length of each incoming normal (may be NULL) (a display list
39 * optimization)
40 * dest - the destination vector of normals
41 */
42 static void _XFORMAPI
TAG(transform_normalize_normals)43 TAG(transform_normalize_normals)( const GLmatrix *mat,
44 GLfloat scale,
45 const GLvector4f *in,
46 const GLfloat *lengths,
47 GLvector4f *dest )
48 {
49 GLfloat (*out)[4] = (GLfloat (*)[4])dest->start;
50 const GLfloat *from = in->start;
51 const GLuint stride = in->stride;
52 const GLuint count = in->count;
53 const GLfloat *m = mat->inv;
54 GLfloat m0 = m[0], m4 = m[4], m8 = m[8];
55 GLfloat m1 = m[1], m5 = m[5], m9 = m[9];
56 GLfloat m2 = m[2], m6 = m[6], m10 = m[10];
57 GLuint i;
58
59 if (!lengths) {
60 STRIDE_LOOP {
61 GLfloat tx, ty, tz;
62 {
63 const GLfloat ux = from[0], uy = from[1], uz = from[2];
64 tx = ux * m0 + uy * m1 + uz * m2;
65 ty = ux * m4 + uy * m5 + uz * m6;
66 tz = ux * m8 + uy * m9 + uz * m10;
67 }
68 {
69 GLdouble len = tx*tx + ty*ty + tz*tz;
70 if (len > 1e-20) {
71 GLfloat scale = INV_SQRTF(len);
72 out[i][0] = tx * scale;
73 out[i][1] = ty * scale;
74 out[i][2] = tz * scale;
75 }
76 else {
77 out[i][0] = out[i][1] = out[i][2] = 0;
78 }
79 }
80 }
81 }
82 else {
83 if (scale != 1.0) {
84 m0 *= scale, m4 *= scale, m8 *= scale;
85 m1 *= scale, m5 *= scale, m9 *= scale;
86 m2 *= scale, m6 *= scale, m10 *= scale;
87 }
88
89 STRIDE_LOOP {
90 GLfloat tx, ty, tz;
91 {
92 const GLfloat ux = from[0], uy = from[1], uz = from[2];
93 tx = ux * m0 + uy * m1 + uz * m2;
94 ty = ux * m4 + uy * m5 + uz * m6;
95 tz = ux * m8 + uy * m9 + uz * m10;
96 }
97 {
98 GLfloat len = lengths[i];
99 out[i][0] = tx * len;
100 out[i][1] = ty * len;
101 out[i][2] = tz * len;
102 }
103 }
104 }
105 dest->count = in->count;
106 }
107
108
109 static void _XFORMAPI
TAG(transform_normalize_normals_no_rot)110 TAG(transform_normalize_normals_no_rot)( const GLmatrix *mat,
111 GLfloat scale,
112 const GLvector4f *in,
113 const GLfloat *lengths,
114 GLvector4f *dest )
115 {
116 GLfloat (*out)[4] = (GLfloat (*)[4])dest->start;
117 const GLfloat *from = in->start;
118 const GLuint stride = in->stride;
119 const GLuint count = in->count;
120 const GLfloat *m = mat->inv;
121 GLfloat m0 = m[0];
122 GLfloat m5 = m[5];
123 GLfloat m10 = m[10];
124 GLuint i;
125
126 if (!lengths) {
127 STRIDE_LOOP {
128 GLfloat tx, ty, tz;
129 {
130 const GLfloat ux = from[0], uy = from[1], uz = from[2];
131 tx = ux * m0 ;
132 ty = uy * m5 ;
133 tz = uz * m10;
134 }
135 {
136 GLdouble len = tx*tx + ty*ty + tz*tz;
137 if (len > 1e-20) {
138 GLfloat scale = INV_SQRTF(len);
139 out[i][0] = tx * scale;
140 out[i][1] = ty * scale;
141 out[i][2] = tz * scale;
142 }
143 else {
144 out[i][0] = out[i][1] = out[i][2] = 0;
145 }
146 }
147 }
148 }
149 else {
150 m0 *= scale;
151 m5 *= scale;
152 m10 *= scale;
153
154 STRIDE_LOOP {
155 GLfloat tx, ty, tz;
156 {
157 const GLfloat ux = from[0], uy = from[1], uz = from[2];
158 tx = ux * m0 ;
159 ty = uy * m5 ;
160 tz = uz * m10;
161 }
162 {
163 GLfloat len = lengths[i];
164 out[i][0] = tx * len;
165 out[i][1] = ty * len;
166 out[i][2] = tz * len;
167 }
168 }
169 }
170 dest->count = in->count;
171 }
172
173
174 static void _XFORMAPI
TAG(transform_rescale_normals_no_rot)175 TAG(transform_rescale_normals_no_rot)( const GLmatrix *mat,
176 GLfloat scale,
177 const GLvector4f *in,
178 const GLfloat *lengths,
179 GLvector4f *dest )
180 {
181 GLfloat (*out)[4] = (GLfloat (*)[4])dest->start;
182 const GLfloat *from = in->start;
183 const GLuint stride = in->stride;
184 const GLuint count = in->count;
185 const GLfloat *m = mat->inv;
186 const GLfloat m0 = scale*m[0];
187 const GLfloat m5 = scale*m[5];
188 const GLfloat m10 = scale*m[10];
189 GLuint i;
190
191 (void) lengths;
192
193 STRIDE_LOOP {
194 GLfloat ux = from[0], uy = from[1], uz = from[2];
195 out[i][0] = ux * m0;
196 out[i][1] = uy * m5;
197 out[i][2] = uz * m10;
198 }
199 dest->count = in->count;
200 }
201
202
203 static void _XFORMAPI
TAG(transform_rescale_normals)204 TAG(transform_rescale_normals)( const GLmatrix *mat,
205 GLfloat scale,
206 const GLvector4f *in,
207 const GLfloat *lengths,
208 GLvector4f *dest )
209 {
210 GLfloat (*out)[4] = (GLfloat (*)[4])dest->start;
211 const GLfloat *from = in->start;
212 const GLuint stride = in->stride;
213 const GLuint count = in->count;
214 /* Since we are unlikely to have < 3 vertices in the buffer,
215 * it makes sense to pre-multiply by scale.
216 */
217 const GLfloat *m = mat->inv;
218 const GLfloat m0 = scale*m[0], m4 = scale*m[4], m8 = scale*m[8];
219 const GLfloat m1 = scale*m[1], m5 = scale*m[5], m9 = scale*m[9];
220 const GLfloat m2 = scale*m[2], m6 = scale*m[6], m10 = scale*m[10];
221 GLuint i;
222
223 (void) lengths;
224
225 STRIDE_LOOP {
226 GLfloat ux = from[0], uy = from[1], uz = from[2];
227 out[i][0] = ux * m0 + uy * m1 + uz * m2;
228 out[i][1] = ux * m4 + uy * m5 + uz * m6;
229 out[i][2] = ux * m8 + uy * m9 + uz * m10;
230 }
231 dest->count = in->count;
232 }
233
234
235 static void _XFORMAPI
TAG(transform_normals_no_rot)236 TAG(transform_normals_no_rot)( const GLmatrix *mat,
237 GLfloat scale,
238 const GLvector4f *in,
239 const GLfloat *lengths,
240 GLvector4f *dest )
241 {
242 GLfloat (*out)[4] = (GLfloat (*)[4])dest->start;
243 const GLfloat *from = in->start;
244 const GLuint stride = in->stride;
245 const GLuint count = in->count;
246 const GLfloat *m = mat->inv;
247 const GLfloat m0 = m[0];
248 const GLfloat m5 = m[5];
249 const GLfloat m10 = m[10];
250 GLuint i;
251
252 (void) scale;
253 (void) lengths;
254
255 STRIDE_LOOP {
256 GLfloat ux = from[0], uy = from[1], uz = from[2];
257 out[i][0] = ux * m0;
258 out[i][1] = uy * m5;
259 out[i][2] = uz * m10;
260 }
261 dest->count = in->count;
262 }
263
264
265 static void _XFORMAPI
TAG(transform_normals)266 TAG(transform_normals)( const GLmatrix *mat,
267 GLfloat scale,
268 const GLvector4f *in,
269 const GLfloat *lengths,
270 GLvector4f *dest )
271 {
272 GLfloat (*out)[4] = (GLfloat (*)[4])dest->start;
273 const GLfloat *from = in->start;
274 const GLuint stride = in->stride;
275 const GLuint count = in->count;
276 const GLfloat *m = mat->inv;
277 const GLfloat m0 = m[0], m4 = m[4], m8 = m[8];
278 const GLfloat m1 = m[1], m5 = m[5], m9 = m[9];
279 const GLfloat m2 = m[2], m6 = m[6], m10 = m[10];
280 GLuint i;
281
282 (void) scale;
283 (void) lengths;
284
285 STRIDE_LOOP {
286 GLfloat ux = from[0], uy = from[1], uz = from[2];
287 out[i][0] = ux * m0 + uy * m1 + uz * m2;
288 out[i][1] = ux * m4 + uy * m5 + uz * m6;
289 out[i][2] = ux * m8 + uy * m9 + uz * m10;
290 }
291 dest->count = in->count;
292 }
293
294
295 static void _XFORMAPI
TAG(normalize_normals)296 TAG(normalize_normals)( const GLmatrix *mat,
297 GLfloat scale,
298 const GLvector4f *in,
299 const GLfloat *lengths,
300 GLvector4f *dest )
301 {
302 GLfloat (*out)[4] = (GLfloat (*)[4])dest->start;
303 const GLfloat *from = in->start;
304 const GLuint stride = in->stride;
305 const GLuint count = in->count;
306 GLuint i;
307
308 (void) mat;
309 (void) scale;
310
311 if (lengths) {
312 STRIDE_LOOP {
313 const GLfloat x = from[0], y = from[1], z = from[2];
314 GLfloat invlen = lengths[i];
315 out[i][0] = x * invlen;
316 out[i][1] = y * invlen;
317 out[i][2] = z * invlen;
318 }
319 }
320 else {
321 STRIDE_LOOP {
322 const GLfloat x = from[0], y = from[1], z = from[2];
323 GLdouble len = x * x + y * y + z * z;
324 if (len > 1e-50) {
325 len = INV_SQRTF(len);
326 out[i][0] = (GLfloat)(x * len);
327 out[i][1] = (GLfloat)(y * len);
328 out[i][2] = (GLfloat)(z * len);
329 }
330 else {
331 out[i][0] = x;
332 out[i][1] = y;
333 out[i][2] = z;
334 }
335 }
336 }
337 dest->count = in->count;
338 }
339
340
341 static void _XFORMAPI
TAG(rescale_normals)342 TAG(rescale_normals)( const GLmatrix *mat,
343 GLfloat scale,
344 const GLvector4f *in,
345 const GLfloat *lengths,
346 GLvector4f *dest )
347 {
348 GLfloat (*out)[4] = (GLfloat (*)[4])dest->start;
349 const GLfloat *from = in->start;
350 const GLuint stride = in->stride;
351 const GLuint count = in->count;
352 GLuint i;
353
354 (void) mat;
355 (void) lengths;
356
357 STRIDE_LOOP {
358 SCALE_SCALAR_3V( out[i], scale, from );
359 }
360 dest->count = in->count;
361 }
362
363
364 static void _XFORMAPI
TAG(init_c_norm_transform)365 TAG(init_c_norm_transform)( void )
366 {
367 _mesa_normal_tab[NORM_TRANSFORM_NO_ROT] =
368 TAG(transform_normals_no_rot);
369
370 _mesa_normal_tab[NORM_TRANSFORM_NO_ROT | NORM_RESCALE] =
371 TAG(transform_rescale_normals_no_rot);
372
373 _mesa_normal_tab[NORM_TRANSFORM_NO_ROT | NORM_NORMALIZE] =
374 TAG(transform_normalize_normals_no_rot);
375
376 _mesa_normal_tab[NORM_TRANSFORM] =
377 TAG(transform_normals);
378
379 _mesa_normal_tab[NORM_TRANSFORM | NORM_RESCALE] =
380 TAG(transform_rescale_normals);
381
382 _mesa_normal_tab[NORM_TRANSFORM | NORM_NORMALIZE] =
383 TAG(transform_normalize_normals);
384
385 _mesa_normal_tab[NORM_RESCALE] =
386 TAG(rescale_normals);
387
388 _mesa_normal_tab[NORM_NORMALIZE] =
389 TAG(normalize_normals);
390 }
391