Node Bugfixes:
[blender.git] / source / blender / editors / transform / transform.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., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
19  *
20  * The Original Code is Copyright (C) 2001-2002 by NaN Holding BV.
21  * All rights reserved.
22  *
23  * The Original Code is: all of this file.
24  *
25  * Contributor(s): none yet.
26  *
27  * ***** END GPL LICENSE BLOCK *****
28  */
29
30 #include <stdlib.h>
31 #include <stdio.h>
32 #include <string.h>
33 #include <math.h>
34 #include <float.h>
35
36 #ifdef HAVE_CONFIG_H
37 #include <config.h>
38 #endif
39
40 #ifndef WIN32
41 #include <unistd.h>
42 #else
43 #include <io.h>
44 #endif
45
46 #include "MEM_guardedalloc.h"
47
48 #include "DNA_anim_types.h"
49 #include "DNA_armature_types.h"
50 #include "DNA_action_types.h"  /* for some special action-editor settings */
51 #include "DNA_constraint_types.h"
52 #include "DNA_ipo_types.h"              /* some silly ipo flag  */
53 #include "DNA_listBase.h"
54 #include "DNA_meshdata_types.h"
55 #include "DNA_mesh_types.h"
56 #include "DNA_object_types.h"
57 #include "DNA_scene_types.h"            /* PET modes                    */
58 #include "DNA_screen_types.h"   /* area dimensions              */
59 #include "DNA_texture_types.h"
60 #include "DNA_userdef_types.h"
61 #include "DNA_view3d_types.h"
62 #include "DNA_space_types.h"
63 #include "DNA_windowmanager_types.h"
64
65 #include "RNA_access.h"
66
67 //#include "BIF_editview.h"             /* arrows_move_cursor   */
68 #include "BIF_gl.h"
69 #include "BIF_glutil.h"
70 //#include "BIF_mywindow.h"
71 //#include "BIF_resources.h"
72 //#include "BIF_screen.h"
73 //#include "BIF_space.h"                        /* undo                                 */
74 //#include "BIF_toets.h"                        /* persptoetsen                 */
75 //#include "BIF_mywindow.h"             /* warp_pointer                 */
76 //#include "BIF_toolbox.h"                      /* notice                               */
77 //#include "BIF_editmesh.h"
78 //#include "BIF_editsima.h"
79 //#include "BIF_editparticle.h"
80
81 #include "BKE_action.h"
82 #include "BKE_nla.h"
83 //#include "BKE_bad_level_calls.h"/* popmenu and error  */
84 #include "BKE_bmesh.h"
85 #include "BKE_context.h"
86 #include "BKE_constraint.h"
87 #include "BKE_global.h"
88 #include "BKE_particle.h"
89 #include "BKE_pointcache.h"
90 #include "BKE_utildefines.h"
91 #include "BKE_context.h"
92 #include "BKE_unit.h"
93
94 //#include "BSE_view.h"
95
96 #include "ED_image.h"
97 #include "ED_keyframing.h"
98 #include "ED_screen.h"
99 #include "ED_space_api.h"
100 #include "ED_markers.h"
101 #include "ED_util.h"
102 #include "ED_view3d.h"
103 #include "ED_mesh.h"
104
105 #include "UI_view2d.h"
106 #include "WM_types.h"
107 #include "WM_api.h"
108
109 #include "BLI_arithb.h"
110 #include "BLI_blenlib.h"
111 #include "BLI_editVert.h"
112 #include "BLI_ghash.h"
113 #include "BLI_linklist.h"
114
115 #include "PIL_time.h"                   /* sleep                                */
116
117 #include "UI_resources.h"
118
119 //#include "blendef.h"
120 //
121 //#include "mydevice.h"
122
123 #include "transform.h"
124
125 /* ************************** SPACE DEPENDANT CODE **************************** */
126
127 void setTransformViewMatrices(TransInfo *t)
128 {
129         if(t->spacetype==SPACE_VIEW3D && t->ar->regiontype == RGN_TYPE_WINDOW) {
130                 RegionView3D *rv3d = t->ar->regiondata;
131
132                 Mat4CpyMat4(t->viewmat, rv3d->viewmat);
133                 Mat4CpyMat4(t->viewinv, rv3d->viewinv);
134                 Mat4CpyMat4(t->persmat, rv3d->persmat);
135                 Mat4CpyMat4(t->persinv, rv3d->persinv);
136                 t->persp = rv3d->persp;
137         }
138         else {
139                 Mat4One(t->viewmat);
140                 Mat4One(t->viewinv);
141                 Mat4One(t->persmat);
142                 Mat4One(t->persinv);
143                 t->persp = V3D_ORTHO;
144         }
145
146         calculateCenter2D(t);
147 }
148
149 void convertViewVec(TransInfo *t, float *vec, short dx, short dy)
150 {
151         if (t->spacetype==SPACE_VIEW3D) {
152                 if (t->ar->regiontype == RGN_TYPE_WINDOW)
153                 {
154                         window_to_3d_delta(t->ar, vec, dx, dy);
155                 }
156         }
157         else if(t->spacetype==SPACE_IMAGE) {
158                 View2D *v2d = t->view;
159                 float divx, divy, aspx, aspy;
160
161                 ED_space_image_uv_aspect(t->sa->spacedata.first, &aspx, &aspy);
162
163                 divx= v2d->mask.xmax-v2d->mask.xmin;
164                 divy= v2d->mask.ymax-v2d->mask.ymin;
165
166                 vec[0]= aspx*(v2d->cur.xmax-v2d->cur.xmin)*(dx)/divx;
167                 vec[1]= aspy*(v2d->cur.ymax-v2d->cur.ymin)*(dy)/divy;
168                 vec[2]= 0.0f;
169         }
170         else if(ELEM(t->spacetype, SPACE_IPO, SPACE_NLA)) {
171                 View2D *v2d = t->view;
172                 float divx, divy;
173
174                 divx= v2d->mask.xmax-v2d->mask.xmin;
175                 divy= v2d->mask.ymax-v2d->mask.ymin;
176
177                 vec[0]= (v2d->cur.xmax-v2d->cur.xmin)*(dx) / (divx);
178                 vec[1]= (v2d->cur.ymax-v2d->cur.ymin)*(dy) / (divy);
179                 vec[2]= 0.0f;
180         }
181         else if(t->spacetype==SPACE_NODE) {
182                 View2D *v2d = &t->ar->v2d;
183                 float divx, divy;
184
185                 divx= v2d->mask.xmax-v2d->mask.xmin;
186                 divy= v2d->mask.ymax-v2d->mask.ymin;
187
188                 vec[0]= (v2d->cur.xmax-v2d->cur.xmin)*(dx)/divx;
189                 vec[1]= (v2d->cur.ymax-v2d->cur.ymin)*(dy)/divy;
190                 vec[2]= 0.0f;
191         }
192         else if(t->spacetype==SPACE_SEQ) {
193                 View2D *v2d = &t->ar->v2d;
194                 float divx, divy;
195
196                 divx= v2d->mask.xmax-v2d->mask.xmin;
197                 divy= v2d->mask.ymax-v2d->mask.ymin;
198
199                 vec[0]= (v2d->cur.xmax-v2d->cur.xmin)*(dx)/divx;
200                 vec[1]= (v2d->cur.ymax-v2d->cur.ymin)*(dy)/divy;
201                 vec[2]= 0.0f;
202         }
203 }
204
205 void projectIntView(TransInfo *t, float *vec, int *adr)
206 {
207         if (t->spacetype==SPACE_VIEW3D) {
208                 if(t->ar->regiontype == RGN_TYPE_WINDOW)
209                         project_int_noclip(t->ar, vec, adr);
210         }
211         else if(t->spacetype==SPACE_IMAGE) {
212                 float aspx, aspy, v[2];
213
214                 ED_space_image_uv_aspect(t->sa->spacedata.first, &aspx, &aspy);
215                 v[0]= vec[0]/aspx;
216                 v[1]= vec[1]/aspy;
217
218                 UI_view2d_to_region_no_clip(t->view, v[0], v[1], adr, adr+1);
219         }
220         else if(ELEM(t->spacetype, SPACE_IPO, SPACE_NLA)) {
221                 int out[2] = {0, 0};
222
223                 UI_view2d_view_to_region((View2D *)t->view, vec[0], vec[1], out, out+1);
224                 adr[0]= out[0];
225                 adr[1]= out[1];
226         }
227         else if(t->spacetype==SPACE_SEQ) { /* XXX not tested yet, but should work */
228                 int out[2] = {0, 0};
229
230                 UI_view2d_view_to_region((View2D *)t->view, vec[0], vec[1], out, out+1);
231                 adr[0]= out[0];
232                 adr[1]= out[1];
233         }
234 }
235
236 void projectFloatView(TransInfo *t, float *vec, float *adr)
237 {
238         if (t->spacetype==SPACE_VIEW3D) {
239                 if(t->ar->regiontype == RGN_TYPE_WINDOW)
240                         project_float_noclip(t->ar, vec, adr);
241         }
242         else if(t->spacetype==SPACE_IMAGE) {
243                 int a[2];
244
245                 projectIntView(t, vec, a);
246                 adr[0]= a[0];
247                 adr[1]= a[1];
248         }
249         else if(ELEM(t->spacetype, SPACE_IPO, SPACE_NLA)) {
250                 int a[2];
251
252                 projectIntView(t, vec, a);
253                 adr[0]= a[0];
254                 adr[1]= a[1];
255         }
256 }
257
258 void applyAspectRatio(TransInfo *t, float *vec)
259 {
260         SpaceImage *sima= t->sa->spacedata.first;
261
262         if ((t->spacetype==SPACE_IMAGE) && (t->mode==TFM_TRANSLATION)) {
263                 float aspx, aspy;
264
265                 if((sima->flag & SI_COORDFLOATS)==0) {
266                         int width, height;
267                         ED_space_image_size(sima, &width, &height);
268
269                         vec[0] *= width;
270                         vec[1] *= height;
271                 }
272
273                 ED_space_image_uv_aspect(sima, &aspx, &aspy);
274                 vec[0] /= aspx;
275                 vec[1] /= aspy;
276         }
277 }
278
279 void removeAspectRatio(TransInfo *t, float *vec)
280 {
281         SpaceImage *sima= t->sa->spacedata.first;
282
283         if ((t->spacetype==SPACE_IMAGE) && (t->mode==TFM_TRANSLATION)) {
284                 float aspx, aspy;
285
286                 if((sima->flag & SI_COORDFLOATS)==0) {
287                         int width, height;
288                         ED_space_image_size(sima, &width, &height);
289
290                         vec[0] /= width;
291                         vec[1] /= height;
292                 }
293
294                 ED_space_image_uv_aspect(sima, &aspx, &aspy);
295                 vec[0] *= aspx;
296                 vec[1] *= aspy;
297         }
298 }
299
300 static void viewRedrawForce(bContext *C, TransInfo *t)
301 {
302         if (t->spacetype == SPACE_VIEW3D)
303         {
304                 /* Do we need more refined tags? */
305                 WM_event_add_notifier(C, NC_OBJECT|ND_TRANSFORM, NULL);
306                 
307                 /* for realtime animation record - send notifiers recognised by animation editors */
308                 if ((t->animtimer) && IS_AUTOKEY_ON(t->scene))
309                         WM_event_add_notifier(C, NC_OBJECT|ND_KEYS, NULL);
310         }
311         else if (t->spacetype == SPACE_ACTION) {
312                 //SpaceAction *saction= (SpaceAction *)t->sa->spacedata.first;
313                 WM_event_add_notifier(C, NC_ANIMATION|ND_KEYFRAME_EDIT, NULL);
314         }
315         else if (t->spacetype == SPACE_IPO) {
316                 //SpaceIpo *sipo= (SpaceIpo *)t->sa->spacedata.first;
317                 WM_event_add_notifier(C, NC_ANIMATION|ND_KEYFRAME_EDIT, NULL);
318         }
319         else if (t->spacetype == SPACE_NLA) {
320                 WM_event_add_notifier(C, NC_ANIMATION|ND_NLA_EDIT, NULL);
321         }
322         else if(t->spacetype == SPACE_NODE)
323         {
324                 //ED_area_tag_redraw(t->sa);
325                 WM_event_add_notifier(C, NC_SPACE|ND_SPACE_NODE, NULL);
326         }
327         else if(t->spacetype == SPACE_SEQ)
328         {
329                 WM_event_add_notifier(C, NC_SCENE|ND_SEQUENCER, NULL);
330         }
331         else if (t->spacetype==SPACE_IMAGE) {
332                 // XXX how to deal with lock?
333 #if 0
334                 SpaceImage *sima= (SpaceImage*)t->sa->spacedata.first;
335                 if(sima->lock) force_draw_plus(SPACE_VIEW3D, 0);
336                 else force_draw(0);
337 #endif
338
339                 WM_event_add_notifier(C, NC_GEOM|ND_DATA, t->obedit->data);
340         }
341 }
342
343 static void viewRedrawPost(TransInfo *t)
344 {
345         ED_area_headerprint(t->sa, NULL);
346
347 #if 0 // TRANSFORM_FIX_ME
348         if(t->spacetype==SPACE_VIEW3D) {
349                 allqueue(REDRAWBUTSOBJECT, 0);
350                 allqueue(REDRAWVIEW3D, 0);
351         }
352         else if(t->spacetype==SPACE_IMAGE) {
353                 allqueue(REDRAWIMAGE, 0);
354                 allqueue(REDRAWVIEW3D, 0);
355         }
356         else if(ELEM3(t->spacetype, SPACE_ACTION, SPACE_NLA, SPACE_IPO)) {
357                 allqueue(REDRAWVIEW3D, 0);
358                 allqueue(REDRAWACTION, 0);
359                 allqueue(REDRAWNLA, 0);
360                 allqueue(REDRAWIPO, 0);
361                 allqueue(REDRAWTIME, 0);
362                 allqueue(REDRAWBUTSOBJECT, 0);
363         }
364
365         scrarea_queue_headredraw(curarea);
366 #endif
367 }
368
369 /* ************************** TRANSFORMATIONS **************************** */
370
371 void BIF_selectOrientation() {
372 #if 0 // TRANSFORM_FIX_ME
373         short val;
374         char *str_menu = BIF_menustringTransformOrientation("Orientation");
375         val= pupmenu(str_menu);
376         MEM_freeN(str_menu);
377
378         if(val >= 0) {
379                 G.vd->twmode = val;
380         }
381 #endif
382 }
383
384 static void view_editmove(unsigned short event)
385 {
386 #if 0 // TRANSFORM_FIX_ME
387         int refresh = 0;
388         /* Regular:   Zoom in */
389         /* Shift:     Scroll up */
390         /* Ctrl:      Scroll right */
391         /* Alt-Shift: Rotate up */
392         /* Alt-Ctrl:  Rotate right */
393
394         /* only work in 3D window for now
395          * In the end, will have to send to event to a 2D window handler instead
396          */
397         if (Trans.flag & T_2D_EDIT)
398                 return;
399
400         switch(event) {
401                 case WHEELUPMOUSE:
402
403                         if( G.qual & LR_SHIFTKEY ) {
404                                 if( G.qual & LR_ALTKEY ) {
405                                         G.qual &= ~LR_SHIFTKEY;
406                                         persptoetsen(PAD2);
407                                         G.qual |= LR_SHIFTKEY;
408                                 } else {
409                                         persptoetsen(PAD2);
410                                 }
411                         } else if( G.qual & LR_CTRLKEY ) {
412                                 if( G.qual & LR_ALTKEY ) {
413                                         G.qual &= ~LR_CTRLKEY;
414                                         persptoetsen(PAD4);
415                                         G.qual |= LR_CTRLKEY;
416                                 } else {
417                                         persptoetsen(PAD4);
418                                 }
419                         } else if(U.uiflag & USER_WHEELZOOMDIR)
420                                 persptoetsen(PADMINUS);
421                         else
422                                 persptoetsen(PADPLUSKEY);
423
424                         refresh = 1;
425                         break;
426                 case WHEELDOWNMOUSE:
427                         if( G.qual & LR_SHIFTKEY ) {
428                                 if( G.qual & LR_ALTKEY ) {
429                                         G.qual &= ~LR_SHIFTKEY;
430                                         persptoetsen(PAD8);
431                                         G.qual |= LR_SHIFTKEY;
432                                 } else {
433                                         persptoetsen(PAD8);
434                                 }
435                         } else if( G.qual & LR_CTRLKEY ) {
436                                 if( G.qual & LR_ALTKEY ) {
437                                         G.qual &= ~LR_CTRLKEY;
438                                         persptoetsen(PAD6);
439                                         G.qual |= LR_CTRLKEY;
440                                 } else {
441                                         persptoetsen(PAD6);
442                                 }
443                         } else if(U.uiflag & USER_WHEELZOOMDIR)
444                                 persptoetsen(PADPLUSKEY);
445                         else
446                                 persptoetsen(PADMINUS);
447
448                         refresh = 1;
449                         break;
450         }
451
452         if (refresh)
453                 setTransformViewMatrices(&Trans);
454 #endif
455 }
456
457 #if 0
458 static char *transform_to_undostr(TransInfo *t)
459 {
460         switch (t->mode) {
461                 case TFM_TRANSLATION:
462                         return "Translate";
463                 case TFM_ROTATION:
464                         return "Rotate";
465                 case TFM_RESIZE:
466                         return "Scale";
467                 case TFM_TOSPHERE:
468                         return "To Sphere";
469                 case TFM_SHEAR:
470                         return "Shear";
471                 case TFM_WARP:
472                         return "Warp";
473                 case TFM_SHRINKFATTEN:
474                         return "Shrink/Fatten";
475                 case TFM_TILT:
476                         return "Tilt";
477                 case TFM_TRACKBALL:
478                         return "Trackball";
479                 case TFM_PUSHPULL:
480                         return "Push/Pull";
481                 case TFM_BEVEL:
482                         return "Bevel";
483                 case TFM_BWEIGHT:
484                         return "Bevel Weight";
485                 case TFM_CREASE:
486                         return "Crease";
487                 case TFM_BONESIZE:
488                         return "Bone Width";
489                 case TFM_BONE_ENVELOPE:
490                         return "Bone Envelope";
491                 case TFM_TIME_TRANSLATE:
492                         return "Translate Anim. Data";
493                 case TFM_TIME_SCALE:
494                         return "Scale Anim. Data";
495                 case TFM_TIME_SLIDE:
496                         return "Time Slide";
497                 case TFM_BAKE_TIME:
498                         return "Key Time";
499                 case TFM_MIRROR:
500                         return "Mirror";
501         }
502         return "Transform";
503 }
504 #endif
505
506 /* ************************************************* */
507
508 /* NOTE: these defines are saved in keymap files, do not change values but just add new ones */
509 #define TFM_MODAL_CANCEL                        1
510 #define TFM_MODAL_CONFIRM                       2
511 #define TFM_MODAL_TRANSLATE                     3
512 #define TFM_MODAL_ROTATE                        4
513 #define TFM_MODAL_RESIZE                        5
514 #define TFM_MODAL_SNAP_GEARS            6
515 #define TFM_MODAL_SNAP_GEARS_OFF        7
516
517 /* called in transform_ops.c, on each regeneration of keymaps */
518 void transform_modal_keymap(wmWindowManager *wm)
519 {
520         static EnumPropertyItem modal_items[] = {
521         {TFM_MODAL_CANCEL, "CANCEL", 0, "Cancel", ""},
522         {TFM_MODAL_CONFIRM, "CONFIRM", 0, "Confirm", ""},
523         {TFM_MODAL_TRANSLATE, "TRANSLATE", 0, "Translate", ""},
524         {TFM_MODAL_ROTATE, "ROTATE", 0, "Rotate", ""},
525         {TFM_MODAL_RESIZE, "RESIZE", 0, "Resize", ""},
526         {TFM_MODAL_SNAP_GEARS, "SNAP_GEARS", 0, "Snap On", ""},
527         {TFM_MODAL_SNAP_GEARS_OFF, "SNAP_GEARS_OFF", 0, "Snap Off", ""},
528         {0, NULL, 0, NULL, NULL}};
529         
530         wmKeyMap *keymap= WM_modalkeymap_get(wm, "Transform Modal Map");
531         
532         /* this function is called for each spacetype, only needs to add map once */
533         if(keymap) return;
534         
535         keymap= WM_modalkeymap_add(wm, "Transform Modal Map", modal_items);
536         
537         /* items for modal map */
538         WM_modalkeymap_add_item(keymap, ESCKEY,    KM_PRESS, KM_ANY, 0, TFM_MODAL_CANCEL);
539         WM_modalkeymap_add_item(keymap, LEFTMOUSE, KM_ANY, KM_ANY, 0, TFM_MODAL_CONFIRM);
540         WM_modalkeymap_add_item(keymap, RETKEY, KM_PRESS, KM_ANY, 0, TFM_MODAL_CONFIRM);
541         WM_modalkeymap_add_item(keymap, PADENTER, KM_PRESS, KM_ANY, 0, TFM_MODAL_CONFIRM);
542
543         WM_modalkeymap_add_item(keymap, GKEY, KM_PRESS, 0, 0, TFM_MODAL_TRANSLATE);
544         WM_modalkeymap_add_item(keymap, RKEY, KM_PRESS, 0, 0, TFM_MODAL_ROTATE);
545         WM_modalkeymap_add_item(keymap, SKEY, KM_PRESS, 0, 0, TFM_MODAL_RESIZE);
546         
547         WM_modalkeymap_add_item(keymap, LEFTCTRLKEY, KM_PRESS, KM_ANY, 0, TFM_MODAL_SNAP_GEARS);
548         WM_modalkeymap_add_item(keymap, LEFTCTRLKEY, KM_RELEASE, KM_ANY, 0, TFM_MODAL_SNAP_GEARS_OFF);
549         
550         /* assign map to operators */
551         WM_modalkeymap_assign(keymap, "TFM_OT_transform");
552         WM_modalkeymap_assign(keymap, "TFM_OT_translate");
553         WM_modalkeymap_assign(keymap, "TFM_OT_rotate");
554         WM_modalkeymap_assign(keymap, "TFM_OT_tosphere");
555         WM_modalkeymap_assign(keymap, "TFM_OT_resize");
556         WM_modalkeymap_assign(keymap, "TFM_OT_shear");
557         WM_modalkeymap_assign(keymap, "TFM_OT_warp");
558         WM_modalkeymap_assign(keymap, "TFM_OT_shrink_fatten");
559         WM_modalkeymap_assign(keymap, "TFM_OT_tilt");
560         WM_modalkeymap_assign(keymap, "TFM_OT_trackball");
561         
562 }
563
564
565 void transformEvent(TransInfo *t, wmEvent *event)
566 {
567         float mati[3][3] = {{1.0f, 0.0f, 0.0f}, {0.0f, 1.0f, 0.0f}, {0.0f, 0.0f, 1.0f}};
568         char cmode = constraintModeToChar(t);
569
570         t->redraw |= handleMouseInput(t, &t->mouse, event);
571
572         if (event->type == MOUSEMOVE)
573         {
574                 t->mval[0] = event->x - t->ar->winrct.xmin;
575                 t->mval[1] = event->y - t->ar->winrct.ymin;
576
577                 t->redraw = 1;
578
579                 applyMouseInput(t, &t->mouse, t->mval, t->values);
580         }
581
582         /* handle modal keymap first */
583         if (event->type == EVT_MODAL_MAP) {
584                 switch (event->val) {
585                         case TFM_MODAL_CANCEL:
586                                 t->state = TRANS_CANCEL;
587                                 break;
588                         case TFM_MODAL_CONFIRM:
589                                 t->state = TRANS_CONFIRM;
590                                 break;
591                                 
592                         case TFM_MODAL_TRANSLATE:
593                                 /* only switch when... */
594                                 if( ELEM3(t->mode, TFM_ROTATION, TFM_RESIZE, TFM_TRACKBALL) ) {
595                                         resetTransRestrictions(t);
596                                         restoreTransObjects(t);
597                                         initTranslation(t);
598                                         initSnapping(t, NULL); // need to reinit after mode change
599                                         t->redraw = 1;
600                                 }
601                                 break;
602                         case TFM_MODAL_ROTATE:
603                                 /* only switch when... */
604                                 if( ELEM4(t->mode, TFM_ROTATION, TFM_RESIZE, TFM_TRACKBALL, TFM_TRANSLATION) ) {
605                                         
606                                         resetTransRestrictions(t);
607                                         
608                                         if (t->mode == TFM_ROTATION) {
609                                                 restoreTransObjects(t);
610                                                 initTrackball(t);
611                                         }
612                                         else {
613                                                 restoreTransObjects(t);
614                                                 initRotation(t);
615                                         }
616                                         initSnapping(t, NULL); // need to reinit after mode change
617                                         t->redraw = 1;
618                                 }
619                                 break;
620                         case TFM_MODAL_RESIZE:
621                                 /* only switch when... */
622                                 if( ELEM3(t->mode, TFM_ROTATION, TFM_TRANSLATION, TFM_TRACKBALL) ) {
623                                         resetTransRestrictions(t);
624                                         restoreTransObjects(t);
625                                         initResize(t);
626                                         initSnapping(t, NULL); // need to reinit after mode change
627                                         t->redraw = 1;
628                                 }
629                                 break;
630                                 
631                         case TFM_MODAL_SNAP_GEARS:
632                                 t->modifiers |= MOD_SNAP_GEARS;
633                                 t->redraw = 1;
634                                 break;
635                         case TFM_MODAL_SNAP_GEARS_OFF:
636                                 t->modifiers &= ~MOD_SNAP_GEARS;
637                                 t->redraw = 1;
638                                 break;
639                 }
640         }
641         /* else do non-mapped events */
642         else if (event->val==KM_PRESS) {
643                 switch (event->type){
644                 case RIGHTMOUSE:
645                         t->state = TRANS_CANCEL;
646                         break;
647                 /* enforce redraw of transform when modifiers are used */
648                 case LEFTCTRLKEY:
649                 case RIGHTCTRLKEY:
650                         t->modifiers |= MOD_SNAP_GEARS;
651                         t->redraw = 1;
652                         break;
653
654                 case LEFTSHIFTKEY:
655                 case RIGHTSHIFTKEY:
656                         t->modifiers |= MOD_CONSTRAINT_PLANE;
657                         t->redraw = 1;
658                         break;
659
660                 case SPACEKEY:
661                         if ((t->spacetype==SPACE_VIEW3D) && event->alt) {
662 #if 0 // TRANSFORM_FIX_ME
663                                 short mval[2];
664
665                                 getmouseco_sc(mval);
666                                 BIF_selectOrientation();
667                                 calc_manipulator_stats(curarea);
668                                 Mat3CpyMat4(t->spacemtx, G.vd->twmat);
669                                 warp_pointer(mval[0], mval[1]);
670 #endif
671                         }
672                         else {
673                                 t->state = TRANS_CONFIRM;
674                         }
675                         break;
676
677                 case MIDDLEMOUSE:
678                         if ((t->flag & T_NO_CONSTRAINT)==0) {
679                                 /* exception for switching to dolly, or trackball, in camera view */
680                                 if (t->flag & T_CAMERA) {
681                                         if (t->mode==TFM_TRANSLATION)
682                                                 setLocalConstraint(t, (CON_AXIS2), "along local Z");
683                                         else if (t->mode==TFM_ROTATION) {
684                                                 restoreTransObjects(t);
685                                                 initTrackball(t);
686                                         }
687                                 }
688                                 else {
689                                         t->modifiers |= MOD_CONSTRAINT_SELECT;
690                                         if (t->con.mode & CON_APPLY) {
691                                                 stopConstraint(t);
692                                         }
693                                         else {
694                                                 if (event->shift) {
695                                                         initSelectConstraint(t, t->spacemtx);
696                                                 }
697                                                 else {
698                                                         /* bit hackish... but it prevents mmb select to print the orientation from menu */
699                                                         strcpy(t->spacename, "global");
700                                                         initSelectConstraint(t, mati);
701                                                 }
702                                                 postSelectConstraint(t);
703                                         }
704                                 }
705                                 t->redraw = 1;
706                         }
707                         break;
708                 case ESCKEY:
709                         t->state = TRANS_CANCEL;
710                         break;
711                 case PADENTER:
712                 case RETKEY:
713                         t->state = TRANS_CONFIRM;
714                         break;
715                 case GKEY:
716                         /* only switch when... */
717                         if( ELEM3(t->mode, TFM_ROTATION, TFM_RESIZE, TFM_TRACKBALL) ) {
718                                 resetTransRestrictions(t);
719                                 restoreTransObjects(t);
720                                 initTranslation(t);
721                                 initSnapping(t, NULL); // need to reinit after mode change
722                                 t->redraw = 1;
723                         }
724                         break;
725                 case SKEY:
726                         /* only switch when... */
727                         if( ELEM3(t->mode, TFM_ROTATION, TFM_TRANSLATION, TFM_TRACKBALL) ) {
728                                 resetTransRestrictions(t);
729                                 restoreTransObjects(t);
730                                 initResize(t);
731                                 initSnapping(t, NULL); // need to reinit after mode change
732                                 t->redraw = 1;
733                         }
734                         break;
735                 case RKEY:
736                         /* only switch when... */
737                         if( ELEM4(t->mode, TFM_ROTATION, TFM_RESIZE, TFM_TRACKBALL, TFM_TRANSLATION) ) {
738
739                                 resetTransRestrictions(t);
740
741                                 if (t->mode == TFM_ROTATION) {
742                                         restoreTransObjects(t);
743                                         initTrackball(t);
744                                 }
745                                 else {
746                                         restoreTransObjects(t);
747                                         initRotation(t);
748                                 }
749                                 initSnapping(t, NULL); // need to reinit after mode change
750                                 t->redraw = 1;
751                         }
752                         break;
753                 case CKEY:
754                         if (event->alt) {
755                                 t->flag ^= T_PROP_CONNECTED;
756                                 sort_trans_data_dist(t);
757                                 calculatePropRatio(t);
758                                 t->redraw= 1;
759                         }
760                         else {
761                                 stopConstraint(t);
762                                 t->redraw = 1;
763                         }
764                         break;
765                 case XKEY:
766                         if ((t->flag & T_NO_CONSTRAINT)==0) {
767                                 if (cmode == 'X') {
768                                         if (t->flag & T_2D_EDIT) {
769                                                 stopConstraint(t);
770                                         }
771                                         else {
772                                                 if (t->con.mode & CON_USER) {
773                                                         stopConstraint(t);
774                                                 }
775                                                 else {
776                                                         short orientation = t->current_orientation != V3D_MANIP_GLOBAL ? t->current_orientation : V3D_MANIP_LOCAL;
777                                                         if ((t->modifiers & MOD_CONSTRAINT_PLANE) == 0)
778                                                                 setUserConstraint(t, orientation, (CON_AXIS0), "along %s X");
779                                                         else if (t->modifiers & MOD_CONSTRAINT_PLANE)
780                                                                 setUserConstraint(t, orientation, (CON_AXIS1|CON_AXIS2), "locking %s X");
781                                                 }
782                                         }
783                                 }
784                                 else {
785                                         if (t->flag & T_2D_EDIT) {
786                                                 setConstraint(t, mati, (CON_AXIS0), "along X axis");
787                                         }
788                                         else {
789                                                 if ((t->modifiers & MOD_CONSTRAINT_PLANE) == 0)
790                                                         setConstraint(t, mati, (CON_AXIS0), "along global X");
791                                                 else if (t->modifiers & MOD_CONSTRAINT_PLANE)
792                                                         setConstraint(t, mati, (CON_AXIS1|CON_AXIS2), "locking global X");
793                                         }
794                                 }
795                                 t->redraw = 1;
796                         }
797                         break;
798                 case YKEY:
799                         if ((t->flag & T_NO_CONSTRAINT)==0) {
800                                 if (cmode == 'Y') {
801                                         if (t->flag & T_2D_EDIT) {
802                                                 stopConstraint(t);
803                                         }
804                                         else {
805                                                 if (t->con.mode & CON_USER) {
806                                                         stopConstraint(t);
807                                                 }
808                                                 else {
809                                                         short orientation = t->current_orientation != V3D_MANIP_GLOBAL ? t->current_orientation : V3D_MANIP_LOCAL;
810                                                         if ((t->modifiers & MOD_CONSTRAINT_PLANE) == 0)
811                                                                 setUserConstraint(t, orientation, (CON_AXIS1), "along %s Y");
812                                                         else if (t->modifiers & MOD_CONSTRAINT_PLANE)
813                                                                 setUserConstraint(t, orientation, (CON_AXIS0|CON_AXIS2), "locking %s Y");
814                                                 }
815                                         }
816                                 }
817                                 else {
818                                         if (t->flag & T_2D_EDIT) {
819                                                 setConstraint(t, mati, (CON_AXIS1), "along Y axis");
820                                         }
821                                         else {
822                                                 if ((t->modifiers & MOD_CONSTRAINT_PLANE) == 0)
823                                                         setConstraint(t, mati, (CON_AXIS1), "along global Y");
824                                                 else if (t->modifiers & MOD_CONSTRAINT_PLANE)
825                                                         setConstraint(t, mati, (CON_AXIS0|CON_AXIS2), "locking global Y");
826                                         }
827                                 }
828                                 t->redraw = 1;
829                         }
830                         break;
831                 case ZKEY:
832                         if ((t->flag & T_NO_CONSTRAINT)==0) {
833                                 if (cmode == 'Z') {
834                                         if (t->con.mode & CON_USER) {
835                                                 stopConstraint(t);
836                                         }
837                                         else {
838                                                 short orientation = t->current_orientation != V3D_MANIP_GLOBAL ? t->current_orientation : V3D_MANIP_LOCAL;
839                                                 if ((t->modifiers & MOD_CONSTRAINT_PLANE) == 0)
840                                                         setUserConstraint(t, orientation, (CON_AXIS2), "along %s Z");
841                                                 else if ((t->modifiers & MOD_CONSTRAINT_PLANE) && ((t->flag & T_2D_EDIT)==0))
842                                                         setUserConstraint(t, orientation, (CON_AXIS0|CON_AXIS1), "locking %s Z");
843                                         }
844                                 }
845                                 else if ((t->flag & T_2D_EDIT)==0) {
846                                         if ((t->modifiers & MOD_CONSTRAINT_PLANE) == 0)
847                                                 setConstraint(t, mati, (CON_AXIS2), "along global Z");
848                                         else if (t->modifiers & MOD_CONSTRAINT_PLANE)
849                                                 setConstraint(t, mati, (CON_AXIS0|CON_AXIS1), "locking global Z");
850                                 }
851                                 t->redraw = 1;
852                         }
853                         break;
854                 case OKEY:
855                         if (t->flag & T_PROP_EDIT && event->shift) {
856                                 t->prop_mode = (t->prop_mode + 1) % 6;
857                                 calculatePropRatio(t);
858                                 t->redraw = 1;
859                         }
860                         break;
861                 case PADPLUSKEY:
862                         if(event->alt && t->flag & T_PROP_EDIT) {
863                                 t->prop_size *= 1.1f;
864                                 calculatePropRatio(t);
865                         }
866                         t->redraw= 1;
867                         break;
868                 case PAGEUPKEY:
869                 case WHEELDOWNMOUSE:
870                         if (t->flag & T_AUTOIK) {
871                                 transform_autoik_update(t, 1);
872                         }
873                         else if(t->flag & T_PROP_EDIT) {
874                                 t->prop_size*= 1.1f;
875                                 calculatePropRatio(t);
876                         }
877                         else view_editmove(event->type);
878                         t->redraw= 1;
879                         break;
880                 case PADMINUS:
881                         if(event->alt && t->flag & T_PROP_EDIT) {
882                                 t->prop_size*= 0.90909090f;
883                                 calculatePropRatio(t);
884                         }
885                         t->redraw= 1;
886                         break;
887                 case PAGEDOWNKEY:
888                 case WHEELUPMOUSE:
889                         if (t->flag & T_AUTOIK) {
890                                 transform_autoik_update(t, -1);
891                         }
892                         else if (t->flag & T_PROP_EDIT) {
893                                 t->prop_size*= 0.90909090f;
894                                 calculatePropRatio(t);
895                         }
896                         else view_editmove(event->type);
897                         t->redraw= 1;
898                         break;
899 //              case NDOFMOTION:
900 //            viewmoveNDOF(1);
901   //         break;
902                 }
903
904                 // Numerical input events
905                 t->redraw |= handleNumInput(&(t->num), event);
906
907                 // NDof input events
908                 switch(handleNDofInput(&(t->ndof), event))
909                 {
910                         case NDOF_CONFIRM:
911                                 if ((t->options & CTX_NDOF) == 0)
912                                 {
913                                         /* Confirm on normal transform only */
914                                         t->state = TRANS_CONFIRM;
915                                 }
916                                 break;
917                         case NDOF_CANCEL:
918                                 if (t->options & CTX_NDOF)
919                                 {
920                                         /* Cancel on pure NDOF transform */
921                                         t->state = TRANS_CANCEL;
922                                 }
923                                 else
924                                 {
925                                         /* Otherwise, just redraw, NDof input was cancelled */
926                                         t->redraw = 1;
927                                 }
928                                 break;
929                         case NDOF_NOMOVE:
930                                 if (t->options & CTX_NDOF)
931                                 {
932                                         /* Confirm on pure NDOF transform */
933                                         t->state = TRANS_CONFIRM;
934                                 }
935                                 break;
936                         case NDOF_REFRESH:
937                                 t->redraw = 1;
938                                 break;
939
940                 }
941
942                 // Snapping events
943                 t->redraw |= handleSnapping(t, event);
944
945                 //arrows_move_cursor(event->type);
946         }
947         else {
948                 switch (event->type){
949                 case LEFTMOUSE:
950                         t->state = TRANS_CONFIRM;
951                         break;
952                 case LEFTSHIFTKEY:
953                 case RIGHTSHIFTKEY:
954                         t->modifiers &= ~MOD_CONSTRAINT_PLANE;
955                         t->redraw = 1;
956                         break;
957
958                 case LEFTCTRLKEY:
959                 case RIGHTCTRLKEY:
960                         t->modifiers &= ~MOD_SNAP_GEARS;
961                         /* no redraw on release modifier keys! this makes sure you can assign the 'grid' still
962                            after releasing modifer key */
963                         //t->redraw = 1;
964                         break;
965                 case MIDDLEMOUSE:
966                         if ((t->flag & T_NO_CONSTRAINT)==0) {
967                                 t->modifiers &= ~MOD_CONSTRAINT_SELECT;
968                                 postSelectConstraint(t);
969                                 t->redraw = 1;
970                         }
971                         break;
972 //              case LEFTMOUSE:
973 //              case RIGHTMOUSE:
974 //                      if(WM_modal_tweak_exit(event, t->event_type))
975 ////                    if (t->options & CTX_TWEAK)
976 //                              t->state = TRANS_CONFIRM;
977 //                      break;
978                 }
979         }
980
981         // Per transform event, if present
982         if (t->handleEvent)
983                 t->redraw |= t->handleEvent(t, event);
984 }
985
986 int calculateTransformCenter(bContext *C, wmEvent *event, int centerMode, float *vec)
987 {
988         TransInfo *t = MEM_callocN(sizeof(TransInfo), "TransInfo data");
989         int success = 1;
990
991         t->state = TRANS_RUNNING;
992
993         t->options = CTX_NONE;
994
995         t->mode = TFM_DUMMY;
996
997         initTransInfo(C, t, NULL, event);                                       // internal data, mouse, vectors
998
999         createTransData(C, t);                  // make TransData structs from selection
1000
1001         t->around = centerMode;                         // override userdefined mode
1002
1003         if (t->total == 0) {
1004                 success = 0;
1005         }
1006         else {
1007                 success = 1;
1008
1009                 calculateCenter(t);
1010
1011                 // Copy center from constraint center. Transform center can be local
1012                 VECCOPY(vec, t->con.center);
1013         }
1014
1015         postTrans(t);
1016
1017         /* aftertrans does insert ipos and action channels, and clears base flags, doesnt read transdata */
1018         special_aftertrans_update(t);
1019
1020         MEM_freeN(t);
1021
1022         return success;
1023 }
1024
1025 typedef enum {
1026         UP,
1027         DOWN,
1028         LEFT,
1029         RIGHT
1030 } ArrowDirection;
1031 static void drawArrow(ArrowDirection d, short offset, short length, short size)
1032 {
1033         switch(d)
1034         {
1035                 case LEFT:
1036                         offset = -offset;
1037                         length = -length;
1038                         size = -size;
1039                 case RIGHT:
1040                         glBegin(GL_LINES);
1041                         glVertex2s( offset, 0);
1042                         glVertex2s( offset + length, 0);
1043                         glVertex2s( offset + length, 0);
1044                         glVertex2s( offset + length - size, -size);
1045                         glVertex2s( offset + length, 0);
1046                         glVertex2s( offset + length - size,  size);
1047                         glEnd();
1048                         break;
1049                 case DOWN:
1050                         offset = -offset;
1051                         length = -length;
1052                         size = -size;
1053                 case UP:
1054                         glBegin(GL_LINES);
1055                         glVertex2s( 0, offset);
1056                         glVertex2s( 0, offset + length);
1057                         glVertex2s( 0, offset + length);
1058                         glVertex2s(-size, offset + length - size);
1059                         glVertex2s( 0, offset + length);
1060                         glVertex2s( size, offset + length - size);
1061                         glEnd();
1062                         break;
1063         }
1064 }
1065
1066 static void drawArrowHead(ArrowDirection d, short size)
1067 {
1068         switch(d)
1069         {
1070                 case LEFT:
1071                         size = -size;
1072                 case RIGHT:
1073                         glBegin(GL_LINES);
1074                         glVertex2s( 0, 0);
1075                         glVertex2s( -size, -size);
1076                         glVertex2s( 0, 0);
1077                         glVertex2s( -size,  size);
1078                         glEnd();
1079                         break;
1080                 case DOWN:
1081                         size = -size;
1082                 case UP:
1083                         glBegin(GL_LINES);
1084                         glVertex2s( 0, 0);
1085                         glVertex2s(-size, -size);
1086                         glVertex2s( 0, 0);
1087                         glVertex2s( size, -size);
1088                         glEnd();
1089                         break;
1090         }
1091 }
1092
1093 static void drawArc(float size, float angle_start, float angle_end, int segments)
1094 {
1095         float delta = (angle_end - angle_start) / segments;
1096         float angle;
1097
1098         glBegin(GL_LINE_STRIP);
1099
1100         for( angle = angle_start; angle < angle_end; angle += delta)
1101         {
1102                 glVertex2f( cosf(angle) * size, sinf(angle) * size);
1103         }
1104         glVertex2f( cosf(angle_end) * size, sinf(angle_end) * size);
1105
1106         glEnd();
1107 }
1108
1109 void drawHelpline(const struct bContext *C, TransInfo *t)
1110 {
1111         if (t->helpline != HLP_NONE && !(t->flag & T_USES_MANIPULATOR))
1112         {
1113                 float vecrot[3], cent[2];
1114
1115                 VECCOPY(vecrot, t->center);
1116                 if(t->flag & T_EDIT) {
1117                         Object *ob= t->obedit;
1118                         if(ob) Mat4MulVecfl(ob->obmat, vecrot);
1119                 }
1120                 else if(t->flag & T_POSE) {
1121                         Object *ob=t->poseobj;
1122                         if(ob) Mat4MulVecfl(ob->obmat, vecrot);
1123                 }
1124
1125                 projectFloatView(t, vecrot, cent);      // no overflow in extreme cases
1126
1127                 glDisable(GL_DEPTH_TEST);
1128
1129                 glMatrixMode(GL_PROJECTION);
1130                 glPushMatrix();
1131                 glMatrixMode(GL_MODELVIEW);
1132                 glPushMatrix();
1133
1134                 ED_region_pixelspace(t->ar);
1135
1136                 switch(t->helpline)
1137                 {
1138                         case HLP_SPRING:
1139                                 UI_ThemeColor(TH_WIRE);
1140
1141                                 setlinestyle(3);
1142                                 glBegin(GL_LINE_STRIP);
1143                                 glVertex2sv(t->mval);
1144                                 glVertex2fv(cent);
1145                                 glEnd();
1146
1147                                 glTranslatef(t->mval[0], t->mval[1], 0);
1148                                 glRotatef(-180 / M_PI * atan2f(cent[0] - t->mval[0], cent[1] - t->mval[1]), 0, 0, 1);
1149
1150                                 setlinestyle(0);
1151                                 glLineWidth(3.0);
1152                                 drawArrow(UP, 5, 10, 5);
1153                                 drawArrow(DOWN, 5, 10, 5);
1154                                 glLineWidth(1.0);
1155                                 break;
1156                         case HLP_HARROW:
1157                                 UI_ThemeColor(TH_WIRE);
1158
1159                                 glTranslatef(t->mval[0], t->mval[1], 0);
1160
1161                                 glLineWidth(3.0);
1162                                 drawArrow(RIGHT, 5, 10, 5);
1163                                 drawArrow(LEFT, 5, 10, 5);
1164                                 glLineWidth(1.0);
1165                                 break;
1166                         case HLP_VARROW:
1167                                 UI_ThemeColor(TH_WIRE);
1168
1169                                 glTranslatef(t->mval[0], t->mval[1], 0);
1170
1171                                 glLineWidth(3.0);
1172                                 glBegin(GL_LINES);
1173                                 drawArrow(UP, 5, 10, 5);
1174                                 drawArrow(DOWN, 5, 10, 5);
1175                                 glLineWidth(1.0);
1176                                 break;
1177                         case HLP_ANGLE:
1178                                 {
1179                                         float dx = t->mval[0] - cent[0], dy = t->mval[1] - cent[1];
1180                                         float angle = atan2f(dy, dx);
1181                                         float dist = sqrtf(dx*dx + dy*dy);
1182                                         float delta_angle = MIN2(15 / dist, M_PI/4);
1183                                         float spacing_angle = MIN2(5 / dist, M_PI/12);
1184                                         UI_ThemeColor(TH_WIRE);
1185
1186                                         setlinestyle(3);
1187                                         glBegin(GL_LINE_STRIP);
1188                                         glVertex2sv(t->mval);
1189                                         glVertex2fv(cent);
1190                                         glEnd();
1191
1192                                         glTranslatef(cent[0], cent[1], 0);
1193
1194                                         setlinestyle(0);
1195                                         glLineWidth(3.0);
1196                                         drawArc(dist, angle - delta_angle, angle - spacing_angle, 10);
1197                                         drawArc(dist, angle + spacing_angle, angle + delta_angle, 10);
1198
1199                                         glPushMatrix();
1200
1201                                         glTranslatef(cosf(angle - delta_angle) * dist, sinf(angle - delta_angle) * dist, 0);
1202                                         glRotatef(180 / M_PI * (angle - delta_angle), 0, 0, 1);
1203
1204                                         drawArrowHead(DOWN, 5);
1205
1206                                         glPopMatrix();
1207
1208                                         glTranslatef(cosf(angle + delta_angle) * dist, sinf(angle + delta_angle) * dist, 0);
1209                                         glRotatef(180 / M_PI * (angle + delta_angle), 0, 0, 1);
1210
1211                                         drawArrowHead(UP, 5);
1212
1213                                         glLineWidth(1.0);
1214                                         break;
1215                                 }
1216                                 case HLP_TRACKBALL:
1217                                 {
1218                                         char col[3], col2[3];
1219                                         UI_GetThemeColor3ubv(TH_GRID, col);
1220
1221                                         glTranslatef(t->mval[0], t->mval[1], 0);
1222
1223                                         glLineWidth(3.0);
1224
1225                                         UI_make_axis_color(col, col2, 'x');
1226                                         glColor3ubv((GLubyte *)col2);
1227
1228                                         drawArrow(RIGHT, 5, 10, 5);
1229                                         drawArrow(LEFT, 5, 10, 5);
1230
1231                                         UI_make_axis_color(col, col2, 'y');
1232                                         glColor3ubv((GLubyte *)col2);
1233
1234                                         drawArrow(UP, 5, 10, 5);
1235                                         drawArrow(DOWN, 5, 10, 5);
1236                                         glLineWidth(1.0);
1237                                         break;
1238                                 }
1239                 }
1240
1241                 glMatrixMode(GL_PROJECTION);
1242                 glPopMatrix();
1243                 glMatrixMode(GL_MODELVIEW);
1244                 glPopMatrix();
1245
1246                 glEnable(GL_DEPTH_TEST);
1247         }
1248 }
1249
1250 void drawTransform(const struct bContext *C, struct ARegion *ar, void *arg)
1251 {
1252         TransInfo *t = arg;
1253
1254         drawConstraint(C, t);
1255         drawPropCircle(C, t);
1256         drawSnapping(C, t);
1257         drawHelpline(C, t);
1258 }
1259
1260 void saveTransform(bContext *C, TransInfo *t, wmOperator *op)
1261 {
1262         ToolSettings *ts = CTX_data_tool_settings(C);
1263         int constraint_axis[3] = {0, 0, 0};
1264         int proportional = 0;
1265
1266         if (RNA_struct_find_property(op->ptr, "value"))
1267         {
1268                 if (t->flag & T_AUTOVALUES)
1269                 {
1270                         RNA_float_set_array(op->ptr, "value", t->auto_values);
1271                 }
1272                 else
1273                 {
1274                         RNA_float_set_array(op->ptr, "value", t->values);
1275                 }
1276         }
1277
1278         /* XXX convert stupid flag to enum */
1279         switch(t->flag & (T_PROP_EDIT|T_PROP_CONNECTED))
1280         {
1281         case (T_PROP_EDIT|T_PROP_CONNECTED):
1282                 proportional = 2;
1283                 break;
1284         case T_PROP_EDIT:
1285                 proportional = 1;
1286                 break;
1287         default:
1288                 proportional = 0;
1289         }
1290
1291         if (RNA_struct_find_property(op->ptr, "proportional"))
1292         {
1293                 RNA_enum_set(op->ptr, "proportional", proportional);
1294                 RNA_enum_set(op->ptr, "proportional_editing_falloff", t->prop_mode);
1295                 RNA_float_set(op->ptr, "proportional_size", t->prop_size);
1296         }
1297
1298         if (RNA_struct_find_property(op->ptr, "mirror"))
1299         {
1300                 RNA_boolean_set(op->ptr, "mirror", t->flag & T_MIRROR);
1301         }
1302
1303         if (RNA_struct_find_property(op->ptr, "constraint_axis"))
1304         {
1305                 RNA_enum_set(op->ptr, "constraint_orientation", t->current_orientation);
1306
1307                 if (t->con.mode & CON_APPLY)
1308                 {
1309                         if (t->con.mode & CON_AXIS0) {
1310                                 constraint_axis[0] = 1;
1311                         }
1312                         if (t->con.mode & CON_AXIS1) {
1313                                 constraint_axis[1] = 1;
1314                         }
1315                         if (t->con.mode & CON_AXIS2) {
1316                                 constraint_axis[2] = 1;
1317                         }
1318                 }
1319
1320                 RNA_boolean_set_array(op->ptr, "constraint_axis", constraint_axis);
1321         }
1322
1323         // XXX If modal, save settings back in scene
1324         if (t->flag & T_MODAL)
1325         {
1326                 ts->prop_mode = t->prop_mode;
1327                 
1328                 /* only save back if it wasn't automatically disabled */
1329                 if ((t->options & CTX_NO_PET) == 0)
1330                 {
1331                         ts->proportional = proportional;
1332                         ts->proportional_size = t->prop_size;
1333                 }
1334
1335                 if(t->spacetype == SPACE_VIEW3D)
1336                 {
1337                         View3D *v3d = t->view;
1338
1339                         v3d->twmode = t->current_orientation;
1340                 }
1341         }
1342 }
1343
1344 int initTransform(bContext *C, TransInfo *t, wmOperator *op, wmEvent *event, int mode)
1345 {
1346         int options = 0;
1347
1348         /* added initialize, for external calls to set stuff in TransInfo, like undo string */
1349
1350         t->state = TRANS_RUNNING;
1351
1352         t->options = options;
1353
1354         t->mode = mode;
1355
1356         if (!initTransInfo(C, t, op, event))                                    // internal data, mouse, vectors
1357         {
1358                 return 0;
1359         }
1360
1361         if(t->spacetype == SPACE_VIEW3D)
1362         {
1363                 //calc_manipulator_stats(curarea);
1364                 initTransformOrientation(C, t);
1365
1366                 t->draw_handle = ED_region_draw_cb_activate(t->ar->type, drawTransform, t, REGION_DRAW_POST);
1367         }
1368         else if(t->spacetype == SPACE_IMAGE) {
1369                 Mat3One(t->spacemtx);
1370                 t->draw_handle = ED_region_draw_cb_activate(t->ar->type, drawTransform, t, REGION_DRAW_POST);
1371         }
1372         else
1373                 Mat3One(t->spacemtx);
1374
1375         createTransData(C, t);                  // make TransData structs from selection
1376
1377         if (t->total == 0) {
1378                 postTrans(t);
1379                 return 0;
1380         }
1381
1382         initSnapping(t, op); // Initialize snapping data AFTER mode flags
1383
1384         /* EVIL! posemode code can switch translation to rotate when 1 bone is selected. will be removed (ton) */
1385         /* EVIL2: we gave as argument also texture space context bit... was cleared */
1386         /* EVIL3: extend mode for animation editors also switches modes... but is best way to avoid duplicate code */
1387         mode = t->mode;
1388
1389         calculatePropRatio(t);
1390         calculateCenter(t);
1391
1392         initMouseInput(t, &t->mouse, t->center2d, t->imval);
1393
1394         switch (mode) {
1395         case TFM_TRANSLATION:
1396                 initTranslation(t);
1397                 break;
1398         case TFM_ROTATION:
1399                 initRotation(t);
1400                 break;
1401         case TFM_RESIZE:
1402                 initResize(t);
1403                 break;
1404         case TFM_TOSPHERE:
1405                 initToSphere(t);
1406                 break;
1407         case TFM_SHEAR:
1408                 initShear(t);
1409                 break;
1410         case TFM_WARP:
1411                 initWarp(t);
1412                 break;
1413         case TFM_SHRINKFATTEN:
1414                 initShrinkFatten(t);
1415                 break;
1416         case TFM_TILT:
1417                 initTilt(t);
1418                 break;
1419         case TFM_CURVE_SHRINKFATTEN:
1420                 initCurveShrinkFatten(t);
1421                 break;
1422         case TFM_TRACKBALL:
1423                 initTrackball(t);
1424                 break;
1425         case TFM_PUSHPULL:
1426                 initPushPull(t);
1427                 break;
1428         case TFM_CREASE:
1429                 initCrease(t);
1430                 break;
1431         case TFM_BONESIZE:
1432                 {       /* used for both B-Bone width (bonesize) as for deform-dist (envelope) */
1433                         bArmature *arm= t->poseobj->data;
1434                         if(arm->drawtype==ARM_ENVELOPE)
1435                                 initBoneEnvelope(t);
1436                         else
1437                                 initBoneSize(t);
1438                 }
1439                 break;
1440         case TFM_BONE_ENVELOPE:
1441                 initBoneEnvelope(t);
1442                 break;
1443         case TFM_EDGE_SLIDE:
1444                 initEdgeSlide(t);
1445                 break;
1446         case TFM_BONE_ROLL:
1447                 initBoneRoll(t);
1448                 break;
1449         case TFM_TIME_TRANSLATE:
1450                 initTimeTranslate(t);
1451                 break;
1452         case TFM_TIME_SLIDE:
1453                 initTimeSlide(t);
1454                 break;
1455         case TFM_TIME_SCALE:
1456                 initTimeScale(t);
1457                 break;
1458         case TFM_TIME_EXTEND:
1459                 /* now that transdata has been made, do like for TFM_TIME_TRANSLATE (for most Animation
1460                  * Editors because they have only 1D transforms for time values) or TFM_TRANSLATION
1461                  * (for Graph/NLA Editors only since they uses 'standard' transforms to get 2D movement)
1462                  * depending on which editor this was called from
1463                  */
1464                 if ELEM(t->spacetype, SPACE_IPO, SPACE_NLA)
1465                         initTranslation(t);
1466                 else
1467                         initTimeTranslate(t);
1468                 break;
1469         case TFM_BAKE_TIME:
1470                 initBakeTime(t);
1471                 break;
1472         case TFM_MIRROR:
1473                 initMirror(t);
1474                 break;
1475         case TFM_BEVEL:
1476                 initBevel(t);
1477                 break;
1478         case TFM_BWEIGHT:
1479                 initBevelWeight(t);
1480                 break;
1481         case TFM_ALIGN:
1482                 initAlign(t);
1483                 break;
1484         }
1485
1486         /* overwrite initial values if operator supplied a non-null vector */
1487         if (RNA_property_is_set(op->ptr, "value"))
1488         {
1489                 float values[4];
1490                 RNA_float_get_array(op->ptr, "value", values);
1491                 QUATCOPY(t->values, values);
1492                 QUATCOPY(t->auto_values, values);
1493                 t->flag |= T_AUTOVALUES;
1494         }
1495
1496         /* Constraint init from operator */
1497         if (RNA_struct_find_property(op->ptr, "constraint_axis") && RNA_property_is_set(op->ptr, "constraint_axis"))
1498         {
1499                 int constraint_axis[3];
1500
1501                 RNA_boolean_get_array(op->ptr, "constraint_axis", constraint_axis);
1502
1503                 if (constraint_axis[0] || constraint_axis[1] || constraint_axis[2])
1504                 {
1505                         t->con.mode |= CON_APPLY;
1506
1507                         if (constraint_axis[0]) {
1508                                 t->con.mode |= CON_AXIS0;
1509                         }
1510                         if (constraint_axis[1]) {
1511                                 t->con.mode |= CON_AXIS1;
1512                         }
1513                         if (constraint_axis[2]) {
1514                                 t->con.mode |= CON_AXIS2;
1515                         }
1516
1517                         setUserConstraint(t, t->current_orientation, t->con.mode, "%s");
1518                 }
1519         }
1520
1521         return 1;
1522 }
1523
1524 void transformApply(bContext *C, TransInfo *t)
1525 {
1526         if (t->redraw)
1527         {
1528                 if (t->modifiers & MOD_CONSTRAINT_SELECT)
1529                         t->con.mode |= CON_SELECT;
1530
1531                 selectConstraint(t);
1532                 if (t->transform) {
1533                         t->transform(t, t->mval);  // calls recalcData()
1534                         viewRedrawForce(C, t);
1535                 }
1536                 t->redraw = 0;
1537         }
1538
1539         /* If auto confirm is on, break after one pass */
1540         if (t->options & CTX_AUTOCONFIRM)
1541         {
1542                 t->state = TRANS_CONFIRM;
1543         }
1544
1545         if (BKE_ptcache_get_continue_physics())
1546         {
1547                 // TRANSFORM_FIX_ME
1548                 //do_screenhandlers(G.curscreen);
1549                 t->redraw = 1;
1550         }
1551 }
1552
1553 int transformEnd(bContext *C, TransInfo *t)
1554 {
1555         int exit_code = OPERATOR_RUNNING_MODAL;
1556
1557         if (t->state != TRANS_RUNNING)
1558         {
1559                 /* handle restoring objects */
1560                 if(t->state == TRANS_CANCEL)
1561                 {
1562                         exit_code = OPERATOR_CANCELLED;
1563                         restoreTransObjects(t); // calls recalcData()
1564                 }
1565                 else
1566                 {
1567                         exit_code = OPERATOR_FINISHED;
1568                 }
1569
1570                 /* free data */
1571                 postTrans(t);
1572
1573                 /* aftertrans does insert keyframes, and clears base flags, doesnt read transdata */
1574                 special_aftertrans_update(t);
1575
1576                 /* send events out for redraws */
1577                 viewRedrawPost(t);
1578
1579                 /*  Undo as last, certainly after special_trans_update! */
1580
1581                 if(t->state == TRANS_CANCEL) {
1582 //                      if(t->undostr) ED_undo_push(C, t->undostr);
1583                 }
1584                 else {
1585 //                      if(t->undostr) ED_undo_push(C, t->undostr);
1586 //                      else ED_undo_push(C, transform_to_undostr(t));
1587                 }
1588                 t->undostr= NULL;
1589
1590                 viewRedrawForce(C, t);
1591         }
1592
1593         return exit_code;
1594 }
1595
1596 /* ************************** TRANSFORM LOCKS **************************** */
1597
1598 static void protectedTransBits(short protectflag, float *vec)
1599 {
1600         if(protectflag & OB_LOCK_LOCX)
1601                 vec[0]= 0.0f;
1602         if(protectflag & OB_LOCK_LOCY)
1603                 vec[1]= 0.0f;
1604         if(protectflag & OB_LOCK_LOCZ)
1605                 vec[2]= 0.0f;
1606 }
1607
1608 static void protectedSizeBits(short protectflag, float *size)
1609 {
1610         if(protectflag & OB_LOCK_SCALEX)
1611                 size[0]= 1.0f;
1612         if(protectflag & OB_LOCK_SCALEY)
1613                 size[1]= 1.0f;
1614         if(protectflag & OB_LOCK_SCALEZ)
1615                 size[2]= 1.0f;
1616 }
1617
1618 static void protectedRotateBits(short protectflag, float *eul, float *oldeul)
1619 {
1620         if(protectflag & OB_LOCK_ROTX)
1621                 eul[0]= oldeul[0];
1622         if(protectflag & OB_LOCK_ROTY)
1623                 eul[1]= oldeul[1];
1624         if(protectflag & OB_LOCK_ROTZ)
1625                 eul[2]= oldeul[2];
1626 }
1627
1628
1629 /* this function only does the delta rotation */
1630 /* axis-angle is usually internally stored as quats... */
1631 static void protectedAxisAngleBits(short protectflag, float *quat, float *oldquat)
1632 {
1633         /* check that protection flags are set */
1634         if ((protectflag & (OB_LOCK_ROTX|OB_LOCK_ROTY|OB_LOCK_ROTZ|OB_LOCK_ROTW)) == 0)
1635                 return;
1636         
1637         if (protectflag & OB_LOCK_ROT4D) {
1638                 /* axis-angle getting limited as 4D entities that they are... */
1639                 if (protectflag & OB_LOCK_ROTW)
1640                         quat[0]= oldquat[0];
1641                 if (protectflag & OB_LOCK_ROTX)
1642                         quat[1]= oldquat[1];
1643                 if (protectflag & OB_LOCK_ROTY)
1644                         quat[2]= oldquat[2];
1645                 if (protectflag & OB_LOCK_ROTZ)
1646                         quat[3]= oldquat[3];
1647         }
1648         else {
1649                 /* axis-angle get limited with euler... */
1650                 float eul[3], oldeul[3], quat1[4];
1651                 
1652                 QUATCOPY(quat1, quat);
1653                 AxisAngleToEulO(quat+1, quat[0], eul, EULER_ORDER_DEFAULT);
1654                 AxisAngleToEulO(oldquat+1, oldquat[0], oldeul, EULER_ORDER_DEFAULT);
1655                 
1656                 if (protectflag & OB_LOCK_ROTX)
1657                         eul[0]= oldeul[0];
1658                 if (protectflag & OB_LOCK_ROTY)
1659                         eul[1]= oldeul[1];
1660                 if (protectflag & OB_LOCK_ROTZ)
1661                         eul[2]= oldeul[2];
1662                 
1663                 EulOToAxisAngle(eul, EULER_ORDER_DEFAULT, quat+1, quat);
1664                 
1665                 /* when converting to axis-angle, we need a special exception for the case when there is no axis */
1666                 if (IS_EQ(quat[1], quat[2]) && IS_EQ(quat[2], quat[3])) {
1667                         /* for now, rotate around y-axis then (so that it simply becomes the roll) */
1668                         quat[2]= 1.0f;
1669                 }
1670         }
1671 }
1672
1673 /* this function only does the delta rotation */
1674 static void protectedQuaternionBits(short protectflag, float *quat, float *oldquat)
1675 {
1676         /* check that protection flags are set */
1677         if ((protectflag & (OB_LOCK_ROTX|OB_LOCK_ROTY|OB_LOCK_ROTZ|OB_LOCK_ROTW)) == 0)
1678                 return;
1679         
1680         if (protectflag & OB_LOCK_ROT4D) {
1681                 /* quaternions getting limited as 4D entities that they are... */
1682                 if (protectflag & OB_LOCK_ROTW)
1683                         quat[0]= oldquat[0];
1684                 if (protectflag & OB_LOCK_ROTX)
1685                         quat[1]= oldquat[1];
1686                 if (protectflag & OB_LOCK_ROTY)
1687                         quat[2]= oldquat[2];
1688                 if (protectflag & OB_LOCK_ROTZ)
1689                         quat[3]= oldquat[3];
1690         }
1691         else {
1692                 /* quaternions get limited with euler... (compatability mode) */
1693                 float eul[3], oldeul[3], quat1[4];
1694                 
1695                 QUATCOPY(quat1, quat);
1696                 QuatToEul(quat, eul);
1697                 QuatToEul(oldquat, oldeul);
1698                 
1699                 if (protectflag & OB_LOCK_ROTX)
1700                         eul[0]= oldeul[0];
1701                 if (protectflag & OB_LOCK_ROTY)
1702                         eul[1]= oldeul[1];
1703                 if (protectflag & OB_LOCK_ROTZ)
1704                         eul[2]= oldeul[2];
1705                 
1706                 EulToQuat(eul, quat);
1707                 
1708                 /* quaternions flip w sign to accumulate rotations correctly */
1709                 if ( (quat1[0]<0.0f && quat[0]>0.0f) || (quat1[0]>0.0f && quat[0]<0.0f) ) {
1710                         QuatMulf(quat, -1.0f);
1711                 }
1712         }
1713 }
1714
1715 /* ******************* TRANSFORM LIMITS ********************** */
1716
1717 static void constraintTransLim(TransInfo *t, TransData *td)
1718 {
1719         if (td->con) {
1720                 bConstraintTypeInfo *cti= get_constraint_typeinfo(CONSTRAINT_TYPE_LOCLIMIT);
1721                 bConstraintOb cob;
1722                 bConstraint *con;
1723                 
1724                 /* Make a temporary bConstraintOb for using these limit constraints
1725                  *      - they only care that cob->matrix is correctly set ;-)
1726                  *      - current space should be local
1727                  */
1728                 memset(&cob, 0, sizeof(bConstraintOb));
1729                 Mat4One(cob.matrix);
1730                 VECCOPY(cob.matrix[3], td->loc);
1731                 
1732                 /* Evaluate valid constraints */
1733                 for (con= td->con; con; con= con->next) {
1734                         float tmat[4][4];
1735                         
1736                         /* only consider constraint if enabled */
1737                         if (con->flag & CONSTRAINT_DISABLE) continue;
1738                         if (con->enforce == 0.0f) continue;
1739                         
1740                         /* only use it if it's tagged for this purpose (and the right type) */
1741                         if (con->type == CONSTRAINT_TYPE_LOCLIMIT) {
1742                                 bLocLimitConstraint *data= con->data;
1743                                 
1744                                 if ((data->flag2 & LIMIT_TRANSFORM)==0)
1745                                         continue;
1746                                 
1747                                 /* do space conversions */
1748                                 if (con->ownspace == CONSTRAINT_SPACE_WORLD) {
1749                                         /* just multiply by td->mtx (this should be ok) */
1750                                         Mat4CpyMat4(tmat, cob.matrix);
1751                                         Mat4MulMat34(cob.matrix, td->mtx, tmat);
1752                                 }
1753                                 else if (con->ownspace != CONSTRAINT_SPACE_LOCAL) {
1754                                         /* skip... incompatable spacetype */
1755                                         continue;
1756                                 }
1757                                 
1758                                 /* do constraint */
1759                                 cti->evaluate_constraint(con, &cob, NULL);
1760                                 
1761                                 /* convert spaces again */
1762                                 if (con->ownspace == CONSTRAINT_SPACE_WORLD) {
1763                                         /* just multiply by td->mtx (this should be ok) */
1764                                         Mat4CpyMat4(tmat, cob.matrix);
1765                                         Mat4MulMat34(cob.matrix, td->smtx, tmat);
1766                                 }
1767                         }
1768                 }
1769                 
1770                 /* copy results from cob->matrix */
1771                 VECCOPY(td->loc, cob.matrix[3]);
1772         }
1773 }
1774
1775 static void constraintRotLim(TransInfo *t, TransData *td)
1776 {
1777         if (td->con) {
1778                 bConstraintTypeInfo *cti= get_constraint_typeinfo(CONSTRAINT_TYPE_ROTLIMIT);
1779                 bConstraintOb cob;
1780                 bConstraint *con;
1781
1782                 /* Make a temporary bConstraintOb for using these limit constraints
1783                  *      - they only care that cob->matrix is correctly set ;-)
1784                  *      - current space should be local
1785                  */
1786                 memset(&cob, 0, sizeof(bConstraintOb));
1787                 if (td->rotOrder == ROT_MODE_QUAT) {
1788                         /* quats */
1789                         if (td->ext)
1790                                 QuatToMat4(td->ext->quat, cob.matrix);
1791                         else
1792                                 return;
1793                 }
1794                 else if (td->rotOrder == ROT_MODE_AXISANGLE) {
1795                         /* axis angle */
1796                         if (td->ext)
1797                                 AxisAngleToMat4(&td->ext->quat[1], td->ext->quat[0], cob.matrix);
1798                         else
1799                                 return;
1800                 }
1801                 else {
1802                         /* eulers */
1803                         if (td->ext)
1804                                 EulOToMat4(td->ext->rot, td->rotOrder, cob.matrix);
1805                         else
1806                                 return;
1807                 }
1808                 
1809                 /* Evaluate valid constraints */
1810                 for (con= td->con; con; con= con->next) {
1811                         /* only consider constraint if enabled */
1812                         if (con->flag & CONSTRAINT_DISABLE) continue;
1813                         if (con->enforce == 0.0f) continue;
1814                         
1815                         /* we're only interested in Limit-Rotation constraints */
1816                         if (con->type == CONSTRAINT_TYPE_ROTLIMIT) {
1817                                 bRotLimitConstraint *data= con->data;
1818                                 float tmat[4][4];
1819                                 
1820                                 /* only use it if it's tagged for this purpose */
1821                                 if ((data->flag2 & LIMIT_TRANSFORM)==0)
1822                                         continue;
1823                                 
1824                                 /* do space conversions */
1825                                 if (con->ownspace == CONSTRAINT_SPACE_WORLD) {
1826                                         /* just multiply by td->mtx (this should be ok) */
1827                                         Mat4CpyMat4(tmat, cob.matrix);
1828                                         Mat4MulMat34(cob.matrix, td->mtx, tmat);
1829                                 }
1830                                 else if (con->ownspace != CONSTRAINT_SPACE_LOCAL) {
1831                                         /* skip... incompatable spacetype */
1832                                         continue;
1833                                 }
1834                                 
1835                                 /* do constraint */
1836                                 cti->evaluate_constraint(con, &cob, NULL);
1837                                 
1838                                 /* convert spaces again */
1839                                 if (con->ownspace == CONSTRAINT_SPACE_WORLD) {
1840                                         /* just multiply by td->mtx (this should be ok) */
1841                                         Mat4CpyMat4(tmat, cob.matrix);
1842                                         Mat4MulMat34(cob.matrix, td->smtx, tmat);
1843                                 }
1844                         }
1845                 }
1846                 
1847                 /* copy results from cob->matrix */
1848                 if (td->rotOrder == ROT_MODE_QUAT) {
1849                         /* quats */
1850                         Mat4ToQuat(cob.matrix, td->ext->quat);
1851                 }
1852                 else if (td->rotOrder == ROT_MODE_AXISANGLE) {
1853                         /* axis angle */
1854                         Mat4ToAxisAngle(cob.matrix, &td->ext->quat[1], &td->ext->quat[0]);
1855                 }
1856                 else {
1857                         /* eulers */
1858                         Mat4ToEulO(cob.matrix, td->ext->rot, td->rotOrder);
1859                 }
1860         }
1861 }
1862
1863 static void constraintSizeLim(TransInfo *t, TransData *td)
1864 {
1865         if (td->con && td->ext) {
1866                 bConstraintTypeInfo *cti= get_constraint_typeinfo(CONSTRAINT_TYPE_SIZELIMIT);
1867                 bConstraintOb cob;
1868                 bConstraint *con;
1869                 
1870                 /* Make a temporary bConstraintOb for using these limit constraints
1871                  *      - they only care that cob->matrix is correctly set ;-)
1872                  *      - current space should be local
1873                  */
1874                 memset(&cob, 0, sizeof(bConstraintOb));
1875                 if ((td->flag & TD_SINGLESIZE) && !(t->con.mode & CON_APPLY)) {
1876                         /* scale val and reset size */
1877                         return; // TODO: fix this case
1878                 }
1879                 else {
1880                         /* Reset val if SINGLESIZE but using a constraint */
1881                         if (td->flag & TD_SINGLESIZE)
1882                                 return;
1883                         
1884                         SizeToMat4(td->ext->size, cob.matrix);
1885                 }
1886                 
1887                 /* Evaluate valid constraints */
1888                 for (con= td->con; con; con= con->next) {
1889                         /* only consider constraint if enabled */
1890                         if (con->flag & CONSTRAINT_DISABLE) continue;
1891                         if (con->enforce == 0.0f) continue;
1892                         
1893                         /* we're only interested in Limit-Scale constraints */
1894                         if (con->type == CONSTRAINT_TYPE_SIZELIMIT) {
1895                                 bSizeLimitConstraint *data= con->data;
1896                                 float tmat[4][4];
1897                                 
1898                                 /* only use it if it's tagged for this purpose */
1899                                 if ((data->flag2 & LIMIT_TRANSFORM)==0)
1900                                         continue;
1901                                 
1902                                 /* do space conversions */
1903                                 if (con->ownspace == CONSTRAINT_SPACE_WORLD) {
1904                                         /* just multiply by td->mtx (this should be ok) */
1905                                         Mat4CpyMat4(tmat, cob.matrix);
1906                                         Mat4MulMat34(cob.matrix, td->mtx, tmat);
1907                                 }
1908                                 else if (con->ownspace != CONSTRAINT_SPACE_LOCAL) {
1909                                         /* skip... incompatable spacetype */
1910                                         continue;
1911                                 }
1912                                 
1913                                 /* do constraint */
1914                                 cti->evaluate_constraint(con, &cob, NULL);
1915                                 
1916                                 /* convert spaces again */
1917                                 if (con->ownspace == CONSTRAINT_SPACE_WORLD) {
1918                                         /* just multiply by td->mtx (this should be ok) */
1919                                         Mat4CpyMat4(tmat, cob.matrix);
1920                                         Mat4MulMat34(cob.matrix, td->smtx, tmat);
1921                                 }
1922                         }
1923                 }
1924                 
1925                 /* copy results from cob->matrix */
1926                 if ((td->flag & TD_SINGLESIZE) && !(t->con.mode & CON_APPLY)) {
1927                         /* scale val and reset size */
1928                         return; // TODO: fix this case
1929                 }
1930                 else {
1931                         /* Reset val if SINGLESIZE but using a constraint */
1932                         if (td->flag & TD_SINGLESIZE)
1933                                 return;
1934                         
1935                         Mat4ToSize(cob.matrix, td->ext->size);
1936                 }
1937         }
1938 }
1939
1940 /* ************************** WARP *************************** */
1941
1942 void initWarp(TransInfo *t)
1943 {
1944         float max[3], min[3];
1945         int i;
1946         
1947         t->mode = TFM_WARP;
1948         t->transform = Warp;
1949         t->handleEvent = handleEventWarp;
1950         
1951         initMouseInputMode(t, &t->mouse, INPUT_HORIZONTAL_RATIO);
1952         
1953         t->idx_max = 0;
1954         t->num.idx_max = 0;
1955         t->snap[0] = 0.0f;
1956         t->snap[1] = 5.0f;
1957         t->snap[2] = 1.0f;
1958         
1959         t->flag |= T_NO_CONSTRAINT;
1960         
1961         /* we need min/max in view space */
1962         for(i = 0; i < t->total; i++) {
1963                 float center[3];
1964                 VECCOPY(center, t->data[i].center);
1965                 Mat3MulVecfl(t->data[i].mtx, center);
1966                 Mat4MulVecfl(t->viewmat, center);
1967                 VecSubf(center, center, t->viewmat[3]);
1968                 if (i)
1969                         MinMax3(min, max, center);
1970                 else {
1971                         VECCOPY(max, center);
1972                         VECCOPY(min, center);
1973                 }
1974         }
1975         
1976         t->center[0]= (min[0]+max[0])/2.0f;
1977         t->center[1]= (min[1]+max[1])/2.0f;
1978         t->center[2]= (min[2]+max[2])/2.0f;
1979
1980         if (max[0] == min[0]) max[0] += 0.1; /* not optimal, but flipping is better than invalid garbage (i.e. division by zero!) */
1981         t->val= (max[0]-min[0])/2.0f; /* t->val is X dimension projected boundbox */
1982 }
1983
1984 int handleEventWarp(TransInfo *t, wmEvent *event)
1985 {
1986         int status = 0;
1987         
1988         if (event->type == MIDDLEMOUSE && event->val==KM_PRESS)
1989         {
1990                 // Use customData pointer to signal warp direction
1991                 if      (t->customData == 0)
1992                         t->customData = (void*)1;
1993                 else
1994                         t->customData = 0;
1995                 
1996                 status = 1;
1997         }
1998         
1999         return status;
2000 }
2001
2002 int Warp(TransInfo *t, short mval[2])
2003 {
2004         TransData *td = t->data;
2005         float vec[3], circumfac, dist, phi0, co, si, *curs, cursor[3], gcursor[3];
2006         int i;
2007         char str[50];
2008         
2009         curs= give_cursor(t->scene, t->view);
2010         /*
2011          * gcursor is the one used for helpline.
2012          * It has to be in the same space as the drawing loop
2013          * (that means it needs to be in the object's space when in edit mode and
2014          *  in global space in object mode)
2015          *
2016          * cursor is used for calculations.
2017          * It needs to be in view space, but we need to take object's offset
2018          * into account if in Edit mode.
2019          */
2020         VECCOPY(cursor, curs);
2021         VECCOPY(gcursor, cursor);
2022         if (t->flag & T_EDIT) {
2023                 VecSubf(cursor, cursor, t->obedit->obmat[3]);
2024                 VecSubf(gcursor, gcursor, t->obedit->obmat[3]);
2025                 Mat3MulVecfl(t->data->smtx, gcursor);
2026         }
2027         Mat4MulVecfl(t->viewmat, cursor);
2028         VecSubf(cursor, cursor, t->viewmat[3]);
2029         
2030         /* amount of degrees for warp */
2031         circumfac = 360.0f * t->values[0];
2032         
2033         if (t->customData) /* non-null value indicates reversed input */
2034         {
2035                 circumfac *= -1;
2036         }
2037         
2038         snapGrid(t, &circumfac);
2039         applyNumInput(&t->num, &circumfac);
2040         
2041         /* header print for NumInput */
2042         if (hasNumInput(&t->num)) {
2043                 char c[20];
2044                 
2045                 outputNumInput(&(t->num), c);
2046                 
2047                 sprintf(str, "Warp: %s", c);
2048         }
2049         else {
2050                 /* default header print */
2051                 sprintf(str, "Warp: %.3f", circumfac);
2052         }
2053         
2054         circumfac*= (float)(-M_PI/360.0);
2055         
2056         for(i = 0; i < t->total; i++, td++) {
2057                 float loc[3];
2058                 if (td->flag & TD_NOACTION)
2059                         break;
2060                 
2061                 if (td->flag & TD_SKIP)
2062                         continue;
2063                 
2064                 /* translate point to center, rotate in such a way that outline==distance */
2065                 VECCOPY(vec, td->iloc);
2066                 Mat3MulVecfl(td->mtx, vec);
2067                 Mat4MulVecfl(t->viewmat, vec);
2068                 VecSubf(vec, vec, t->viewmat[3]);
2069                 
2070                 dist= vec[0]-cursor[0];
2071                 
2072                 /* t->val is X dimension projected boundbox */
2073                 phi0= (circumfac*dist/t->val);
2074                 
2075                 vec[1]= (vec[1]-cursor[1]);
2076                 
2077                 co= (float)cos(phi0);
2078                 si= (float)sin(phi0);
2079                 loc[0]= -si*vec[1]+cursor[0];
2080                 loc[1]= co*vec[1]+cursor[1];
2081                 loc[2]= vec[2];
2082                 
2083                 Mat4MulVecfl(t->viewinv, loc);
2084                 VecSubf(loc, loc, t->viewinv[3]);
2085                 Mat3MulVecfl(td->smtx, loc);
2086                 
2087                 VecSubf(loc, loc, td->iloc);
2088                 VecMulf(loc, td->factor);
2089                 VecAddf(td->loc, td->iloc, loc);
2090         }
2091         
2092         recalcData(t);
2093         
2094         ED_area_headerprint(t->sa, str);
2095         
2096         return 1;
2097 }
2098
2099 /* ************************** SHEAR *************************** */
2100
2101 void initShear(TransInfo *t)
2102 {
2103         t->mode = TFM_SHEAR;
2104         t->transform = Shear;
2105         t->handleEvent = handleEventShear;
2106         
2107         initMouseInputMode(t, &t->mouse, INPUT_HORIZONTAL_ABSOLUTE);
2108         
2109         t->idx_max = 0;
2110         t->num.idx_max = 0;
2111         t->snap[0] = 0.0f;
2112         t->snap[1] = 0.1f;
2113         t->snap[2] = t->snap[1] * 0.1f;
2114         
2115         t->flag |= T_NO_CONSTRAINT;
2116 }
2117
2118 int handleEventShear(TransInfo *t, wmEvent *event)
2119 {
2120         int status = 0;
2121         
2122         if (event->type == MIDDLEMOUSE && event->val==KM_PRESS)
2123         {
2124                 // Use customData pointer to signal Shear direction
2125                 if      (t->customData == 0)
2126                 {
2127                         initMouseInputMode(t, &t->mouse, INPUT_VERTICAL_ABSOLUTE);
2128                         t->customData = (void*)1;
2129                 }
2130                 else
2131                 {
2132                         initMouseInputMode(t, &t->mouse, INPUT_HORIZONTAL_ABSOLUTE);
2133                         t->customData = 0;
2134                 }
2135                 
2136                 status = 1;
2137         }
2138         
2139         return status;
2140 }
2141
2142
2143 int Shear(TransInfo *t, short mval[2])
2144 {
2145         TransData *td = t->data;
2146         float vec[3];
2147         float smat[3][3], tmat[3][3], totmat[3][3], persmat[3][3], persinv[3][3];
2148         float value;
2149         int i;
2150         char str[50];
2151         
2152         Mat3CpyMat4(persmat, t->viewmat);
2153         Mat3Inv(persinv, persmat);
2154         
2155         value = 0.05f * t->values[0];
2156         
2157         snapGrid(t, &value);
2158         
2159         applyNumInput(&t->num, &value);
2160         
2161         /* header print for NumInput */
2162         if (hasNumInput(&t->num)) {
2163                 char c[20];
2164                 
2165                 outputNumInput(&(t->num), c);
2166                 
2167                 sprintf(str, "Shear: %s %s", c, t->proptext);
2168         }
2169         else {
2170                 /* default header print */
2171                 sprintf(str, "Shear: %.3f %s", value, t->proptext);
2172         }
2173         
2174         Mat3One(smat);
2175         
2176         // Custom data signals shear direction
2177         if (t->customData == 0)
2178                 smat[1][0] = value;
2179         else
2180                 smat[0][1] = value;
2181         
2182         Mat3MulMat3(tmat, smat, persmat);
2183         Mat3MulMat3(totmat, persinv, tmat);
2184         
2185         for(i = 0 ; i < t->total; i++, td++) {
2186                 if (td->flag & TD_NOACTION)
2187                         break;
2188                 
2189                 if (td->flag & TD_SKIP)
2190                         continue;
2191                 
2192                 if (t->obedit) {
2193                         float mat3[3][3];
2194                         Mat3MulMat3(mat3, totmat, td->mtx);
2195                         Mat3MulMat3(tmat, td->smtx, mat3);
2196                 }
2197                 else {
2198                         Mat3CpyMat3(tmat, totmat);
2199                 }
2200                 VecSubf(vec, td->center, t->center);
2201                 
2202                 Mat3MulVecfl(tmat, vec);
2203                 
2204                 VecAddf(vec, vec, t->center);
2205                 VecSubf(vec, vec, td->center);
2206                 
2207                 VecMulf(vec, td->factor);
2208                 
2209                 VecAddf(td->loc, td->iloc, vec);
2210         }
2211         
2212         recalcData(t);
2213         
2214         ED_area_headerprint(t->sa, str);
2215
2216         return 1;
2217 }
2218
2219 /* ************************** RESIZE *************************** */
2220
2221 void initResize(TransInfo *t)
2222 {
2223         t->mode = TFM_RESIZE;
2224         t->transform = Resize;
2225         
2226         initMouseInputMode(t, &t->mouse, INPUT_SPRING_FLIP);
2227         
2228         t->flag |= T_NULL_ONE;
2229         t->num.flag |= NUM_NULL_ONE;
2230         t->num.flag |= NUM_AFFECT_ALL;
2231         if (!t->obedit) {
2232                 t->flag |= T_NO_ZERO;
2233                 t->num.flag |= NUM_NO_ZERO;
2234         }
2235         
2236         t->idx_max = 2;
2237         t->num.idx_max = 2;
2238         t->snap[0] = 0.0f;
2239         t->snap[1] = 0.1f;
2240         t->snap[2] = t->snap[1] * 0.1f;
2241 }
2242
2243 static void headerResize(TransInfo *t, float vec[3], char *str) {
2244         char tvec[60];
2245         if (hasNumInput(&t->num)) {
2246                 outputNumInput(&(t->num), tvec);
2247         }
2248         else {
2249                 sprintf(&tvec[0], "%.4f", vec[0]);
2250                 sprintf(&tvec[20], "%.4f", vec[1]);
2251                 sprintf(&tvec[40], "%.4f", vec[2]);
2252         }
2253         
2254         if (t->con.mode & CON_APPLY) {
2255                 switch(t->num.idx_max) {
2256                 case 0:
2257                         sprintf(str, "Scale: %s%s %s", &tvec[0], t->con.text, t->proptext);
2258                         break;
2259                 case 1:
2260                         sprintf(str, "Scale: %s : %s%s %s", &tvec[0], &tvec[20], t->con.text, t->proptext);
2261                         break;
2262                 case 2:
2263                         sprintf(str, "Scale: %s : %s : %s%s %s", &tvec[0], &tvec[20], &tvec[40], t->con.text, t->proptext);
2264                 }
2265         }
2266         else {
2267                 if (t->flag & T_2D_EDIT)
2268                         sprintf(str, "Scale X: %s   Y: %s%s %s", &tvec[0], &tvec[20], t->con.text, t->proptext);
2269                 else
2270                         sprintf(str, "Scale X: %s   Y: %s  Z: %s%s %s", &tvec[0], &tvec[20], &tvec[40], t->con.text, t->proptext);
2271         }
2272 }
2273
2274 #define SIGN(a)         (a<-FLT_EPSILON?1:a>FLT_EPSILON?2:3)
2275 #define VECSIGNFLIP(a, b) ((SIGN(a[0]) & SIGN(b[0]))==0 || (SIGN(a[1]) & SIGN(b[1]))==0 || (SIGN(a[2]) & SIGN(b[2]))==0)
2276
2277 /* smat is reference matrix, only scaled */
2278 static void TransMat3ToSize( float mat[][3], float smat[][3], float *size)
2279 {
2280         float vec[3];
2281         
2282         VecCopyf(vec, mat[0]);
2283         size[0]= Normalize(vec);
2284         VecCopyf(vec, mat[1]);
2285         size[1]= Normalize(vec);
2286         VecCopyf(vec, mat[2]);
2287         size[2]= Normalize(vec);
2288         
2289         /* first tried with dotproduct... but the sign flip is crucial */
2290         if( VECSIGNFLIP(mat[0], smat[0]) ) size[0]= -size[0];
2291         if( VECSIGNFLIP(mat[1], smat[1]) ) size[1]= -size[1];
2292         if( VECSIGNFLIP(mat[2], smat[2]) ) size[2]= -size[2];
2293 }
2294
2295
2296 static void ElementResize(TransInfo *t, TransData *td, float mat[3][3]) {
2297         float tmat[3][3], smat[3][3], center[3];
2298         float vec[3];
2299         
2300         if (t->flag & T_EDIT) {
2301                 Mat3MulMat3(smat, mat, td->mtx);
2302                 Mat3MulMat3(tmat, td->smtx, smat);
2303         }
2304         else {
2305                 Mat3CpyMat3(tmat, mat);
2306         }
2307         
2308         if (t->con.applySize) {
2309                 t->con.applySize(t, td, tmat);
2310         }
2311         
2312         /* local constraint shouldn't alter center */
2313         if (t->around == V3D_LOCAL) {
2314                 if (t->flag & T_OBJECT) {
2315                         VECCOPY(center, td->center);
2316                 }
2317                 else if (t->flag & T_EDIT) {
2318                         
2319                         if(t->around==V3D_LOCAL && (t->settings->selectmode & SCE_SELECT_FACE)) {
2320                                 VECCOPY(center, td->center);
2321                         }
2322                         else {
2323                                 VECCOPY(center, t->center);
2324                         }
2325                 }
2326                 else {
2327                         VECCOPY(center, t->center);
2328                 }
2329         }
2330         else {
2331                 VECCOPY(center, t->center);
2332         }
2333         
2334         if (td->ext) {
2335                 float fsize[3];
2336                 
2337                 if (t->flag & (T_OBJECT|T_TEXTURE|T_POSE)) {
2338                         float obsizemat[3][3];
2339                         // Reorient the size mat to fit the oriented object.
2340                         Mat3MulMat3(obsizemat, td->axismtx, tmat);
2341                         //printmatrix3("obsizemat", obsizemat);
2342                         TransMat3ToSize(obsizemat, td->axismtx, fsize);
2343                         //printvecf("fsize", fsize);
2344                 }
2345                 else {
2346                         Mat3ToSize(tmat, fsize);
2347                 }
2348                 
2349                 protectedSizeBits(td->protectflag, fsize);
2350                 
2351                 if ((t->flag & T_V3D_ALIGN)==0) {       // align mode doesn't resize objects itself
2352                         if((td->flag & TD_SINGLESIZE) && !(t->con.mode & CON_APPLY)){
2353                                 /* scale val and reset size */
2354                                 *td->val = td->ival * fsize[0] * td->factor;
2355                                 
2356                                 td->ext->size[0] = td->ext->isize[0];
2357                                 td->ext->size[1] = td->ext->isize[1];
2358                                 td->ext->size[2] = td->ext->isize[2];
2359                         }
2360                         else {
2361                                 /* Reset val if SINGLESIZE but using a constraint */
2362                                 if (td->flag & TD_SINGLESIZE)
2363                                         *td->val = td->ival;
2364                                 
2365                                 td->ext->size[0] = td->ext->isize[0] * (fsize[0]) * td->factor;
2366                                 td->ext->size[1] = td->ext->isize[1] * (fsize[1]) * td->factor;
2367                                 td->ext->size[2] = td->ext->isize[2] * (fsize[2]) * td->factor;
2368                         }
2369                 }
2370                 
2371                 constraintSizeLim(t, td);
2372         }
2373         
2374         /* For individual element center, Editmode need to use iloc */
2375         if (t->flag & T_POINTS)
2376                 VecSubf(vec, td->iloc, center);
2377         else
2378                 VecSubf(vec, td->center, center);
2379         
2380         Mat3MulVecfl(tmat, vec);
2381         
2382         VecAddf(vec, vec, center);
2383         if (t->flag & T_POINTS)
2384                 VecSubf(vec, vec, td->iloc);
2385         else
2386                 VecSubf(vec, vec, td->center);
2387         
2388         VecMulf(vec, td->factor);
2389         
2390         if (t->flag & (T_OBJECT|T_POSE)) {
2391                 Mat3MulVecfl(td->smtx, vec);
2392         }
2393         
2394         protectedTransBits(td->protectflag, vec);
2395         VecAddf(td->loc, td->iloc, vec);
2396         
2397         constraintTransLim(t, td);
2398 }
2399
2400 int Resize(TransInfo *t, short mval[2])
2401 {
2402         TransData *td;
2403         float size[3], mat[3][3];
2404         float ratio;
2405         int i;
2406         char str[200];
2407         
2408         /* for manipulator, center handle, the scaling can't be done relative to center */
2409         if( (t->flag & T_USES_MANIPULATOR) && t->con.mode==0)
2410         {
2411                 ratio = 1.0f - ((t->imval[0] - mval[0]) + (t->imval[1] - mval[1]))/100.0f;
2412         }
2413         else
2414         {
2415                 ratio = t->values[0];
2416         }
2417         
2418         size[0] = size[1] = size[2] = ratio;
2419         
2420         snapGrid(t, size);
2421         
2422         if (hasNumInput(&t->num)) {
2423                 applyNumInput(&t->num, size);
2424                 constraintNumInput(t, size);
2425         }
2426         
2427         applySnapping(t, size);
2428         
2429         if (t->flag & T_AUTOVALUES)
2430         {
2431                 VECCOPY(size, t->auto_values);
2432         }
2433         
2434         VECCOPY(t->values, size);
2435         
2436         SizeToMat3(size, mat);
2437         
2438         if (t->con.applySize) {
2439                 t->con.applySize(t, NULL, mat);
2440         }
2441         
2442         Mat3CpyMat3(t->mat, mat);       // used in manipulator
2443         
2444         headerResize(t, size, str);
2445         
2446         for(i = 0, td=t->data; i < t->total; i++, td++) {
2447                 if (td->flag & TD_NOACTION)
2448                         break;
2449                 
2450                 if (td->flag & TD_SKIP)
2451                         continue;
2452                 
2453                 ElementResize(t, td, mat);
2454         }
2455         
2456         /* evil hack - redo resize if cliping needed */
2457         if (t->flag & T_CLIP_UV && clipUVTransform(t, size, 1)) {
2458                 SizeToMat3(size, mat);
2459                 
2460                 if (t->con.applySize)
2461                         t->con.applySize(t, NULL, mat);
2462                 
2463                 for(i = 0, td=t->data; i < t->total; i++, td++)
2464                         ElementResize(t, td, mat);
2465         }
2466         
2467         recalcData(t);
2468         
2469         ED_area_headerprint(t->sa, str);
2470         
2471         return 1;
2472 }
2473
2474 /* ************************** TOSPHERE *************************** */
2475
2476 void initToSphere(TransInfo *t)
2477 {
2478         TransData *td = t->data;
2479         int i;
2480         
2481         t->mode = TFM_TOSPHERE;
2482         t->transform = ToSphere;
2483         
2484         initMouseInputMode(t, &t->mouse, INPUT_HORIZONTAL_RATIO);
2485         
2486         t->idx_max = 0;
2487         t->num.idx_max = 0;
2488         t->snap[0] = 0.0f;
2489         t->snap[1] = 0.1f;
2490         t->snap[2] = t->snap[1] * 0.1f;
2491         
2492         t->num.flag |= NUM_NULL_ONE | NUM_NO_NEGATIVE;
2493         t->flag |= T_NO_CONSTRAINT;
2494         
2495         // Calculate average radius
2496         for(i = 0 ; i < t->total; i++, td++) {
2497                 t->val += VecLenf(t->center, td->iloc);
2498         }
2499         
2500         t->val /= (float)t->total;
2501 }
2502
2503 int ToSphere(TransInfo *t, short mval[2])
2504 {
2505         float vec[3];
2506         float ratio, radius;
2507         int i;
2508         char str[64];
2509         TransData *td = t->data;
2510         
2511         ratio = t->values[0];
2512         
2513         snapGrid(t, &ratio);
2514         
2515         applyNumInput(&t->num, &ratio);
2516         
2517         if (ratio < 0)
2518                 ratio = 0.0f;
2519         else if (ratio > 1)
2520                 ratio = 1.0f;
2521         
2522         /* header print for NumInput */
2523         if (hasNumInput(&t->num)) {
2524                 char c[20];
2525                 
2526                 outputNumInput(&(t->num), c);
2527                 
2528                 sprintf(str, "To Sphere: %s %s", c, t->proptext);
2529         }
2530         else {
2531                 /* default header print */
2532                 sprintf(str, "To Sphere: %.4f %s", ratio, t->proptext);
2533         }
2534         
2535         
2536         for(i = 0 ; i < t->total; i++, td++) {
2537                 float tratio;
2538                 if (td->flag & TD_NOACTION)
2539                         break;
2540                 
2541                 if (td->flag & TD_SKIP)
2542                         continue;
2543                 
2544                 VecSubf(vec, td->iloc, t->center);
2545                 
2546                 radius = Normalize(vec);
2547                 
2548                 tratio = ratio * td->factor;
2549                 
2550                 VecMulf(vec, radius * (1.0f - tratio) + t->val * tratio);
2551                 
2552                 VecAddf(td->loc, t->center, vec);
2553         }
2554         
2555         
2556         recalcData(t);
2557         
2558         ED_area_headerprint(t->sa, str);
2559         
2560         return 1;
2561 }
2562
2563 /* ************************** ROTATION *************************** */
2564
2565
2566 void initRotation(TransInfo *t)
2567 {
2568         t->mode = TFM_ROTATION;
2569         t->transform = Rotation;
2570         
2571         initMouseInputMode(t, &t->mouse, INPUT_ANGLE);
2572         
2573         t->ndof.axis = 16;
2574         /* Scale down and flip input for rotation */
2575         t->ndof.factor[0] = -0.2f;
2576         
2577         t->idx_max = 0;
2578         t->num.idx_max = 0;
2579         t->snap[0] = 0.0f;
2580         t->snap[1] = (float)((5.0/180)*M_PI);
2581         t->snap[2] = t->snap[1] * 0.2f;
2582         
2583         if (t->flag & T_2D_EDIT)
2584                 t->flag |= T_NO_CONSTRAINT;
2585 }
2586
2587 static void ElementRotation(TransInfo *t, TransData *td, float mat[3][3], short around) {
2588         float vec[3], totmat[3][3], smat[3][3];
2589         float eul[3], fmat[3][3], quat[4];
2590         float *center = t->center;
2591         
2592         /* local constraint shouldn't alter center */
2593         if (around == V3D_LOCAL) {
2594                 if (t->flag & (T_OBJECT|T_POSE)) {
2595                         center = td->center;
2596                 }
2597                 else {
2598                         /* !TODO! Make this if not rely on G */
2599                         if(around==V3D_LOCAL && (t->settings->selectmode & SCE_SELECT_FACE)) {
2600                                 center = td->center;
2601                         }
2602                 }
2603         }
2604         
2605         if (t->flag & T_POINTS) {
2606                 Mat3MulMat3(totmat, mat, td->mtx);
2607                 Mat3MulMat3(smat, td->smtx, totmat);
2608                 
2609                 VecSubf(vec, td->iloc, center);
2610                 Mat3MulVecfl(smat, vec);
2611                 
2612                 VecAddf(td->loc, vec, center);
2613                 
2614                 VecSubf(vec,td->loc,td->iloc);
2615                 protectedTransBits(td->protectflag, vec);
2616                 VecAddf(td->loc, td->iloc, vec);
2617                 
2618                 
2619                 if(td->flag & TD_USEQUAT) {
2620                         Mat3MulSerie(fmat, td->mtx, mat, td->smtx, 0, 0, 0, 0, 0);
2621                         Mat3ToQuat(fmat, quat); // Actual transform
2622                         
2623                         if(td->ext->quat){
2624                                 QuatMul(td->ext->quat, quat, td->ext->iquat);
2625                                 
2626                                 /* is there a reason not to have this here? -jahka */
2627                                 protectedQuaternionBits(td->protectflag, td->ext->quat, td->ext->iquat);
2628                         }
2629                 }
2630         }
2631         /**
2632          * HACK WARNING
2633          *
2634          * This is some VERY ugly special case to deal with pose mode.
2635          *
2636          * The problem is that mtx and smtx include each bone orientation.
2637          *
2638          * That is needed to rotate each bone properly, HOWEVER, to calculate
2639          * the translation component, we only need the actual armature object's
2640          * matrix (and inverse). That is not all though. Once the proper translation
2641          * has been computed, it has to be converted back into the bone's space.
2642          */
2643         else if (t->flag & T_POSE) {
2644                 float pmtx[3][3], imtx[3][3];
2645                 
2646                 // Extract and invert armature object matrix
2647                 Mat3CpyMat4(pmtx, t->poseobj->obmat);
2648                 Mat3Inv(imtx, pmtx);
2649                 
2650                 if ((td->flag & TD_NO_LOC) == 0)
2651                 {
2652                         VecSubf(vec, td->center, center);
2653                         
2654                         Mat3MulVecfl(pmtx, vec);        // To Global space
2655                         Mat3MulVecfl(mat, vec);         // Applying rotation
2656                         Mat3MulVecfl(imtx, vec);        // To Local space
2657                         
2658                         VecAddf(vec, vec, center);
2659                         /* vec now is the location where the object has to be */
2660                         
2661                         VecSubf(vec, vec, td->center); // Translation needed from the initial location
2662                         
2663                         Mat3MulVecfl(pmtx, vec);        // To Global space
2664                         Mat3MulVecfl(td->smtx, vec);// To Pose space
2665                         
2666                         protectedTransBits(td->protectflag, vec);
2667                         
2668                         VecAddf(td->loc, td->iloc, vec);
2669                         
2670                         constraintTransLim(t, td);
2671                 }
2672                 
2673                 /* rotation */
2674                 if ((t->flag & T_V3D_ALIGN)==0) { // align mode doesn't rotate objects itself
2675                         /* euler or quaternion/axis-angle? */
2676                         if (td->rotOrder == ROT_MODE_QUAT) {
2677                                 Mat3MulSerie(fmat, td->mtx, mat, td->smtx, 0, 0, 0, 0, 0);
2678                                 
2679                                 Mat3ToQuat(fmat, quat); // Actual transform
2680                                 
2681                                 QuatMul(td->ext->quat, quat, td->ext->iquat);
2682                                 /* this function works on end result */
2683                                 protectedQuaternionBits(td->protectflag, td->ext->quat, td->ext->iquat);
2684                                 
2685                         }
2686                         else if (td->rotOrder == ROT_MODE_AXISANGLE) {
2687                                 /* calculate effect based on quats */
2688                                 float iquat[4];
2689                                 
2690                                 /* td->ext->(i)quat is in axis-angle form, not quats! */
2691                                 AxisAngleToQuat(iquat, &td->ext->iquat[1], td->ext->iquat[0]);
2692                                 
2693                                 Mat3MulSerie(fmat, td->mtx, mat, td->smtx, 0, 0, 0, 0, 0);
2694                                 Mat3ToQuat(fmat, quat); // Actual transform
2695                                 
2696                                 QuatMul(td->ext->quat, quat, iquat);
2697                                 
2698                                 /* make temp copy (since stored in same place) */
2699                                 QUATCOPY(quat, td->ext->quat); // this is just a 4d vector copying macro
2700                                 QuatToAxisAngle(quat, &td->ext->quat[1], &td->ext->quat[0]); 
2701                                 
2702                                 /* this function works on end result */
2703                                 protectedAxisAngleBits(td->protectflag, td->ext->quat, td->ext->iquat);
2704                         }
2705                         else { 
2706                                 float eulmat[3][3];
2707                                 
2708                                 Mat3MulMat3(totmat, mat, td->mtx);
2709                                 Mat3MulMat3(smat, td->smtx, totmat);
2710                                 
2711                                 /* calculate the total rotatation in eulers */
2712                                 VECCOPY(eul, td->ext->irot);
2713                                 EulOToMat3(eul, td->rotOrder, eulmat);
2714                                 
2715                                 /* mat = transform, obmat = bone rotation */
2716                                 Mat3MulMat3(fmat, smat, eulmat);
2717                                 
2718                                 Mat3ToCompatibleEulO(fmat, eul, td->ext->rot, td->rotOrder);
2719                                 
2720                                 /* and apply (to end result only) */
2721                                 protectedRotateBits(td->protectflag, eul, td->ext->irot);
2722                                 VECCOPY(td->ext->rot, eul);
2723                         }
2724                         
2725                         constraintRotLim(t, td);
2726                 }
2727         }
2728         else {
2729                 if ((td->flag & TD_NO_LOC) == 0)
2730                 {
2731                         /* translation */
2732                         VecSubf(vec, td->center, center);
2733                         Mat3MulVecfl(mat, vec);
2734                         VecAddf(vec, vec, center);
2735                         /* vec now is the location where the object has to be */
2736                         VecSubf(vec, vec, td->center);
2737                         Mat3MulVecfl(td->smtx, vec);
2738                         
2739                         protectedTransBits(td->protectflag, vec);
2740                         
2741                         VecAddf(td->loc, td->iloc, vec);
2742                 }
2743                 
2744                 
2745                 constraintTransLim(t, td);
2746                 
2747                 /* rotation */
2748                 if ((t->flag & T_V3D_ALIGN)==0) { // align mode doesn't rotate objects itself
2749                         /* euler or quaternion? */
2750                     if ((td->rotOrder == ROT_MODE_QUAT) || (td->flag & TD_USEQUAT)) {
2751                                 Mat3MulSerie(fmat, td->mtx, mat, td->smtx, 0, 0, 0, 0, 0);
2752                                 Mat3ToQuat(fmat, quat); // Actual transform
2753                                 
2754                                 QuatMul(td->ext->quat, quat, td->ext->iquat);
2755                                 /* this function works on end result */
2756                                 protectedQuaternionBits(td->protectflag, td->ext->quat, td->ext->iquat);
2757                         }
2758                         else if (td->rotOrder == ROT_MODE_AXISANGLE) {
2759                                 /* calculate effect based on quats */
2760                                 float iquat[4];
2761                                 
2762                                 /* td->ext->(i)quat is in axis-angle form, not quats! */
2763                                 AxisAngleToQuat(iquat, &td->ext->iquat[1], td->ext->iquat[0]);
2764                                 
2765                                 Mat3MulSerie(fmat, td->mtx, mat, td->smtx, 0, 0, 0, 0, 0);
2766                                 Mat3ToQuat(fmat, quat); // Actual transform
2767                                 
2768                                 QuatMul(td->ext->quat, quat, iquat);
2769                                 
2770                                 /* make temp copy (since stored in same place) */
2771                                 QUATCOPY(quat, td->ext->quat); // this is just a 4d vector copying macro
2772                                 QuatToAxisAngle(quat, &td->ext->quat[1], &td->ext->quat[0]); 
2773                                 
2774                                 /* this function works on end result */
2775                                 protectedAxisAngleBits(td->protectflag, td->ext->quat, td->ext->iquat);
2776                         }
2777                         else {
2778                                 float obmat[3][3];
2779                                 
2780                                 Mat3MulMat3(totmat, mat, td->mtx);
2781                                 Mat3MulMat3(smat, td->smtx, totmat);
2782                                 
2783                                 /* calculate the total rotatation in eulers */
2784                                 VecAddf(eul, td->ext->irot, td->ext->drot); /* we have to correct for delta rot */
2785                                 EulOToMat3(eul, td->rotOrder, obmat);
2786                                 /* mat = transform, obmat = object rotation */
2787                                 Mat3MulMat3(fmat, smat, obmat);
2788                                 
2789                                 Mat3ToCompatibleEulO(fmat, eul, td->ext->rot, td->rotOrder);
2790                                 
2791                                 /* correct back for delta rot */
2792                                 VecSubf(eul, eul, td->ext->drot);
2793                                 
2794                                 /* and apply */
2795                                 protectedRotateBits(td->protectflag, eul, td->ext->irot);
2796                                 VECCOPY(td->ext->rot, eul);
2797                         }
2798                         
2799                         constraintRotLim(t, td);
2800                 }
2801         }
2802 }
2803
2804 static void applyRotation(TransInfo *t, float angle, float axis[3])
2805 {
2806         TransData *td = t->data;
2807         float mat[3][3];
2808         int i;
2809         
2810         VecRotToMat3(axis, angle, mat);
2811         
2812         for(i = 0 ; i < t->total; i++, td++) {
2813                 
2814                 if (td->flag & TD_NOACTION)
2815                         break;
2816                 
2817                 if (td->flag & TD_SKIP)
2818                         continue;
2819                 
2820                 if (t->con.applyRot) {
2821                         t->con.applyRot(t, td, axis, NULL);
2822                         VecRotToMat3(axis, angle * td->factor, mat);
2823                 }
2824                 else if (t->flag & T_PROP_EDIT) {
2825                         VecRotToMat3(axis, angle * td->factor, mat);
2826                 }
2827                 
2828                 ElementRotation(t, td, mat, t->around);
2829         }
2830 }
2831
2832 int Rotation(TransInfo *t, short mval[2])
2833 {
2834         char str[64];
2835         
2836         float final;
2837         
2838         float axis[3];
2839         float mat[3][3];
2840         
2841         VECCOPY(axis, t->viewinv[2]);
2842         VecMulf(axis, -1.0f);
2843         Normalize(axis);
2844         
2845         final = t->values[0];
2846         
2847         applyNDofInput(&t->ndof, &final);
2848         
2849         snapGrid(t, &final);
2850         
2851         if (t->con.applyRot) {
2852                 t->con.applyRot(t, NULL, axis, &final);
2853         }
2854         
2855         applySnapping(t, &final);
2856         
2857         if (hasNumInput(&t->num)) {
2858                 char c[20];
2859                 
2860                 applyNumInput(&t->num, &final);
2861                 
2862                 outputNumInput(&(t->num), c);
2863                 
2864                 sprintf(str, "Rot: %s %s %s", &c[0], t->con.text, t->proptext);
2865                 
2866                 /* Clamp between -180 and 180 */
2867                 while (final >= 180.0)
2868                         final -= 360.0;
2869                 
2870                 while (final <= -180.0)
2871                         final += 360.0;
2872                 
2873                 final *= (float)(M_PI / 180.0);
2874         }
2875         else {
2876                 sprintf(str, "Rot: %.2f%s %s", 180.0*final/M_PI, t->con.text, t->proptext);
2877         }
2878         
2879         VecRotToMat3(axis, final, mat);
2880         
2881         // TRANSFORM_FIX_ME
2882 //      t->values[0] = final;           // used in manipulator
2883 //      Mat3CpyMat3(t->mat, mat);       // used in manipulator
2884         
2885         applyRotation(t, final, axis);
2886         
2887         recalcData(t);
2888         
2889         ED_area_headerprint(t->sa, str);
2890         
2891         return 1;
2892 }
2893
2894
2895 /* ************************** TRACKBALL *************************** */
2896
2897 void initTrackball(TransInfo *t)
2898 {
2899         t->mode = TFM_TRACKBALL;
2900         t->transform = Trackball;
2901
2902         initMouseInputMode(t, &t->mouse, INPUT_TRACKBALL);
2903
2904         t->ndof.axis = 40;
2905         /* Scale down input for rotation */
2906         t->ndof.factor[0] = 0.2f;
2907         t->ndof.factor[1] = 0.2f;
2908
2909         t->idx_max = 1;
2910         t->num.idx_max = 1;
2911         t->snap[0] = 0.0f;
2912         t->snap[1] = (float)((5.0/180)*M_PI);
2913         t->snap[2] = t->snap[1] * 0.2f;
2914
2915         t->flag |= T_NO_CONSTRAINT;
2916 }
2917
2918 static void applyTrackball(TransInfo *t, float axis1[3], float axis2[3], float angles[2])
2919 {
2920         TransData *td = t->data;
2921         float mat[3][3], smat[3][3], totmat[3][3];
2922         int i;
2923
2924         VecRotToMat3(axis1, angles[0], smat);
2925         VecRotToMat3(axis2, angles[1], totmat);
2926
2927         Mat3MulMat3(mat, smat, totmat);
2928
2929         for(i = 0 ; i < t->total; i++, td++) {
2930                 if (td->flag & TD_NOACTION)
2931                         break;
2932
2933                 if (td->flag & TD_SKIP)
2934                         continue;
2935
2936                 if (t->flag & T_PROP_EDIT) {
2937                         VecRotToMat3(axis1, td->factor * angles[0], smat);
2938                         VecRotToMat3(axis2, td->factor * angles[1], totmat);
2939
2940                         Mat3MulMat3(mat, smat, totmat);
2941                 }
2942
2943                 ElementRotation(t, td, mat, t->around);
2944         }
2945 }
2946
2947 int Trackball(TransInfo *t, short mval[2])
2948 {
2949         char str[128];
2950         float axis1[3], axis2[3];
2951         float mat[3][3], totmat[3][3], smat[3][3];
2952         float phi[2];
2953
2954         VECCOPY(axis1, t->persinv[0]);
2955         VECCOPY(axis2, t->persinv[1]);
2956         Normalize(axis1);
2957         Normalize(axis2);
2958
2959         phi[0] = t->values[0];
2960         phi[1] = t->values[1];
2961
2962         applyNDofInput(&t->ndof, phi);
2963
2964         snapGrid(t, phi);
2965
2966         if (hasNumInput(&t->num)) {
2967                 char c[40];
2968
2969                 applyNumInput(&t->num, phi);
2970
2971                 outputNumInput(&(t->num), c);
2972
2973                 sprintf(str, "Trackball: %s %s %s", &c[0], &c[20], t->proptext);
2974
2975                 phi[0] *= (float)(M_PI / 180.0);
2976                 phi[1] *= (float)(M_PI / 180.0);
2977         }
2978         else {
2979                 sprintf(str, "Trackball: %.2f %.2f %s", 180.0*phi[0]/M_PI, 180.0*phi[1]/M_PI, t->proptext);
2980         }
2981
2982         VecRotToMat3(axis1, phi[0], smat);
2983         VecRotToMat3(axis2, phi[1], totmat);
2984
2985         Mat3MulMat3(mat, smat, totmat);
2986
2987         // TRANSFORM_FIX_ME
2988         //Mat3CpyMat3(t->mat, mat);     // used in manipulator
2989
2990         applyTrackball(t, axis1, axis2, phi);
2991
2992         recalcData(t);
2993
2994         ED_area_headerprint(t->sa, str);
2995
2996         return 1;
2997 }