bugfix and cleanup
[blender.git] / source / blender / blenlib / intern / uvproject.c
1 /**
2  * $Id$
3  *
4  * ***** BEGIN GPL LICENSE BLOCK *****
5  *
6  * This program is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU General Public License
8  * as published by the Free Software Foundation; either version 2
9  * of the License, or (at your option) any later version.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program; if not, write to the Free Software Foundation,
18  * Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
19  *
20  * ***** END GPL LICENSE BLOCK *****
21  */
22
23 #include <math.h>
24
25 #include "MEM_guardedalloc.h"
26
27 #include "DNA_camera_types.h"
28 #include "DNA_object_types.h"
29
30 #include "BLI_math.h"
31
32 typedef struct UvCameraInfo {
33         float camangle;
34         float camsize;
35         float xasp, yasp;
36         float shiftx, shifty;
37         float rotmat[4][4];
38         float caminv[4][4];
39         short do_persp, do_pano, do_rotmat;
40 } UvCameraInfo;
41
42 void project_from_camera(float target[2], float source[3], UvCameraInfo *uci)
43 {
44         float pv4[4];
45
46         copy_v3_v3(pv4, source);
47         pv4[3]= 1.0;
48
49         /* rotmat is the object matrix in this case */
50         if(uci->do_rotmat)
51                 mul_m4_v4(uci->rotmat, pv4);
52
53         /* caminv is the inverse camera matrix */
54         mul_m4_v4(uci->caminv, pv4);
55
56         if(uci->do_pano) {
57                 float angle= atan2f(pv4[0], -pv4[2]) / (M_PI * 2.0); /* angle around the camera */
58                 if (uci->do_persp==0) {
59                         target[0]= angle; /* no correct method here, just map to  0-1 */
60                         target[1]= pv4[1] / uci->camsize;
61                 }
62                 else {
63                         float vec2d[2]= {pv4[0], pv4[2]}; /* 2D position from the camera */
64                         target[0]= angle * (M_PI / uci->camangle);
65                         target[1]= pv4[1] / (len_v2(vec2d) * uci->camsize);
66                 }
67         }
68         else {
69                 if (pv4[2]==0.0f) pv4[2]= 0.00001f; /* don't allow div by 0 */
70
71                 if (uci->do_persp==0) {
72                         target[0]= (pv4[0]/uci->camsize);
73                         target[1]= (pv4[1]/uci->camsize);
74                 }
75                 else {
76                         target[0]= (-pv4[0]*((1.0f/uci->camsize)/pv4[2])) / 2.0f;
77                         target[1]= (-pv4[1]*((1.0f/uci->camsize)/pv4[2])) / 2.0f;
78                 }
79         }
80
81         target[0] *= uci->xasp;
82         target[1] *= uci->yasp;
83         
84         /* adds camera shift + 0.5 */
85         target[0] += uci->shiftx;
86         target[1] += uci->shifty;
87 }
88
89 /* could rv3d->persmat */
90 void project_from_view(float target[2], float source[3], float persmat[4][4], float rotmat[4][4], float winx, float winy)
91 {
92         float pv[3], pv4[4], x= 0.0, y= 0.0;
93
94         mul_v3_m4v3(pv, rotmat, source);
95
96         copy_v3_v3(pv4, source);
97         pv4[3]= 1.0;
98
99         /* rotmat is the object matrix in this case */
100         mul_m4_v4(rotmat, pv4); 
101
102         /* almost project_short */
103         mul_m4_v4(persmat, pv4);
104         if(fabs(pv4[3]) > 0.00001) { /* avoid division by zero */
105                 target[0] = winx/2.0 + (winx/2.0) * pv4[0] / pv4[3];
106                 target[1] = winy/2.0 + (winy/2.0) * pv4[1] / pv4[3];
107         }
108         else {
109                 /* scaling is lost but give a valid result */
110                 target[0] = winx/2.0 + (winx/2.0) * pv4[0];
111                 target[1] = winy/2.0 + (winy/2.0) * pv4[1];
112         }
113
114         /* v3d->persmat seems to do this funky scaling */ 
115         if(winx > winy) {
116                 y= (winx - winy)/2.0;
117                 winy = winx;
118         }
119         else {
120                 x= (winy - winx)/2.0;
121                 winx = winy;
122         }
123
124         target[0]= (x + target[0]) / winx;
125         target[1]= (y + target[1]) / winy;
126 }
127
128 /* 'rotmat' can be obedit->obmat when uv project is used.
129  * 'winx' and 'winy' can be from scene->r.xsch/ysch */ 
130 UvCameraInfo *project_camera_info(Object *ob, float (*rotmat)[4], float winx, float winy)
131 {
132         UvCameraInfo uci;
133         Camera *camera= ob->data;
134
135         uci.do_pano = (camera->flag & CAM_PANORAMA);
136         uci.do_persp = (camera->type==CAM_PERSP);
137
138         uci.camangle= lens_to_angle(camera->lens) / 2.0f;
139         uci.camsize= uci.do_persp ? tanf(uci.camangle) : camera->ortho_scale;
140
141         if (invert_m4_m4(uci.caminv, ob->obmat)) {
142                 UvCameraInfo *uci_pt;
143
144                 /* normal projection */
145                 if(rotmat) {
146                         copy_m4_m4(uci.rotmat, rotmat);
147                         uci.do_rotmat= 1;
148                 }
149                 else {
150                         uci.do_rotmat= 0;
151                 }
152
153                 /* also make aspect ratio adjustment factors */
154                 if (winx > winy) {
155                         uci.xasp= 1.0f;
156                         uci.yasp= winx / winy;
157                 }
158                 else {
159                         uci.xasp= winy / winx;
160                         uci.yasp= 1.0f;
161                 }
162                 
163                 /* include 0.5f here to move the UVs into the center */
164                 uci.shiftx = 0.5f - camera->shiftx;
165                 uci.shifty = 0.5f - camera->shifty;
166                 
167                 uci_pt= MEM_mallocN(sizeof(UvCameraInfo), "UvCameraInfo");
168                 *uci_pt= uci;
169                 return uci_pt;
170         }
171
172         return NULL;
173 }
174
175 void project_from_view_ortho(float target[2], float source[3], float rotmat[4][4])
176 {
177         float pv[3];
178
179         mul_v3_m4v3(pv, rotmat, source);
180
181         /* ortho projection */
182         target[0] = -pv[0];
183         target[1] = pv[2];
184 }