Bugfix [#27157] keyframing a constrained bone does not work as before
[blender.git] / source / blender / editors / transform / transform_input.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  * Contributor(s): none yet.
21  *
22  * ***** END GPL LICENSE BLOCK *****
23  */
24
25 /** \file blender/editors/transform/transform_input.c
26  *  \ingroup edtransform
27  */
28
29
30 #include <stdlib.h>
31 #include <math.h>
32
33 #include "DNA_screen_types.h"
34
35 #include "BLI_math.h"
36 #include "BLI_utildefines.h"
37
38 #include "WM_types.h"
39
40 #include "transform.h"
41
42 #include "MEM_guardedalloc.h" 
43
44 /* ************************** INPUT FROM MOUSE *************************** */
45
46 static void InputVector(TransInfo *t, MouseInput *mi, const int mval[2], float output[3])
47 {
48         float vec[3], dvec[3];
49         if(mi->precision)
50         {
51                 /* calculate the main translation and the precise one separate */
52                 convertViewVec(t, dvec, (mval[0] - mi->precision_mval[0]), (mval[1] - mi->precision_mval[1]));
53                 mul_v3_fl(dvec, 0.1f);
54                 convertViewVec(t, vec, (mi->precision_mval[0] - t->imval[0]), (mi->precision_mval[1] - t->imval[1]));
55                 add_v3_v3v3(output, vec, dvec);
56         }
57         else
58         {
59                 convertViewVec(t, output, (mval[0] - t->imval[0]), (mval[1] - t->imval[1]));
60         }
61
62 }
63
64 static void InputSpring(TransInfo *UNUSED(t), MouseInput *mi, const int mval[2], float output[3])
65 {
66         float ratio, precise_ratio, dx, dy;
67         if(mi->precision)
68         {
69                 /* calculate ratio for shiftkey pos, and for total, and blend these for precision */
70                 dx = (float)(mi->center[0] - mi->precision_mval[0]);
71                 dy = (float)(mi->center[1] - mi->precision_mval[1]);
72                 ratio = (float)sqrt( dx*dx + dy*dy);
73
74                 dx= (float)(mi->center[0] - mval[0]);
75                 dy= (float)(mi->center[1] - mval[1]);
76                 precise_ratio = (float)sqrt( dx*dx + dy*dy);
77
78                 ratio = (ratio + (precise_ratio - ratio) / 10.0f) / mi->factor;
79         }
80         else
81         {
82                 dx = (float)(mi->center[0] - mval[0]);
83                 dy = (float)(mi->center[1] - mval[1]);
84                 ratio = (float)sqrt( dx*dx + dy*dy) / mi->factor;
85         }
86
87         output[0] = ratio;
88 }
89
90 static void InputSpringFlip(TransInfo *t, MouseInput *mi, const int mval[2], float output[3])
91 {
92         InputSpring(t, mi, mval, output);
93
94         /* flip scale */
95         /* values can become really big when zoomed in so use longs [#26598] */
96         if      ((long long int)(mi->center[0] - mval[0]) * (long long int)(mi->center[0] - mi->imval[0]) +
97                  (long long int)(mi->center[1] - mval[1]) * (long long int)(mi->center[1] - mi->imval[1]) < 0)
98          {
99                 output[0] *= -1.0f;
100          }
101 }
102
103 static void InputTrackBall(TransInfo *UNUSED(t), MouseInput *mi, const int mval[2], float output[3])
104 {
105
106         if(mi->precision)
107         {
108                 output[0] = ( mi->imval[1] - mi->precision_mval[1] ) + ( mi->precision_mval[1] - mval[1] ) * 0.1f;
109                 output[1] = ( mi->precision_mval[0] - mi->imval[0] ) + ( mval[0] - mi->precision_mval[0] ) * 0.1f;
110         }
111         else
112         {
113                 output[0] = (float)( mi->imval[1] - mval[1] );
114                 output[1] = (float)( mval[0] - mi->imval[0] );
115         }
116
117         output[0] *= mi->factor;
118         output[1] *= mi->factor;
119 }
120
121 static void InputHorizontalRatio(TransInfo *t, MouseInput *mi, const int mval[2], float output[3]) {
122         float x, pad;
123
124         pad = t->ar->winx / 10;
125
126         if (mi->precision)
127         {
128                 /* deal with Shift key by adding motion / 10 to motion before shift press */
129                 x = mi->precision_mval[0] + (float)(mval[0] - mi->precision_mval[0]) / 10.0f;
130         }
131         else {
132                 x = mval[0];
133         }
134
135         output[0] = (x - pad) / (t->ar->winx - 2 * pad);
136 }
137
138 static void InputHorizontalAbsolute(TransInfo *t, MouseInput *mi, const int mval[2], float output[3]) {
139         float vec[3];
140
141         InputVector(t, mi, mval, vec);
142         project_v3_v3v3(vec, vec, t->viewinv[0]);
143
144         output[0] = dot_v3v3(t->viewinv[0], vec) * 2.0f;
145 }
146
147 static void InputVerticalRatio(TransInfo *t, MouseInput *mi, const int mval[2], float output[3]) {
148         float y, pad;
149
150         pad = t->ar->winy / 10;
151
152         if (mi->precision) {
153                 /* deal with Shift key by adding motion / 10 to motion before shift press */
154                 y = mi->precision_mval[1] + (float)(mval[1] - mi->precision_mval[1]) / 10.0f;
155         }
156         else {
157                 y = mval[0];
158         }
159
160         output[0] = (y - pad) / (t->ar->winy - 2 * pad);
161 }
162
163 static void InputVerticalAbsolute(TransInfo *t, MouseInput *mi, const int mval[2], float output[3]) {
164         float vec[3];
165
166         InputVector(t, mi, mval, vec);
167         project_v3_v3v3(vec, vec, t->viewinv[1]);
168
169         output[0] = dot_v3v3(t->viewinv[1], vec) * 2.0f;
170 }
171
172 void setCustomPoints(TransInfo *UNUSED(t), MouseInput *mi, int start[2], int end[2])
173 {
174         int *data;
175
176         if (mi->data == NULL) {
177                 mi->data = MEM_callocN(sizeof(int) * 4, "custom points");
178         }
179         
180         data = mi->data;
181
182         data[0] = start[0];
183         data[1] = start[1];
184         data[2] = end[0];
185         data[3] = end[1];
186 }
187
188 static void InputCustomRatio(TransInfo *UNUSED(t), MouseInput *mi, const int mval[2], float output[3])
189 {
190         float length;
191         float distance;
192         int *data = mi->data;
193         int dx, dy;
194         
195         if (data) {
196                 dx = data[2] - data[0];
197                 dy = data[3] - data[1];
198                 
199                 length = (float)sqrtf(dx*dx + dy*dy);
200                 
201                 if (mi->precision) {
202                         /* deal with Shift key by adding motion / 10 to motion before shift press */
203                         int mdx, mdy;
204                         mdx = (mi->precision_mval[0] + (float)(mval[0] - mi->precision_mval[0]) / 10.0f) - data[2];
205                         mdy = (mi->precision_mval[1] + (float)(mval[1] - mi->precision_mval[1]) / 10.0f) - data[3];
206
207                         distance = (length != 0.0f)? (mdx*dx + mdy*dy) / length: 0.0f;
208                 }
209                 else {
210                         int mdx, mdy;
211                         mdx = mval[0] - data[2];
212                         mdy = mval[1] - data[3];
213
214                         distance = (length != 0.0f)? (mdx*dx + mdy*dy) / length: 0.0f;
215                 }
216
217                 output[0] = (length != 0.0f)? distance / length: 0.0f;
218         }
219 }
220
221 static void InputAngle(TransInfo *UNUSED(t), MouseInput *mi, const int mval[2], float output[3])
222 {
223         double dx2 = mval[0] - mi->center[0];
224         double dy2 = mval[1] - mi->center[1];
225         double B = sqrt(dx2*dx2+dy2*dy2);
226
227         double dx1 = mi->imval[0] - mi->center[0];
228         double dy1 = mi->imval[1] - mi->center[1];
229         double A = sqrt(dx1*dx1+dy1*dy1);
230
231         double dx3 = mval[0] - mi->imval[0];
232         double dy3 = mval[1] - mi->imval[1];
233
234         double *angle = mi->data;
235
236         /* use doubles here, to make sure a "1.0" (no rotation) doesnt become 9.999999e-01, which gives 0.02 for acos */
237         double deler = ((dx1*dx1+dy1*dy1)+(dx2*dx2+dy2*dy2)-(dx3*dx3+dy3*dy3))
238                 / (2.0 * ((A*B)?(A*B):1.0));
239         /* ((A*B)?(A*B):1.0) this takes care of potential divide by zero errors */
240
241         float dphi;
242
243         dphi = saacos((float)deler);
244         if( (dx1*dy2-dx2*dy1)>0.0 ) dphi= -dphi;
245
246         /* If the angle is zero, because of lack of precision close to the 1.0 value in acos
247          * approximate the angle with the opposite side of the normalized triangle
248          * This is a good approximation here since the smallest acos value seems to be around
249          * 0.02 degree and lower values don't even have a 0.01% error compared to the approximation
250          * */
251         if (dphi == 0)
252         {
253                 double dx, dy;
254
255                 dx2 /= A;
256                 dy2 /= A;
257
258                 dx1 /= B;
259                 dy1 /= B;
260
261                 dx = dx1 - dx2;
262                 dy = dy1 - dy2;
263
264                 dphi = sqrt(dx*dx + dy*dy);
265                 if( (dx1*dy2-dx2*dy1)>0.0 ) dphi= -dphi;
266         }
267
268         if(mi->precision) dphi = dphi/30.0f;
269
270         /* if no delta angle, don't update initial position */
271         if (dphi != 0)
272         {
273                 mi->imval[0] = mval[0];
274                 mi->imval[1] = mval[1];
275         }
276
277         *angle += (double)dphi;
278
279         output[0] = *angle;
280 }
281
282 void initMouseInput(TransInfo *UNUSED(t), MouseInput *mi, int center[2], int mval[2])
283 {
284         mi->factor = 0;
285         mi->precision = 0;
286
287         mi->center[0] = center[0];
288         mi->center[1] = center[1];
289
290         mi->imval[0] = mval[0];
291         mi->imval[1] = mval[1];
292
293         mi->post = NULL;
294 }
295
296 static void calcSpringFactor(MouseInput *mi)
297 {
298         mi->factor = (float)sqrt(
299                 (
300                         ((float)(mi->center[1] - mi->imval[1]))*((float)(mi->center[1] - mi->imval[1]))
301                 +
302                         ((float)(mi->center[0] - mi->imval[0]))*((float)(mi->center[0] - mi->imval[0]))
303                 ) );
304
305         if (mi->factor==0.0f)
306                 mi->factor= 1.0f; /* prevent Inf */
307 }
308
309 void initMouseInputMode(TransInfo *t, MouseInput *mi, MouseInputMode mode)
310 {
311
312         switch(mode)
313         {
314         case INPUT_VECTOR:
315                 mi->apply = InputVector;
316                 t->helpline = HLP_NONE;
317                 break;
318         case INPUT_SPRING:
319                 calcSpringFactor(mi);
320                 mi->apply = InputSpring;
321                 t->helpline = HLP_SPRING;
322                 break;
323         case INPUT_SPRING_FLIP:
324                 calcSpringFactor(mi);
325                 mi->apply = InputSpringFlip;
326                 t->helpline = HLP_SPRING;
327                 break;
328         case INPUT_ANGLE:
329                 mi->data = MEM_callocN(sizeof(double), "angle accumulator");
330                 mi->apply = InputAngle;
331                 t->helpline = HLP_ANGLE;
332                 break;
333         case INPUT_TRACKBALL:
334                 /* factor has to become setting or so */
335                 mi->factor = 0.01f;
336                 mi->apply = InputTrackBall;
337                 t->helpline = HLP_TRACKBALL;
338                 break;
339         case INPUT_HORIZONTAL_RATIO:
340                 mi->factor = (float)(mi->center[0] - mi->imval[0]);
341                 mi->apply = InputHorizontalRatio;
342                 t->helpline = HLP_HARROW;
343                 break;
344         case INPUT_HORIZONTAL_ABSOLUTE:
345                 mi->apply = InputHorizontalAbsolute;
346                 t->helpline = HLP_HARROW;
347                 break;
348         case INPUT_VERTICAL_RATIO:
349                 mi->apply = InputVerticalRatio;
350                 t->helpline = HLP_VARROW;
351                 break;
352         case INPUT_VERTICAL_ABSOLUTE:
353                 mi->apply = InputVerticalAbsolute;
354                 t->helpline = HLP_VARROW;
355                 break;
356         case INPUT_CUSTOM_RATIO:
357                 mi->apply = InputCustomRatio;
358                 t->helpline = HLP_NONE;
359                 break;
360         case INPUT_NONE:
361         default:
362                 mi->apply = NULL;
363                 break;
364         }
365
366         /* bootstrap mouse input with initial values */
367         applyMouseInput(t, mi, mi->imval, t->values);
368 }
369
370 void setInputPostFct(MouseInput *mi, void       (*post)(struct TransInfo *, float [3]))
371 {
372         mi->post = post;
373 }
374
375 void applyMouseInput(TransInfo *t, MouseInput *mi, const int mval[2], float output[3])
376 {
377         if (mi->apply != NULL)
378         {
379                 mi->apply(t, mi, mval, output);
380         }
381
382         if (mi->post)
383         {
384                 mi->post(t, output);
385         }
386 }
387
388 int handleMouseInput(TransInfo *t, MouseInput *mi, wmEvent *event)
389 {
390         int redraw = TREDRAW_NOTHING;
391
392         switch (event->type)
393         {
394         case LEFTSHIFTKEY:
395         case RIGHTSHIFTKEY:
396                 if (event->val==KM_PRESS)
397                 {
398                         t->modifiers |= MOD_PRECISION;
399                         /* shift is modifier for higher precision transform
400                          * store the mouse position where the normal movement ended */
401                         VECCOPY2D(mi->precision_mval, event->mval);
402                         mi->precision = 1;
403                 }
404                 else
405                 {
406                         t->modifiers &= ~MOD_PRECISION;
407                         mi->precision = 0;
408                 }
409                 redraw = TREDRAW_HARD;
410                 break;
411         }
412
413         return redraw;
414 }