annotate TaskManager/Test/test_render/sys.cpp @ 174:559b48b69b76

getScale()、getTapestry から、span->length に適切なテクスチャの選択に成功
author gongo@localhost.localdomain
date Fri, 12 Dec 2008 12:23:20 +0900
parents d5cca23ed50c
children 08e2bb36639b
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
160
gongo@localhost.localdomain
parents: 109
diff changeset
1 #include <stdlib.h>
109
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
2 #include <iostream>
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
3 #include <math.h>
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
4 #include "sys.h"
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
5 using namespace std;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
6
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
7 void noMoreMemory()
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
8 {
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
9 cout << "can't allocate memory\n";
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
10 exit(1);
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
11 }
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
12
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
13 void matrix4x4(float *xyz, float *xyz1, float *xyz2) //xyz[16]
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
14 {
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
15 for(int t=0; t<16; t+=4)
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
16 {
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
17 for(int i=0; i<4; i++)
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
18 {
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
19 xyz[t+i] = xyz1[t]*xyz2[i] + xyz1[t+1]*xyz2[4+i] + xyz1[t+2]*xyz2[8+i] + xyz1[t+3]*xyz2[12+i];
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
20 }
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
21 }
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
22 }
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
23
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
24 void get_matrix( float *matrix, float *rxyz, float *txyz, float *stack)
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
25 {
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
26 float radx,rady,radz;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
27 radx = rxyz[0]*3.14/180;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
28 rady = rxyz[1]*3.14/180;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
29 radz = rxyz[2]*3.14/180;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
30
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
31 float sinx = sin(radx);
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
32 float cosx = cos(radx);
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
33 float siny = sin(rady);
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
34 float cosy = cos(rady);
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
35 float sinz = sin(radz);
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
36 float cosz = cos(radz);
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
37
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
38 matrix[0] = cosz*cosy+sinz*sinx*siny;
174
559b48b69b76 getScale()、getTapestry から、span->length に適切なテクスチャの選択に成功
gongo@localhost.localdomain
parents: 160
diff changeset
39 matrix[1] = sinz*cosx;
109
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
40 matrix[2] = -cosz*siny+sinz*sinx*cosy;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
41 matrix[3] = 0;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
42 matrix[4] = -sinz*cosy+cosz*sinx*siny;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
43 matrix[5] = cosz*cosx;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
44 matrix[6] = sinz*siny+cosz*sinx*cosy;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
45 matrix[7] = 0;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
46 matrix[8] = cosx*siny;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
47 matrix[9] = -sinx;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
48 matrix[10] = cosx*cosy;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
49 matrix[11] = 0;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
50 matrix[12] = txyz[0];
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
51 matrix[13] = txyz[1];
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
52 matrix[14] = txyz[2];
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
53 matrix[15] = 1;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
54
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
55 float m[16];
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
56
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
57 for(int i=0; i<16; i++)
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
58 {
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
59 m[i] = matrix[i];
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
60 }
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
61
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
62 if(stack)
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
63 {
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
64 matrix4x4(matrix, m, stack);
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
65 }
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
66
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
67 }
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
68
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
69 void rotate_x(float *xyz, float r)
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
70 {
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
71 float rad = r*3.14/180;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
72
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
73 xyz[0] = xyz[0];
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
74 xyz[1] = xyz[1]*cos(rad) - xyz[2]*sin(rad);
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
75 xyz[2] = xyz[1]*sin(rad) + xyz[2]*cos(rad);
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
76 }
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
77
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
78 void rotate_y(float *xyz, float r)
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
79 {
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
80 float rad = r*3.14/180;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
81
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
82 xyz[0] = xyz[0]*cos(rad) + xyz[2]*sin(rad);
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
83 xyz[1] = xyz[1];
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
84 xyz[2] = -xyz[0]*sin(rad) + xyz[2]*cos(rad);
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
85 }
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
86
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
87 void rotate_z(float *xyz, float r)
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
88 {
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
89 float rad = r*3.14/180;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
90
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
91 xyz[0] = xyz[0]*cos(rad) - xyz[1]*sin(rad);
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
92 xyz[1] = xyz[0]*sin(rad) + xyz[1]*cos(rad);
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
93 xyz[2] = xyz[2];
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
94 }
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
95
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
96 void rotate(float *xyz, float *matrix)
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
97 {
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
98 float abc[4];
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
99 abc[0] = xyz[0];
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
100 abc[1] = xyz[1];
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
101 abc[2] = xyz[2];
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
102 abc[3] = xyz[3];
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
103
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
104 for(int i=0; i<4; i++)
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
105 {
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
106 //xyz[i] = abc[0]*rot[i] + abc[1]*rot[i+4] + abc[2]*rot[i+8] + abc[3]*rot[i+12];
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
107 xyz[i] = abc[0]*matrix[i] + abc[1]*matrix[i+4] + abc[2]*matrix[i+8] + abc[3]*matrix[i+12];
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
108 }
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
109 }
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
110
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
111
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
112 void translate(float *xyz, float x, float y, float z)
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
113 {
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
114 xyz[0] += x;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
115 xyz[1] += y;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
116 xyz[2] += z;
5c194c71eca8 Cerium cvs version
gongo@gendarme.local
parents:
diff changeset
117 }