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_SCENE|ND_NODES, 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                                                         if ((t->modifiers & MOD_CONSTRAINT_PLANE) == 0)
 777                                                                 setUserConstraint(t, (CON_AXIS0), "along %s X");
 778                                                         else if (t->modifiers & MOD_CONSTRAINT_PLANE)
 779                                                                 setUserConstraint(t, (CON_AXIS1|CON_AXIS2), "locking %s X");
 780                                                 }
 781                                         }
 782                                 }
 783                                 else {
 784                                         if (t->flag & T_2D_EDIT) {
 785                                                 setConstraint(t, mati, (CON_AXIS0), "along X axis");
 786                                         }
 787                                         else {
 788                                                 if ((t->modifiers & MOD_CONSTRAINT_PLANE) == 0)
 789                                                         setConstraint(t, mati, (CON_AXIS0), "along global X");
 790                                                 else if (t->modifiers & MOD_CONSTRAINT_PLANE)
 791                                                         setConstraint(t, mati, (CON_AXIS1|CON_AXIS2), "locking global X");
 792                                         }
 793                                 }
 794                                 t->redraw = 1;
 795                         }
 796                         break;
 797                 case YKEY:
 798                         if ((t->flag & T_NO_CONSTRAINT)==0) {
 799                                 if (cmode == 'Y') {
 800                                         if (t->flag & T_2D_EDIT) {
 801                                                 stopConstraint(t);
 802                                         }
 803                                         else {
 804                                                 if (t->con.mode & CON_USER) {
 805                                                         stopConstraint(t);
 806                                                 }
 807                                                 else {
 808                                                         if ((t->modifiers & MOD_CONSTRAINT_PLANE) == 0)
 809                                                                 setUserConstraint(t, (CON_AXIS1), "along %s Y");
 810                                                         else if (t->modifiers & MOD_CONSTRAINT_PLANE)
 811                                                                 setUserConstraint(t, (CON_AXIS0|CON_AXIS2), "locking %s Y");
 812                                                 }
 813                                         }
 814                                 }
 815                                 else {
 816                                         if (t->flag & T_2D_EDIT) {
 817                                                 setConstraint(t, mati, (CON_AXIS1), "along Y axis");
 818                                         }
 819                                         else {
 820                                                 if ((t->modifiers & MOD_CONSTRAINT_PLANE) == 0)
 821                                                         setConstraint(t, mati, (CON_AXIS1), "along global Y");
 822                                                 else if (t->modifiers & MOD_CONSTRAINT_PLANE)
 823                                                         setConstraint(t, mati, (CON_AXIS0|CON_AXIS2), "locking global Y");
 824                                         }
 825                                 }
 826                                 t->redraw = 1;
 827                         }
 828                         break;
 829                 case ZKEY:
 830                         if ((t->flag & T_NO_CONSTRAINT)==0) {
 831                                 if (cmode == 'Z') {
 832                                         if (t->con.mode & CON_USER) {
 833                                                 stopConstraint(t);
 834                                         }
 835                                         else {
 836                                                 if ((t->modifiers & MOD_CONSTRAINT_PLANE) == 0)
 837                                                         setUserConstraint(t, (CON_AXIS2), "along %s Z");
 838                                                 else if ((t->modifiers & MOD_CONSTRAINT_PLANE) && ((t->flag & T_2D_EDIT)==0))
 839                                                         setUserConstraint(t, (CON_AXIS0|CON_AXIS1), "locking %s Z");
 840                                         }
 841                                 }
 842                                 else if ((t->flag & T_2D_EDIT)==0) {
 843                                         if ((t->modifiers & MOD_CONSTRAINT_PLANE) == 0)
 844                                                 setConstraint(t, mati, (CON_AXIS2), "along global Z");
 845                                         else if (t->modifiers & MOD_CONSTRAINT_PLANE)
 846                                                 setConstraint(t, mati, (CON_AXIS0|CON_AXIS1), "locking global Z");
 847                                 }
 848                                 t->redraw = 1;
 849                         }
 850                         break;
 851                 case OKEY:
 852                         if (t->flag & T_PROP_EDIT && event->shift) {
 853                                 t->prop_mode = (t->prop_mode + 1) % 6;
 854                                 calculatePropRatio(t);
 855                                 t->redraw = 1;
 856                         }
 857                         break;
 858                 case PADPLUSKEY:
 859                         if(event->alt && t->flag & T_PROP_EDIT) {
 860                                 t->prop_size *= 1.1f;
 861                                 calculatePropRatio(t);
 862                         }
 863                         t->redraw= 1;
 864                         break;
 865                 case PAGEUPKEY:
 866                 case WHEELDOWNMOUSE:
 867                         if (t->flag & T_AUTOIK) {
 868                                 transform_autoik_update(t, 1);
 869                         }
 870                         else if(t->flag & T_PROP_EDIT) {
 871                                 t->prop_size*= 1.1f;
 872                                 calculatePropRatio(t);
 873                         }
 874                         else view_editmove(event->type);
 875                         t->redraw= 1;
 876                         break;
 877                 case PADMINUS:
 878                         if(event->alt && t->flag & T_PROP_EDIT) {
 879                                 t->prop_size*= 0.90909090f;
 880                                 calculatePropRatio(t);
 881                         }
 882                         t->redraw= 1;
 883                         break;
 884                 case PAGEDOWNKEY:
 885                 case WHEELUPMOUSE:
 886                         if (t->flag & T_AUTOIK) {
 887                                 transform_autoik_update(t, -1);
 888                         }
 889                         else if (t->flag & T_PROP_EDIT) {
 890                                 t->prop_size*= 0.90909090f;
 891                                 calculatePropRatio(t);
 892                         }
 893                         else view_editmove(event->type);
 894                         t->redraw= 1;
 895                         break;
 896 //              case NDOFMOTION:
 897 //            viewmoveNDOF(1);
 898   //         break;
 899                 }
 900
 901                 // Numerical input events
 902                 t->redraw |= handleNumInput(&(t->num), event);
 903
 904                 // NDof input events
 905                 switch(handleNDofInput(&(t->ndof), event))
 906                 {
 907                         case NDOF_CONFIRM:
 908                                 if ((t->options & CTX_NDOF) == 0)
 909                                 {
 910                                         /* Confirm on normal transform only */
 911                                         t->state = TRANS_CONFIRM;
 912                                 }
 913                                 break;
 914                         case NDOF_CANCEL:
 915                                 if (t->options & CTX_NDOF)
 916                                 {
 917                                         /* Cancel on pure NDOF transform */
 918                                         t->state = TRANS_CANCEL;
 919                                 }
 920                                 else
 921                                 {
 922                                         /* Otherwise, just redraw, NDof input was cancelled */
 923                                         t->redraw = 1;
 924                                 }
 925                                 break;
 926                         case NDOF_NOMOVE:
 927                                 if (t->options & CTX_NDOF)
 928                                 {
 929                                         /* Confirm on pure NDOF transform */
 930                                         t->state = TRANS_CONFIRM;
 931                                 }
 932                                 break;
 933                         case NDOF_REFRESH:
 934                                 t->redraw = 1;
 935                                 break;
 936
 937                 }
 938
 939                 // Snapping events
 940                 t->redraw |= handleSnapping(t, event);
 941
 942                 //arrows_move_cursor(event->type);
 943         }
 944         else {
 945                 switch (event->type){
 946                 case LEFTMOUSE:
 947                         t->state = TRANS_CONFIRM;
 948                         break;
 949                 case LEFTSHIFTKEY:
 950                 case RIGHTSHIFTKEY:
 951                         t->modifiers &= ~MOD_CONSTRAINT_PLANE;
 952                         t->redraw = 1;
 953                         break;
 954
 955                 case LEFTCTRLKEY:
 956                 case RIGHTCTRLKEY:
 957                         t->modifiers &= ~MOD_SNAP_GEARS;
 958                         /* no redraw on release modifier keys! this makes sure you can assign the 'grid' still
 959                            after releasing modifer key */
 960                         //t->redraw = 1;
 961                         break;
 962                 case MIDDLEMOUSE:
 963                         if ((t->flag & T_NO_CONSTRAINT)==0) {
 964                                 t->modifiers &= ~MOD_CONSTRAINT_SELECT;
 965                                 postSelectConstraint(t);
 966                                 t->redraw = 1;
 967                         }
 968                         break;
 969 //              case LEFTMOUSE:
 970 //              case RIGHTMOUSE:
 971 //                      if(WM_modal_tweak_exit(event, t->event_type))
 972 ////                    if (t->options & CTX_TWEAK)
 973 //                              t->state = TRANS_CONFIRM;
 974 //                      break;
 975                 }
 976         }
 977
 978         // Per transform event, if present
 979         if (t->handleEvent)
 980                 t->redraw |= t->handleEvent(t, event);
 981 }
 982
 983 int calculateTransformCenter(bContext *C, wmEvent *event, int centerMode, float *vec)
 984 {
 985         TransInfo *t = MEM_callocN(sizeof(TransInfo), "TransInfo data");
 986         int success = 1;
 987
 988         t->state = TRANS_RUNNING;
 989
 990         t->options = CTX_NONE;
 991
 992         t->mode = TFM_DUMMY;
 993
 994         initTransInfo(C, t, NULL, event);                                       // internal data, mouse, vectors
 995
 996         createTransData(C, t);                  // make TransData structs from selection
 997
 998         t->around = centerMode;                         // override userdefined mode
 999
1000         if (t->total == 0) {
1001                 success = 0;
1002         }
1003         else {
1004                 success = 1;
1005
1006                 calculateCenter(t);
1007
1008                 // Copy center from constraint center. Transform center can be local
1009                 VECCOPY(vec, t->con.center);
1010         }
1011
1012         postTrans(t);
1013
1014         /* aftertrans does insert ipos and action channels, and clears base flags, doesnt read transdata */
1015         special_aftertrans_update(t);
1016
1017         MEM_freeN(t);
1018
1019         return success;
1020 }
1021
1022 typedef enum {
1023         UP,
1024         DOWN,
1025         LEFT,
1026         RIGHT
1027 } ArrowDirection;
1028 static void drawArrow(ArrowDirection d, short offset, short length, short size)
1029 {
1030         switch(d)
1031         {
1032                 case LEFT:
1033                         offset = -offset;
1034                         length = -length;
1035                         size = -size;
1036                 case RIGHT:
1037                         glBegin(GL_LINES);
1038                         glVertex2s( offset, 0);
1039                         glVertex2s( offset + length, 0);
1040                         glVertex2s( offset + length, 0);
1041                         glVertex2s( offset + length - size, -size);
1042                         glVertex2s( offset + length, 0);
1043                         glVertex2s( offset + length - size,  size);
1044                         glEnd();
1045                         break;
1046                 case DOWN:
1047                         offset = -offset;
1048                         length = -length;
1049                         size = -size;
1050                 case UP:
1051                         glBegin(GL_LINES);
1052                         glVertex2s( 0, offset);
1053                         glVertex2s( 0, offset + length);
1054                         glVertex2s( 0, offset + length);
1055                         glVertex2s(-size, offset + length - size);
1056                         glVertex2s( 0, offset + length);
1057                         glVertex2s( size, offset + length - size);
1058                         glEnd();
1059                         break;
1060         }
1061 }
1062
1063 static void drawArrowHead(ArrowDirection d, short size)
1064 {
1065         switch(d)
1066         {
1067                 case LEFT:
1068                         size = -size;
1069                 case RIGHT:
1070                         glBegin(GL_LINES);
1071                         glVertex2s( 0, 0);
1072                         glVertex2s( -size, -size);
1073                         glVertex2s( 0, 0);
1074                         glVertex2s( -size,  size);
1075                         glEnd();
1076                         break;
1077                 case DOWN:
1078                         size = -size;
1079                 case UP:
1080                         glBegin(GL_LINES);
1081                         glVertex2s( 0, 0);
1082                         glVertex2s(-size, -size);
1083                         glVertex2s( 0, 0);
1084                         glVertex2s( size, -size);
1085                         glEnd();
1086                         break;
1087         }
1088 }
1089
1090 static void drawArc(float size, float angle_start, float angle_end, int segments)
1091 {
1092         float delta = (angle_end - angle_start) / segments;
1093         float angle;
1094
1095         glBegin(GL_LINE_STRIP);
1096
1097         for( angle = angle_start; angle < angle_end; angle += delta)
1098         {
1099                 glVertex2f( cosf(angle) * size, sinf(angle) * size);
1100         }
1101         glVertex2f( cosf(angle_end) * size, sinf(angle_end) * size);
1102
1103         glEnd();
1104 }
1105
1106 void drawHelpline(const struct bContext *C, TransInfo *t)
1107 {
1108         if (t->helpline != HLP_NONE && !(t->flag & T_USES_MANIPULATOR))
1109         {
1110                 float vecrot[3], cent[2];
1111
1112                 VECCOPY(vecrot, t->center);
1113                 if(t->flag & T_EDIT) {
1114                         Object *ob= t->obedit;
1115                         if(ob) Mat4MulVecfl(ob->obmat, vecrot);
1116                 }
1117                 else if(t->flag & T_POSE) {
1118                         Object *ob=t->poseobj;
1119                         if(ob) Mat4MulVecfl(ob->obmat, vecrot);
1120                 }
1121
1122                 projectFloatView(t, vecrot, cent);      // no overflow in extreme cases
1123
1124                 glDisable(GL_DEPTH_TEST);
1125
1126                 glMatrixMode(GL_PROJECTION);
1127                 glPushMatrix();
1128                 glMatrixMode(GL_MODELVIEW);
1129                 glPushMatrix();
1130
1131                 ED_region_pixelspace(t->ar);
1132
1133                 switch(t->helpline)
1134                 {
1135                         case HLP_SPRING:
1136                                 UI_ThemeColor(TH_WIRE);
1137
1138                                 setlinestyle(3);
1139                                 glBegin(GL_LINE_STRIP);
1140                                 glVertex2sv(t->mval);
1141                                 glVertex2fv(cent);
1142                                 glEnd();
1143
1144                                 glTranslatef(t->mval[0], t->mval[1], 0);
1145                                 glRotatef(-180 / M_PI * atan2f(cent[0] - t->mval[0], cent[1] - t->mval[1]), 0, 0, 1);
1146
1147                                 setlinestyle(0);
1148                                 glLineWidth(3.0);
1149                                 drawArrow(UP, 5, 10, 5);
1150                                 drawArrow(DOWN, 5, 10, 5);
1151                                 glLineWidth(1.0);
1152                                 break;
1153                         case HLP_HARROW:
1154                                 UI_ThemeColor(TH_WIRE);
1155
1156                                 glTranslatef(t->mval[0], t->mval[1], 0);
1157
1158                                 glLineWidth(3.0);
1159                                 drawArrow(RIGHT, 5, 10, 5);
1160                                 drawArrow(LEFT, 5, 10, 5);
1161                                 glLineWidth(1.0);
1162                                 break;
1163                         case HLP_VARROW:
1164                                 UI_ThemeColor(TH_WIRE);
1165
1166                                 glTranslatef(t->mval[0], t->mval[1], 0);
1167
1168                                 glLineWidth(3.0);
1169                                 glBegin(GL_LINES);
1170                                 drawArrow(UP, 5, 10, 5);
1171                                 drawArrow(DOWN, 5, 10, 5);
1172                                 glLineWidth(1.0);
1173                                 break;
1174                         case HLP_ANGLE:
1175                                 {
1176                                         float dx = t->mval[0] - cent[0], dy = t->mval[1] - cent[1];
1177                                         float angle = atan2f(dy, dx);
1178                                         float dist = sqrtf(dx*dx + dy*dy);
1179                                         float delta_angle = MIN2(15 / dist, M_PI/4);
1180                                         float spacing_angle = MIN2(5 / dist, M_PI/12);
1181                                         UI_ThemeColor(TH_WIRE);
1182
1183                                         setlinestyle(3);
1184                                         glBegin(GL_LINE_STRIP);
1185                                         glVertex2sv(t->mval);
1186                                         glVertex2fv(cent);
1187                                         glEnd();
1188
1189                                         glTranslatef(cent[0], cent[1], 0);
1190
1191                                         setlinestyle(0);
1192                                         glLineWidth(3.0);
1193                                         drawArc(dist, angle - delta_angle, angle - spacing_angle, 10);
1194                                         drawArc(dist, angle + spacing_angle, angle + delta_angle, 10);
1195
1196                                         glPushMatrix();
1197
1198                                         glTranslatef(cosf(angle - delta_angle) * dist, sinf(angle - delta_angle) * dist, 0);
1199                                         glRotatef(180 / M_PI * (angle - delta_angle), 0, 0, 1);
1200
1201                                         drawArrowHead(DOWN, 5);
1202
1203                                         glPopMatrix();
1204
1205                                         glTranslatef(cosf(angle + delta_angle) * dist, sinf(angle + delta_angle) * dist, 0);
1206                                         glRotatef(180 / M_PI * (angle + delta_angle), 0, 0, 1);
1207
1208                                         drawArrowHead(UP, 5);
1209
1210                                         glLineWidth(1.0);
1211                                         break;
1212                                 }
1213                                 case HLP_TRACKBALL:
1214                                 {
1215                                         char col[3], col2[3];
1216                                         UI_GetThemeColor3ubv(TH_GRID, col);
1217
1218                                         glTranslatef(t->mval[0], t->mval[1], 0);
1219
1220                                         glLineWidth(3.0);
1221
1222                                         UI_make_axis_color(col, col2, 'x');
1223                                         glColor3ubv((GLubyte *)col2);
1224
1225                                         drawArrow(RIGHT, 5, 10, 5);
1226                                         drawArrow(LEFT, 5, 10, 5);
1227
1228                                         UI_make_axis_color(col, col2, 'y');
1229                                         glColor3ubv((GLubyte *)col2);
1230
1231                                         drawArrow(UP, 5, 10, 5);
1232                                         drawArrow(DOWN, 5, 10, 5);
1233                                         glLineWidth(1.0);
1234                                         break;
1235                                 }
1236                 }
1237
1238                 glMatrixMode(GL_PROJECTION);
1239                 glPopMatrix();
1240                 glMatrixMode(GL_MODELVIEW);
1241                 glPopMatrix();
1242
1243                 glEnable(GL_DEPTH_TEST);
1244         }
1245 }
1246
1247 void drawTransform(const struct bContext *C, struct ARegion *ar, void *arg)
1248 {
1249         TransInfo *t = arg;
1250
1251         drawConstraint(C, t);
1252         drawPropCircle(C, t);
1253         drawSnapping(C, t);
1254         drawHelpline(C, t);
1255 }
1256
1257 void saveTransform(bContext *C, TransInfo *t, wmOperator *op)
1258 {
1259         ToolSettings *ts = CTX_data_tool_settings(C);
1260         int constraint_axis[3] = {0, 0, 0};
1261         int proportional = 0;
1262
1263         if (RNA_struct_find_property(op->ptr, "value"))
1264         {
1265                 if (t->flag & T_AUTOVALUES)
1266                 {
1267                         RNA_float_set_array(op->ptr, "value", t->auto_values);
1268                 }
1269                 else
1270                 {
1271                         RNA_float_set_array(op->ptr, "value", t->values);
1272                 }
1273         }
1274
1275         /* XXX convert stupid flag to enum */
1276         switch(t->flag & (T_PROP_EDIT|T_PROP_CONNECTED))
1277         {
1278         case (T_PROP_EDIT|T_PROP_CONNECTED):
1279                 proportional = 2;
1280                 break;
1281         case T_PROP_EDIT:
1282                 proportional = 1;
1283                 break;
1284         default:
1285                 proportional = 0;
1286         }
1287
1288         if (RNA_struct_find_property(op->ptr, "proportional"))
1289         {
1290                 RNA_enum_set(op->ptr, "proportional", proportional);
1291                 RNA_enum_set(op->ptr, "proportional_editing_falloff", t->prop_mode);
1292                 RNA_float_set(op->ptr, "proportional_size", t->prop_size);
1293         }
1294
1295         if (RNA_struct_find_property(op->ptr, "mirror"))
1296         {
1297                 RNA_boolean_set(op->ptr, "mirror", t->flag & T_MIRROR);
1298         }
1299
1300         if (RNA_struct_find_property(op->ptr, "constraint_axis"))
1301         {
1302                 RNA_enum_set(op->ptr, "constraint_orientation", t->current_orientation);
1303
1304                 if (t->con.mode & CON_APPLY)
1305                 {
1306                         if (t->con.mode & CON_AXIS0) {
1307                                 constraint_axis[0] = 1;
1308                         }
1309                         if (t->con.mode & CON_AXIS1) {
1310                                 constraint_axis[1] = 1;
1311                         }
1312                         if (t->con.mode & CON_AXIS2) {
1313                                 constraint_axis[2] = 1;
1314                         }
1315                 }
1316
1317                 RNA_boolean_set_array(op->ptr, "constraint_axis", constraint_axis);
1318         }
1319
1320         // XXX If modal, save settings back in scene
1321         if (t->flag & T_MODAL)
1322         {
1323                 ts->prop_mode = t->prop_mode;
1324
1325                 /* only save back if it wasn't automatically disabled */
1326                 if ((t->options & CTX_NO_PET) == 0)
1327                 {
1328                         ts->proportional = proportional;
1329                         ts->proportional_size = t->prop_size;
1330                 }
1331
1332                 if(t->spacetype == SPACE_VIEW3D)
1333                 {
1334                         View3D *v3d = t->view;
1335
1336                         v3d->twmode = t->current_orientation;
1337                 }
1338         }
1339 }
1340
1341 int initTransform(bContext *C, TransInfo *t, wmOperator *op, wmEvent *event, int mode)
1342 {
1343         int options = 0;
1344
1345         /* added initialize, for external calls to set stuff in TransInfo, like undo string */
1346
1347         t->state = TRANS_RUNNING;
1348
1349         t->options = options;
1350
1351         t->mode = mode;
1352
1353         if (!initTransInfo(C, t, op, event))                                    // internal data, mouse, vectors
1354         {
1355                 return 0;
1356         }
1357
1358         if(t->spacetype == SPACE_VIEW3D)
1359         {
1360                 //calc_manipulator_stats(curarea);
1361                 initTransformOrientation(C, t);
1362
1363                 t->draw_handle = ED_region_draw_cb_activate(t->ar->type, drawTransform, t, REGION_DRAW_POST);
1364         }
1365         else if(t->spacetype == SPACE_IMAGE) {
1366                 Mat3One(t->spacemtx);
1367                 t->draw_handle = ED_region_draw_cb_activate(t->ar->type, drawTransform, t, REGION_DRAW_POST);
1368         }
1369         else
1370                 Mat3One(t->spacemtx);
1371
1372         createTransData(C, t);                  // make TransData structs from selection
1373
1374         if (t->total == 0) {
1375                 postTrans(t);
1376                 return 0;
1377         }
1378
1379         initSnapping(t, op); // Initialize snapping data AFTER mode flags
1380
1381         /* EVIL! posemode code can switch translation to rotate when 1 bone is selected. will be removed (ton) */
1382         /* EVIL2: we gave as argument also texture space context bit... was cleared */
1383         /* EVIL3: extend mode for animation editors also switches modes... but is best way to avoid duplicate code */
1384         mode = t->mode;
1385
1386         calculatePropRatio(t);
1387         calculateCenter(t);
1388
1389         initMouseInput(t, &t->mouse, t->center2d, t->imval);
1390
1391         switch (mode) {
1392         case TFM_TRANSLATION:
1393                 initTranslation(t);
1394                 break;
1395         case TFM_ROTATION:
1396                 initRotation(t);
1397                 break;
1398         case TFM_RESIZE:
1399                 initResize(t);
1400                 break;
1401         case TFM_TOSPHERE:
1402                 initToSphere(t);
1403                 break;
1404         case TFM_SHEAR:
1405                 initShear(t);
1406                 break;
1407         case TFM_WARP:
1408                 initWarp(t);
1409                 break;
1410         case TFM_SHRINKFATTEN:
1411                 initShrinkFatten(t);
1412                 break;
1413         case TFM_TILT:
1414                 initTilt(t);
1415                 break;
1416         case TFM_CURVE_SHRINKFATTEN:
1417                 initCurveShrinkFatten(t);
1418                 break;
1419         case TFM_TRACKBALL:
1420                 initTrackball(t);
1421                 break;
1422         case TFM_PUSHPULL:
1423                 initPushPull(t);
1424                 break;
1425         case TFM_CREASE:
1426                 initCrease(t);
1427                 break;
1428         case TFM_BONESIZE:
1429                 {       /* used for both B-Bone width (bonesize) as for deform-dist (envelope) */
1430                         bArmature *arm= t->poseobj->data;
1431                         if(arm->drawtype==ARM_ENVELOPE)
1432                                 initBoneEnvelope(t);
1433                         else
1434                                 initBoneSize(t);
1435                 }
1436                 break;
1437         case TFM_BONE_ENVELOPE:
1438                 initBoneEnvelope(t);
1439                 break;
1440         case TFM_EDGE_SLIDE:
1441                 initEdgeSlide(t);
1442                 break;
1443         case TFM_BONE_ROLL:
1444                 initBoneRoll(t);
1445                 break;
1446         case TFM_TIME_TRANSLATE:
1447                 initTimeTranslate(t);
1448                 break;
1449         case TFM_TIME_SLIDE:
1450                 initTimeSlide(t);
1451                 break;
1452         case TFM_TIME_SCALE:
1453                 initTimeScale(t);
1454                 break;
1455         case TFM_TIME_EXTEND:
1456                 /* now that transdata has been made, do like for TFM_TIME_TRANSLATE (for most Animation
1457                  * Editors because they have only 1D transforms for time values) or TFM_TRANSLATION
1458                  * (for Graph/NLA Editors only since they uses 'standard' transforms to get 2D movement)
1459                  * depending on which editor this was called from
1460                  */
1461                 if ELEM(t->spacetype, SPACE_IPO, SPACE_NLA)
1462                         initTranslation(t);
1463                 else
1464                         initTimeTranslate(t);
1465                 break;
1466         case TFM_BAKE_TIME:
1467                 initBakeTime(t);
1468                 break;
1469         case TFM_MIRROR:
1470                 initMirror(t);
1471                 break;
1472         case TFM_BEVEL:
1473                 initBevel(t);
1474                 break;
1475         case TFM_BWEIGHT:
1476                 initBevelWeight(t);
1477                 break;
1478         case TFM_ALIGN:
1479                 initAlign(t);
1480                 break;
1481         }
1482
1483         /* overwrite initial values if operator supplied a non-null vector */
1484         if (RNA_property_is_set(op->ptr, "value"))
1485         {
1486                 float values[4];
1487                 RNA_float_get_array(op->ptr, "value", values);
1488                 QUATCOPY(t->values, values);
1489                 QUATCOPY(t->auto_values, values);
1490                 t->flag |= T_AUTOVALUES;
1491         }
1492
1493         /* Constraint init from operator */
1494         if (RNA_struct_find_property(op->ptr, "constraint_axis") && RNA_property_is_set(op->ptr, "constraint_axis"))
1495         {
1496                 int constraint_axis[3];
1497
1498                 RNA_boolean_get_array(op->ptr, "constraint_axis", constraint_axis);
1499
1500                 if (constraint_axis[0] || constraint_axis[1] || constraint_axis[2])
1501                 {
1502                         t->con.mode |= CON_APPLY;
1503
1504                         if (constraint_axis[0]) {
1505                                 t->con.mode |= CON_AXIS0;
1506                         }
1507                         if (constraint_axis[1]) {
1508                                 t->con.mode |= CON_AXIS1;
1509                         }
1510                         if (constraint_axis[2]) {
1511                                 t->con.mode |= CON_AXIS2;
1512                         }
1513
1514                         setUserConstraint(t, t->con.mode, "%s");
1515                 }
1516         }
1517
1518         return 1;
1519 }
1520
1521 void transformApply(bContext *C, TransInfo *t)
1522 {
1523         if (t->redraw)
1524         {
1525                 if (t->modifiers & MOD_CONSTRAINT_SELECT)
1526                         t->con.mode |= CON_SELECT;
1527
1528                 selectConstraint(t);
1529                 if (t->transform) {
1530                         t->transform(t, t->mval);  // calls recalcData()
1531                         viewRedrawForce(C, t);
1532                 }
1533                 t->redraw = 0;
1534         }
1535
1536         /* If auto confirm is on, break after one pass */
1537         if (t->options & CTX_AUTOCONFIRM)
1538         {
1539                 t->state = TRANS_CONFIRM;
1540         }
1541
1542         if (BKE_ptcache_get_continue_physics())
1543         {
1544                 // TRANSFORM_FIX_ME
1545                 //do_screenhandlers(G.curscreen);
1546                 t->redraw = 1;
1547         }
1548 }
1549
1550 int transformEnd(bContext *C, TransInfo *t)
1551 {
1552         int exit_code = OPERATOR_RUNNING_MODAL;
1553
1554         if (t->state != TRANS_RUNNING)
1555         {
1556                 /* handle restoring objects */
1557                 if(t->state == TRANS_CANCEL)
1558                 {
1559                         exit_code = OPERATOR_CANCELLED;
1560                         restoreTransObjects(t); // calls recalcData()
1561                 }
1562                 else
1563                 {
1564                         exit_code = OPERATOR_FINISHED;
1565                 }
1566
1567                 /* free data */
1568                 postTrans(t);
1569
1570                 /* aftertrans does insert keyframes, and clears base flags, doesnt read transdata */
1571                 special_aftertrans_update(t);
1572
1573                 /* send events out for redraws */
1574                 viewRedrawPost(t);
1575
1576                 /*  Undo as last, certainly after special_trans_update! */
1577
1578                 if(t->state == TRANS_CANCEL) {
1579 //                      if(t->undostr) ED_undo_push(C, t->undostr);
1580                 }
1581                 else {
1582 //                      if(t->undostr) ED_undo_push(C, t->undostr);
1583 //                      else ED_undo_push(C, transform_to_undostr(t));
1584                 }
1585                 t->undostr= NULL;
1586
1587                 viewRedrawForce(C, t);
1588         }
1589
1590         return exit_code;
1591 }
1592
1593 /* ************************** TRANSFORM LOCKS **************************** */
1594
1595 static void protectedTransBits(short protectflag, float *vec)
1596 {
1597         if(protectflag & OB_LOCK_LOCX)
1598                 vec[0]= 0.0f;
1599         if(protectflag & OB_LOCK_LOCY)
1600                 vec[1]= 0.0f;
1601         if(protectflag & OB_LOCK_LOCZ)
1602                 vec[2]= 0.0f;
1603 }
1604
1605 static void protectedSizeBits(short protectflag, float *size)
1606 {
1607         if(protectflag & OB_LOCK_SCALEX)
1608                 size[0]= 1.0f;
1609         if(protectflag & OB_LOCK_SCALEY)
1610                 size[1]= 1.0f;
1611         if(protectflag & OB_LOCK_SCALEZ)
1612                 size[2]= 1.0f;
1613 }
1614
1615 static void protectedRotateBits(short protectflag, float *eul, float *oldeul)
1616 {
1617         if(protectflag & OB_LOCK_ROTX)
1618                 eul[0]= oldeul[0];
1619         if(protectflag & OB_LOCK_ROTY)
1620                 eul[1]= oldeul[1];
1621         if(protectflag & OB_LOCK_ROTZ)
1622                 eul[2]= oldeul[2];
1623 }
1624
1625
1626 /* this function only does the delta rotation */
1627 /* axis-angle is usually internally stored as quats... */
1628 static void protectedAxisAngleBits(short protectflag, float *quat, float *oldquat)
1629 {
1630         /* check that protection flags are set */
1631         if ((protectflag & (OB_LOCK_ROTX|OB_LOCK_ROTY|OB_LOCK_ROTZ|OB_LOCK_ROTW)) == 0)
1632                 return;
1633
1634         if (protectflag & OB_LOCK_ROT4D) {
1635                 /* axis-angle getting limited as 4D entities that they are... */
1636                 if (protectflag & OB_LOCK_ROTW)
1637                         quat[0]= oldquat[0];
1638                 if (protectflag & OB_LOCK_ROTX)
1639                         quat[1]= oldquat[1];
1640                 if (protectflag & OB_LOCK_ROTY)
1641                         quat[2]= oldquat[2];
1642                 if (protectflag & OB_LOCK_ROTZ)
1643                         quat[3]= oldquat[3];
1644         }
1645         else {
1646                 /* axis-angle get limited with euler... */
1647                 float eul[3], oldeul[3], quat1[4];
1648
1649                 QUATCOPY(quat1, quat);
1650                 AxisAngleToEulO(quat+1, quat[0], eul, EULER_ORDER_DEFAULT);
1651                 AxisAngleToEulO(oldquat+1, oldquat[0], oldeul, EULER_ORDER_DEFAULT);
1652
1653                 if (protectflag & OB_LOCK_ROTX)
1654                         eul[0]= oldeul[0];
1655                 if (protectflag & OB_LOCK_ROTY)
1656                         eul[1]= oldeul[1];
1657                 if (protectflag & OB_LOCK_ROTZ)
1658                         eul[2]= oldeul[2];
1659
1660                 EulOToAxisAngle(eul, EULER_ORDER_DEFAULT, quat+1, quat);
1661
1662                 /* when converting to axis-angle, we need a special exception for the case when there is no axis */
1663                 if (IS_EQ(quat[1], quat[2]) && IS_EQ(quat[2], quat[3])) {
1664                         /* for now, rotate around y-axis then (so that it simply becomes the roll) */
1665                         quat[2]= 1.0f;
1666                 }
1667         }
1668 }
1669
1670 /* this function only does the delta rotation */
1671 static void protectedQuaternionBits(short protectflag, float *quat, float *oldquat)
1672 {
1673         /* check that protection flags are set */
1674         if ((protectflag & (OB_LOCK_ROTX|OB_LOCK_ROTY|OB_LOCK_ROTZ|OB_LOCK_ROTW)) == 0)
1675                 return;
1676
1677         if (protectflag & OB_LOCK_ROT4D) {
1678                 /* quaternions getting limited as 4D entities that they are... */
1679                 if (protectflag & OB_LOCK_ROTW)
1680                         quat[0]= oldquat[0];
1681                 if (protectflag & OB_LOCK_ROTX)
1682                         quat[1]= oldquat[1];
1683                 if (protectflag & OB_LOCK_ROTY)
1684                         quat[2]= oldquat[2];
1685                 if (protectflag & OB_LOCK_ROTZ)
1686                         quat[3]= oldquat[3];
1687         }
1688         else {
1689                 /* quaternions get limited with euler... (compatability mode) */
1690                 float eul[3], oldeul[3], quat1[4];
1691
1692                 QUATCOPY(quat1, quat);
1693                 QuatToEul(quat, eul);
1694                 QuatToEul(oldquat, oldeul);
1695
1696                 if (protectflag & OB_LOCK_ROTX)
1697                         eul[0]= oldeul[0];
1698                 if (protectflag & OB_LOCK_ROTY)
1699                         eul[1]= oldeul[1];
1700                 if (protectflag & OB_LOCK_ROTZ)
1701                         eul[2]= oldeul[2];
1702
1703                 EulToQuat(eul, quat);
1704
1705                 /* quaternions flip w sign to accumulate rotations correctly */
1706                 if ( (quat1[0]<0.0f && quat[0]>0.0f) || (quat1[0]>0.0f && quat[0]<0.0f) ) {
1707                         QuatMulf(quat, -1.0f);
1708                 }
1709         }
1710 }
1711
1712 /* ******************* TRANSFORM LIMITS ********************** */
1713
1714 static void constraintTransLim(TransInfo *t, TransData *td)
1715 {
1716         if (td->con) {
1717                 bConstraintTypeInfo *cti= get_constraint_typeinfo(CONSTRAINT_TYPE_LOCLIMIT);
1718                 bConstraintOb cob;
1719                 bConstraint *con;
1720
1721                 /* Make a temporary bConstraintOb for using these limit constraints
1722                  *      - they only care that cob->matrix is correctly set ;-)
1723                  *      - current space should be local
1724                  */
1725                 memset(&cob, 0, sizeof(bConstraintOb));
1726                 Mat4One(cob.matrix);
1727                 VECCOPY(cob.matrix[3], td->loc);
1728
1729                 /* Evaluate valid constraints */
1730                 for (con= td->con; con; con= con->next) {
1731                         float tmat[4][4];
1732
1733                         /* only consider constraint if enabled */
1734                         if (con->flag & CONSTRAINT_DISABLE) continue;
1735                         if (con->enforce == 0.0f) continue;
1736
1737                         /* only use it if it's tagged for this purpose (and the right type) */
1738                         if (con->type == CONSTRAINT_TYPE_LOCLIMIT) {
1739                                 bLocLimitConstraint *data= con->data;
1740
1741                                 if ((data->flag2 & LIMIT_TRANSFORM)==0)
1742                                         continue;
1743
1744                                 /* do space conversions */
1745                                 if (con->ownspace == CONSTRAINT_SPACE_WORLD) {
1746                                         /* just multiply by td->mtx (this should be ok) */
1747                                         Mat4CpyMat4(tmat, cob.matrix);
1748                                         Mat4MulMat34(cob.matrix, td->mtx, tmat);
1749                                 }
1750                                 else if (con->ownspace != CONSTRAINT_SPACE_LOCAL) {
1751                                         /* skip... incompatable spacetype */
1752                                         continue;
1753                                 }
1754
1755                                 /* do constraint */
1756                                 cti->evaluate_constraint(con, &cob, NULL);
1757
1758                                 /* convert spaces again */
1759                                 if (con->ownspace == CONSTRAINT_SPACE_WORLD) {
1760                                         /* just multiply by td->mtx (this should be ok) */
1761                                         Mat4CpyMat4(tmat, cob.matrix);
1762                                         Mat4MulMat34(cob.matrix, td->smtx, tmat);
1763                                 }
1764                         }
1765                 }
1766
1767                 /* copy results from cob->matrix */
1768                 VECCOPY(td->loc, cob.matrix[3]);
1769         }
1770 }
1771
1772 static void constraintRotLim(TransInfo *t, TransData *td)
1773 {
1774         if (td->con) {
1775                 bConstraintTypeInfo *cti= get_constraint_typeinfo(CONSTRAINT_TYPE_ROTLIMIT);
1776                 bConstraintOb cob;
1777                 bConstraint *con;
1778
1779                 /* Make a temporary bConstraintOb for using these limit constraints
1780                  *      - they only care that cob->matrix is correctly set ;-)
1781                  *      - current space should be local
1782                  */
1783                 memset(&cob, 0, sizeof(bConstraintOb));
1784                 if (td->rotOrder == ROT_MODE_QUAT) {
1785                         /* quats */
1786                         if (td->ext)
1787                                 QuatToMat4(td->ext->quat, cob.matrix);
1788                         else
1789                                 return;
1790                 }
1791                 else if (td->rotOrder == ROT_MODE_AXISANGLE) {
1792                         /* axis angle */
1793                         if (td->ext)
1794                                 AxisAngleToMat4(&td->ext->quat[1], td->ext->quat[0], cob.matrix);
1795                         else
1796                                 return;
1797                 }
1798                 else {
1799                         /* eulers */
1800                         if (td->ext)
1801                                 EulOToMat4(td->ext->rot, td->rotOrder, cob.matrix);
1802                         else
1803                                 return;
1804                 }
1805
1806                 /* Evaluate valid constraints */
1807                 for (con= td->con; con; con= con->next) {
1808                         /* only consider constraint if enabled */
1809                         if (con->flag & CONSTRAINT_DISABLE) continue;
1810                         if (con->enforce == 0.0f) continue;
1811
1812                         /* we're only interested in Limit-Rotation constraints */
1813                         if (con->type == CONSTRAINT_TYPE_ROTLIMIT) {
1814                                 bRotLimitConstraint *data= con->data;
1815                                 float tmat[4][4];
1816
1817                                 /* only use it if it's tagged for this purpose */
1818                                 if ((data->flag2 & LIMIT_TRANSFORM)==0)
1819                                         continue;
1820
1821                                 /* do space conversions */
1822                                 if (con->ownspace == CONSTRAINT_SPACE_WORLD) {
1823                                         /* just multiply by td->mtx (this should be ok) */
1824                                         Mat4CpyMat4(tmat, cob.matrix);
1825                                         Mat4MulMat34(cob.matrix, td->mtx, tmat);
1826                                 }
1827                                 else if (con->ownspace != CONSTRAINT_SPACE_LOCAL) {
1828                                         /* skip... incompatable spacetype */
1829                                         continue;
1830                                 }
1831
1832                                 /* do constraint */
1833                                 cti->evaluate_constraint(con, &cob, NULL);
1834
1835                                 /* convert spaces again */
1836                                 if (con->ownspace == CONSTRAINT_SPACE_WORLD) {
1837                                         /* just multiply by td->mtx (this should be ok) */
1838                                         Mat4CpyMat4(tmat, cob.matrix);
1839                                         Mat4MulMat34(cob.matrix, td->smtx, tmat);
1840                                 }
1841                         }
1842                 }
1843
1844                 /* copy results from cob->matrix */
1845                 if (td->rotOrder == ROT_MODE_QUAT) {
1846                         /* quats */
1847                         Mat4ToQuat(cob.matrix, td->ext->quat);
1848                 }
1849                 else if (td->rotOrder == ROT_MODE_AXISANGLE) {
1850                         /* axis angle */
1851                         Mat4ToAxisAngle(cob.matrix, &td->ext->quat[1], &td->ext->quat[0]);
1852                 }
1853                 else {
1854                         /* eulers */
1855                         Mat4ToEulO(cob.matrix, td->ext->rot, td->rotOrder);
1856                 }
1857         }
1858 }
1859
1860 static void constraintSizeLim(TransInfo *t, TransData *td)
1861 {
1862         if (td->con && td->ext) {
1863                 bConstraintTypeInfo *cti= get_constraint_typeinfo(CONSTRAINT_TYPE_SIZELIMIT);
1864                 bConstraintOb cob;
1865                 bConstraint *con;
1866
1867                 /* Make a temporary bConstraintOb for using these limit constraints
1868                  *      - they only care that cob->matrix is correctly set ;-)
1869                  *      - current space should be local
1870                  */
1871                 memset(&cob, 0, sizeof(bConstraintOb));
1872                 if ((td->flag & TD_SINGLESIZE) && !(t->con.mode & CON_APPLY)) {
1873                         /* scale val and reset size */
1874                         return; // TODO: fix this case
1875                 }
1876                 else {
1877                         /* Reset val if SINGLESIZE but using a constraint */
1878                         if (td->flag & TD_SINGLESIZE)
1879                                 return;
1880
1881                         SizeToMat4(td->ext->size, cob.matrix);
1882                 }
1883
1884                 /* Evaluate valid constraints */
1885                 for (con= td->con; con; con= con->next) {
1886                         /* only consider constraint if enabled */
1887                         if (con->flag & CONSTRAINT_DISABLE) continue;
1888                         if (con->enforce == 0.0f) continue;
1889
1890                         /* we're only interested in Limit-Scale constraints */
1891                         if (con->type == CONSTRAINT_TYPE_SIZELIMIT) {
1892                                 bSizeLimitConstraint *data= con->data;
1893                                 float tmat[4][4];
1894
1895                                 /* only use it if it's tagged for this purpose */
1896                                 if ((data->flag2 & LIMIT_TRANSFORM)==0)
1897                                         continue;
1898
1899                                 /* do space conversions */
1900                                 if (con->ownspace == CONSTRAINT_SPACE_WORLD) {
1901                                         /* just multiply by td->mtx (this should be ok) */
1902                                         Mat4CpyMat4(tmat, cob.matrix);
1903                                         Mat4MulMat34(cob.matrix, td->mtx, tmat);
1904                                 }
1905                                 else if (con->ownspace != CONSTRAINT_SPACE_LOCAL) {
1906                                         /* skip... incompatable spacetype */
1907                                         continue;
1908                                 }
1909
1910                                 /* do constraint */
1911                                 cti->evaluate_constraint(con, &cob, NULL);
1912
1913                                 /* convert spaces again */
1914                                 if (con->ownspace == CONSTRAINT_SPACE_WORLD) {
1915                                         /* just multiply by td->mtx (this should be ok) */
1916                                         Mat4CpyMat4(tmat, cob.matrix);
1917                                         Mat4MulMat34(cob.matrix, td->smtx, tmat);
1918                                 }
1919                         }
1920                 }
1921
1922                 /* copy results from cob->matrix */
1923                 if ((td->flag & TD_SINGLESIZE) && !(t->con.mode & CON_APPLY)) {
1924                         /* scale val and reset size */
1925                         return; // TODO: fix this case
1926                 }
1927                 else {
1928                         /* Reset val if SINGLESIZE but using a constraint */
1929                         if (td->flag & TD_SINGLESIZE)
1930                                 return;
1931
1932                         Mat4ToSize(cob.matrix, td->ext->size);
1933                 }
1934         }
1935 }
1936
1937 /* ************************** WARP *************************** */
1938
1939 void initWarp(TransInfo *t)
1940 {
1941         float max[3], min[3];
1942         int i;
1943
1944         t->mode = TFM_WARP;
1945         t->transform = Warp;
1946         t->handleEvent = handleEventWarp;
1947
1948         initMouseInputMode(t, &t->mouse, INPUT_HORIZONTAL_RATIO);
1949
1950         t->idx_max = 0;
1951         t->num.idx_max = 0;
1952         t->snap[0] = 0.0f;
1953         t->snap[1] = 5.0f;
1954         t->snap[2] = 1.0f;
1955
1956         t->flag |= T_NO_CONSTRAINT;
1957
1958         /* we need min/max in view space */
1959         for(i = 0; i < t->total; i++) {
1960                 float center[3];
1961                 VECCOPY(center, t->data[i].center);
1962                 Mat3MulVecfl(t->data[i].mtx, center);
1963                 Mat4MulVecfl(t->viewmat, center);
1964                 VecSubf(center, center, t->viewmat[3]);
1965                 if (i)
1966                         MinMax3(min, max, center);
1967                 else {
1968                         VECCOPY(max, center);
1969                         VECCOPY(min, center);
1970                 }
1971         }
1972
1973         t->center[0]= (min[0]+max[0])/2.0f;
1974         t->center[1]= (min[1]+max[1])/2.0f;
1975         t->center[2]= (min[2]+max[2])/2.0f;
1976
1977         if (max[0] == min[0]) max[0] += 0.1; /* not optimal, but flipping is better than invalid garbage (i.e. division by zero!) */
1978         t->val= (max[0]-min[0])/2.0f; /* t->val is X dimension projected boundbox */
1979 }
1980
1981 int handleEventWarp(TransInfo *t, wmEvent *event)
1982 {
1983         int status = 0;
1984
1985         if (event->type == MIDDLEMOUSE && event->val==KM_PRESS)
1986         {
1987                 // Use customData pointer to signal warp direction
1988                 if      (t->customData == 0)
1989                         t->customData = (void*)1;
1990                 else
1991                         t->customData = 0;
1992
1993                 status = 1;
1994         }
1995
1996         return status;
1997 }
1998
1999 int Warp(TransInfo *t, short mval[2])
2000 {
2001         TransData *td = t->data;
2002         float vec[3], circumfac, dist, phi0, co, si, *curs, cursor[3], gcursor[3];
2003         int i;
2004         char str[50];
2005
2006         curs= give_cursor(t->scene, t->view);
2007         /*
2008          * gcursor is the one used for helpline.
2009          * It has to be in the same space as the drawing loop
2010          * (that means it needs to be in the object's space when in edit mode and
2011          *  in global space in object mode)
2012          *
2013          * cursor is used for calculations.
2014          * It needs to be in view space, but we need to take object's offset
2015          * into account if in Edit mode.
2016          */
2017         VECCOPY(cursor, curs);
2018         VECCOPY(gcursor, cursor);
2019         if (t->flag & T_EDIT) {
2020                 VecSubf(cursor, cursor, t->obedit->obmat[3]);
2021                 VecSubf(gcursor, gcursor, t->obedit->obmat[3]);
2022                 Mat3MulVecfl(t->data->smtx, gcursor);
2023         }
2024         Mat4MulVecfl(t->viewmat, cursor);
2025         VecSubf(cursor, cursor, t->viewmat[3]);
2026
2027         /* amount of degrees for warp */
2028         circumfac = 360.0f * t->values[0];
2029
2030         if (t->customData) /* non-null value indicates reversed input */
2031         {
2032                 circumfac *= -1;
2033         }
2034
2035         snapGrid(t, &circumfac);
2036         applyNumInput(&t->num, &circumfac);
2037
2038         /* header print for NumInput */
2039         if (hasNumInput(&t->num)) {
2040                 char c[20];
2041
2042                 outputNumInput(&(t->num), c);
2043
2044                 sprintf(str, "Warp: %s", c);
2045         }
2046         else {
2047                 /* default header print */
2048                 sprintf(str, "Warp: %.3f", circumfac);
2049         }
2050
2051         circumfac*= (float)(-M_PI/360.0);
2052
2053         for(i = 0; i < t->total; i++, td++) {
2054                 float loc[3];
2055                 if (td->flag & TD_NOACTION)
2056                         break;
2057
2058                 if (td->flag & TD_SKIP)
2059                         continue;
2060
2061                 /* translate point to center, rotate in such a way that outline==distance */
2062                 VECCOPY(vec, td->iloc);
2063                 Mat3MulVecfl(td->mtx, vec);
2064                 Mat4MulVecfl(t->viewmat, vec);
2065                 VecSubf(vec, vec, t->viewmat[3]);
2066
2067                 dist= vec[0]-cursor[0];
2068
2069                 /* t->val is X dimension projected boundbox */
2070                 phi0= (circumfac*dist/t->val);
2071
2072                 vec[1]= (vec[1]-cursor[1]);
2073
2074                 co= (float)cos(phi0);
2075                 si= (float)sin(phi0);
2076                 loc[0]= -si*vec[1]+cursor[0];
2077                 loc[1]= co*vec[1]+cursor[1];
2078                 loc[2]= vec[2];
2079
2080                 Mat4MulVecfl(t->viewinv, loc);
2081                 VecSubf(loc, loc, t->viewinv[3]);
2082                 Mat3MulVecfl(td->smtx, loc);
2083
2084                 VecSubf(loc, loc, td->iloc);
2085                 VecMulf(loc, td->factor);
2086                 VecAddf(td->loc, td->iloc, loc);
2087         }
2088
2089         recalcData(t);
2090
2091         ED_area_headerprint(t->sa, str);
2092
2093         return 1;
2094 }
2095
2096 /* ************************** SHEAR *************************** */
2097
2098 void initShear(TransInfo *t)
2099 {
2100         t->mode = TFM_SHEAR;
2101         t->transform = Shear;
2102         t->handleEvent = handleEventShear;
2103
2104         initMouseInputMode(t, &t->mouse, INPUT_HORIZONTAL_ABSOLUTE);
2105
2106         t->idx_max = 0;
2107         t->num.idx_max = 0;
2108         t->snap[0] = 0.0f;
2109         t->snap[1] = 0.1f;
2110         t->snap[2] = t->snap[1] * 0.1f;
2111
2112         t->flag |= T_NO_CONSTRAINT;
2113 }
2114
2115 int handleEventShear(TransInfo *t, wmEvent *event)
2116 {
2117         int status = 0;
2118
2119         if (event->type == MIDDLEMOUSE && event->val==KM_PRESS)
2120         {
2121                 // Use customData pointer to signal Shear direction
2122                 if      (t->customData == 0)
2123                 {
2124                         initMouseInputMode(t, &t->mouse, INPUT_VERTICAL_ABSOLUTE);
2125                         t->customData = (void*)1;
2126                 }
2127                 else
2128                 {
2129                         initMouseInputMode(t, &t->mouse, INPUT_HORIZONTAL_ABSOLUTE);
2130                         t->customData = 0;
2131                 }
2132
2133                 status = 1;
2134         }
2135
2136         return status;
2137 }
2138
2139
2140 int Shear(TransInfo *t, short mval[2])
2141 {
2142         TransData *td = t->data;
2143         float vec[3];
2144         float smat[3][3], tmat[3][3], totmat[3][3], persmat[3][3], persinv[3][3];
2145         float value;
2146         int i;
2147         char str[50];
2148
2149         Mat3CpyMat4(persmat, t->viewmat);
2150         Mat3Inv(persinv, persmat);
2151
2152         value = 0.05f * t->values[0];
2153
2154         snapGrid(t, &value);
2155
2156         applyNumInput(&t->num, &value);
2157
2158         /* header print for NumInput */
2159         if (hasNumInput(&t->num)) {
2160                 char c[20];
2161
2162                 outputNumInput(&(t->num), c);
2163
2164                 sprintf(str, "Shear: %s %s", c, t->proptext);
2165         }
2166         else {
2167                 /* default header print */
2168                 sprintf(str, "Shear: %.3f %s", value, t->proptext);
2169         }
2170
2171         Mat3One(smat);
2172
2173         // Custom data signals shear direction
2174         if (t->customData == 0)
2175                 smat[1][0] = value;
2176         else
2177                 smat[0][1] = value;
2178
2179         Mat3MulMat3(tmat, smat, persmat);
2180         Mat3MulMat3(totmat, persinv, tmat);
2181
2182         for(i = 0 ; i < t->total; i++, td++) {
2183                 if (td->flag & TD_NOACTION)
2184                         break;
2185
2186                 if (td->flag & TD_SKIP)
2187                         continue;
2188
2189                 if (t->obedit) {
2190                         float mat3[3][3];
2191                         Mat3MulMat3(mat3, totmat, td->mtx);
2192                         Mat3MulMat3(tmat, td->smtx, mat3);
2193                 }
2194                 else {
2195                         Mat3CpyMat3(tmat, totmat);
2196                 }
2197                 VecSubf(vec, td->center, t->center);
2198
2199                 Mat3MulVecfl(tmat, vec);
2200
2201                 VecAddf(vec, vec, t->center);
2202                 VecSubf(vec, vec, td->center);
2203
2204                 VecMulf(vec, td->factor);
2205
2206                 VecAddf(td->loc, td->iloc, vec);
2207         }
2208
2209         recalcData(t);
2210
2211         ED_area_headerprint(t->sa, str);
2212
2213         return 1;
2214 }
2215
2216 /* ************************** RESIZE *************************** */
2217
2218 void initResize(TransInfo *t)
2219 {
2220         t->mode = TFM_RESIZE;
2221         t->transform = Resize;
2222
2223         initMouseInputMode(t, &t->mouse, INPUT_SPRING_FLIP);
2224
2225         t->flag |= T_NULL_ONE;
2226         t->num.flag |= NUM_NULL_ONE;
2227         t->num.flag |= NUM_AFFECT_ALL;
2228         if (!t->obedit) {
2229                 t->flag |= T_NO_ZERO;
2230                 t->num.flag |= NUM_NO_ZERO;
2231         }
2232
2233         t->idx_max = 2;
2234         t->num.idx_max = 2;
2235         t->snap[0] = 0.0f;
2236         t->snap[1] = 0.1f;
2237         t->snap[2] = t->snap[1] * 0.1f;
2238 }
2239
2240 static void headerResize(TransInfo *t, float vec[3], char *str) {
2241         char tvec[60];
2242         if (hasNumInput(&t->num)) {
2243                 outputNumInput(&(t->num), tvec);
2244         }
2245         else {
2246                 sprintf(&tvec[0], "%.4f", vec[0]);
2247                 sprintf(&tvec[20], "%.4f", vec[1]);
2248                 sprintf(&tvec[40], "%.4f", vec[2]);
2249         }
2250
2251         if (t->con.mode & CON_APPLY) {
2252                 switch(t->num.idx_max) {
2253                 case 0:
2254                         sprintf(str, "Scale: %s%s %s", &tvec[0], t->con.text, t->proptext);
2255                         break;
2256                 case 1:
2257                         sprintf(str, "Scale: %s : %s%s %s", &tvec[0], &tvec[20], t->con.text, t->proptext);
2258                         break;
2259                 case 2:
2260                         sprintf(str, "Scale: %s : %s : %s%s %s", &tvec[0], &tvec[20], &tvec[40], t->con.text, t->proptext);
2261                 }
2262         }
2263         else {
2264                 if (t->flag & T_2D_EDIT)
2265                         sprintf(str, "Scale X: %s   Y: %s%s %s", &tvec[0], &tvec[20], t->con.text, t->proptext);
2266                 else
2267                         sprintf(str, "Scale X: %s   Y: %s  Z: %s%s %s", &tvec[0], &tvec[20], &tvec[40], t->con.text, t->proptext);
2268         }
2269 }
2270
2271 #define SIGN(a)         (a<-FLT_EPSILON?1:a>FLT_EPSILON?2:3)
2272 #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)
2273
2274 /* smat is reference matrix, only scaled */
2275 static void TransMat3ToSize( float mat[][3], float smat[][3], float *size)
2276 {
2277         float vec[3];
2278
2279         VecCopyf(vec, mat[0]);
2280         size[0]= Normalize(vec);
2281         VecCopyf(vec, mat[1]);
2282         size[1]= Normalize(vec);
2283         VecCopyf(vec, mat[2]);
2284         size[2]= Normalize(vec);
2285
2286         /* first tried with dotproduct... but the sign flip is crucial */
2287         if( VECSIGNFLIP(mat[0], smat[0]) ) size[0]= -size[0];
2288         if( VECSIGNFLIP(mat[1], smat[1]) ) size[1]= -size[1];
2289         if( VECSIGNFLIP(mat[2], smat[2]) ) size[2]= -size[2];
2290 }
2291
2292
2293 static void ElementResize(TransInfo *t, TransData *td, float mat[3][3]) {
2294         float tmat[3][3], smat[3][3], center[3];
2295         float vec[3];
2296
2297         if (t->flag & T_EDIT) {
2298                 Mat3MulMat3(smat, mat, td->mtx);
2299                 Mat3MulMat3(tmat, td->smtx, smat);
2300         }
2301         else {
2302                 Mat3CpyMat3(tmat, mat);
2303         }
2304
2305         if (t->con.applySize) {
2306                 t->con.applySize(t, td, tmat);
2307         }
2308
2309         /* local constraint shouldn't alter center */
2310         if (t->around == V3D_LOCAL) {
2311                 if (t->flag & T_OBJECT) {
2312                         VECCOPY(center, td->center);
2313                 }
2314                 else if (t->flag & T_EDIT) {
2315
2316                         if(t->around==V3D_LOCAL && (t->settings->selectmode & SCE_SELECT_FACE)) {
2317                                 VECCOPY(center, td->center);
2318                         }
2319                         else {
2320                                 VECCOPY(center, t->center);
2321                         }
2322                 }
2323                 else {
2324                         VECCOPY(center, t->center);
2325                 }
2326         }
2327         else {
2328                 VECCOPY(center, t->center);
2329         }
2330
2331         if (td->ext) {
2332                 float fsize[3];
2333
2334                 if (t->flag & (T_OBJECT|T_TEXTURE|T_POSE)) {
2335                         float obsizemat[3][3];
2336                         // Reorient the size mat to fit the oriented object.
2337                         Mat3MulMat3(obsizemat, td->axismtx, tmat);
2338                         //printmatrix3("obsizemat", obsizemat);
2339                         TransMat3ToSize(obsizemat, td->axismtx, fsize);
2340                         //printvecf("fsize", fsize);
2341                 }
2342                 else {
2343                         Mat3ToSize(tmat, fsize);
2344                 }
2345
2346                 protectedSizeBits(td->protectflag, fsize);
2347
2348                 if ((t->flag & T_V3D_ALIGN)==0) {       // align mode doesn't resize objects itself
2349                         if((td->flag & TD_SINGLESIZE) && !(t->con.mode & CON_APPLY)){
2350                                 /* scale val and reset size */
2351                                 *td->val = td->ival * fsize[0] * td->factor;
2352
2353                                 td->ext->size[0] = td->ext->isize[0];
2354                                 td->ext->size[1] = td->ext->isize[1];
2355                                 td->ext->size[2] = td->ext->isize[2];
2356                         }
2357                         else {
2358                                 /* Reset val if SINGLESIZE but using a constraint */
2359                                 if (td->flag & TD_SINGLESIZE)
2360                                         *td->val = td->ival;
2361
2362                                 td->ext->size[0] = td->ext->isize[0] * (fsize[0]) * td->factor;
2363                                 td->ext->size[1] = td->ext->isize[1] * (fsize[1]) * td->factor;
2364                                 td->ext->size[2] = td->ext->isize[2] * (fsize[2]) * td->factor;
2365                         }
2366                 }
2367
2368                 constraintSizeLim(t, td);
2369         }
2370
2371         /* For individual element center, Editmode need to use iloc */
2372         if (t->flag & T_POINTS)
2373                 VecSubf(vec, td->iloc, center);
2374         else
2375                 VecSubf(vec, td->center, center);
2376
2377         Mat3MulVecfl(tmat, vec);
2378
2379         VecAddf(vec, vec, center);
2380         if (t->flag & T_POINTS)
2381                 VecSubf(vec, vec, td->iloc);
2382         else
2383                 VecSubf(vec, vec, td->center);
2384
2385         VecMulf(vec, td->factor);
2386
2387         if (t->flag & (T_OBJECT|T_POSE)) {
2388                 Mat3MulVecfl(td->smtx, vec);
2389         }
2390
2391         protectedTransBits(td->protectflag, vec);
2392         VecAddf(td->loc, td->iloc, vec);
2393
2394         constraintTransLim(t, td);
2395 }
2396
2397 int Resize(TransInfo *t, short mval[2])
2398 {
2399         TransData *td;
2400         float size[3], mat[3][3];
2401         float ratio;
2402         int i;
2403         char str[200];
2404
2405         /* for manipulator, center handle, the scaling can't be done relative to center */
2406         if( (t->flag & T_USES_MANIPULATOR) && t->con.mode==0)
2407         {
2408                 ratio = 1.0f - ((t->imval[0] - mval[0]) + (t->imval[1] - mval[1]))/100.0f;
2409         }
2410         else
2411         {
2412                 ratio = t->values[0];
2413         }
2414
2415         size[0] = size[1] = size[2] = ratio;
2416
2417         snapGrid(t, size);
2418
2419         if (hasNumInput(&t->num)) {
2420                 applyNumInput(&t->num, size);
2421                 constraintNumInput(t, size);
2422         }
2423
2424         applySnapping(t, size);
2425
2426         if (t->flag & T_AUTOVALUES)
2427         {
2428                 VECCOPY(size, t->auto_values);
2429         }
2430
2431         VECCOPY(t->values, size);
2432
2433         SizeToMat3(size, mat);
2434
2435         if (t->con.applySize) {
2436                 t->con.applySize(t, NULL, mat);
2437         }
2438
2439         Mat3CpyMat3(t->mat, mat);       // used in manipulator
2440
2441         headerResize(t, size, str);
2442
2443         for(i = 0, td=t->data; i < t->total; i++, td++) {
2444                 if (td->flag & TD_NOACTION)
2445                         break;
2446
2447                 if (td->flag & TD_SKIP)
2448                         continue;
2449
2450                 ElementResize(t, td, mat);
2451         }
2452
2453         /* evil hack - redo resize if cliping needed */
2454         if (t->flag & T_CLIP_UV && clipUVTransform(t, size, 1)) {
2455                 SizeToMat3(size, mat);
2456
2457                 if (t->con.applySize)
2458                         t->con.applySize(t, NULL, mat);
2459
2460                 for(i = 0, td=t->data; i < t->total; i++, td++)
2461                         ElementResize(t, td, mat);
2462         }
2463
2464         recalcData(t);
2465
2466         ED_area_headerprint(t->sa, str);
2467
2468         return 1;
2469 }
2470
2471 /* ************************** TOSPHERE *************************** */
2472
2473 void initToSphere(TransInfo *t)
2474 {
2475         TransData *td = t->data;
2476         int i;
2477
2478         t->mode = TFM_TOSPHERE;
2479         t->transform = ToSphere;
2480
2481         initMouseInputMode(t, &t->mouse, INPUT_HORIZONTAL_RATIO);
2482
2483         t->idx_max = 0;
2484         t->num.idx_max = 0;
2485         t->snap[0] = 0.0f;
2486         t->snap[1] = 0.1f;
2487         t->snap[2] = t->snap[1] * 0.1f;
2488
2489         t->num.flag |= NUM_NULL_ONE | NUM_NO_NEGATIVE;
2490         t->flag |= T_NO_CONSTRAINT;
2491
2492         // Calculate average radius
2493         for(i = 0 ; i < t->total; i++, td++) {
2494                 t->val += VecLenf(t->center, td->iloc);
2495         }
2496
2497         t->val /= (float)t->total;
2498 }
2499
2500 int ToSphere(TransInfo *t, short mval[2])
2501 {
2502         float vec[3];
2503         float ratio, radius;
2504         int i;
2505         char str[64];
2506         TransData *td = t->data;
2507
2508         ratio = t->values[0];
2509
2510         snapGrid(t, &ratio);
2511
2512         applyNumInput(&t->num, &ratio);
2513
2514         if (ratio < 0)
2515                 ratio = 0.0f;
2516         else if (ratio > 1)
2517                 ratio = 1.0f;
2518
2519         /* header print for NumInput */
2520         if (hasNumInput(&t->num)) {
2521                 char c[20];
2522
2523                 outputNumInput(&(t->num), c);
2524
2525                 sprintf(str, "To Sphere: %s %s", c, t->proptext);
2526         }
2527         else {
2528                 /* default header print */
2529                 sprintf(str, "To Sphere: %.4f %s", ratio, t->proptext);
2530         }
2531
2532
2533         for(i = 0 ; i < t->total; i++, td++) {
2534                 float tratio;
2535                 if (td->flag & TD_NOACTION)
2536                         break;
2537
2538                 if (td->flag & TD_SKIP)
2539                         continue;
2540
2541                 VecSubf(vec, td->iloc, t->center);
2542
2543                 radius = Normalize(vec);
2544
2545                 tratio = ratio * td->factor;
2546
2547                 VecMulf(vec, radius * (1.0f - tratio) + t->val * tratio);
2548
2549                 VecAddf(td->loc, t->center, vec);
2550         }
2551
2552
2553         recalcData(t);
2554
2555         ED_area_headerprint(t->sa, str);
2556
2557         return 1;
2558 }
2559
2560 /* ************************** ROTATION *************************** */
2561
2562
2563 void initRotation(TransInfo *t)
2564 {
2565         t->mode = TFM_ROTATION;
2566         t->transform = Rotation;
2567
2568         initMouseInputMode(t, &t->mouse, INPUT_ANGLE);
2569
2570         t->ndof.axis = 16;
2571         /* Scale down and flip input for rotation */
2572         t->ndof.factor[0] = -0.2f;
2573
2574         t->idx_max = 0;
2575         t->num.idx_max = 0;
2576         t->snap[0] = 0.0f;
2577         t->snap[1] = (float)((5.0/180)*M_PI);
2578         t->snap[2] = t->snap[1] * 0.2f;
2579
2580         if (t->flag & T_2D_EDIT)
2581                 t->flag |= T_NO_CONSTRAINT;
2582 }
2583
2584 static void ElementRotation(TransInfo *t, TransData *td, float mat[3][3], short around) {
2585         float vec[3], totmat[3][3], smat[3][3];
2586         float eul[3], fmat[3][3], quat[4];
2587         float *center = t->center;
2588
2589         /* local constraint shouldn't alter center */
2590         if (around == V3D_LOCAL) {
2591                 if (t->flag & (T_OBJECT|T_POSE)) {
2592                         center = td->center;
2593                 }
2594                 else {
2595                         /* !TODO! Make this if not rely on G */
2596                         if(around==V3D_LOCAL && (t->settings->selectmode & SCE_SELECT_FACE)) {
2597                                 center = td->center;
2598                         }
2599                 }
2600         }
2601
2602         if (t->flag & T_POINTS) {
2603                 Mat3MulMat3(totmat, mat, td->mtx);
2604                 Mat3MulMat3(smat, td->smtx, totmat);
2605
2606                 VecSubf(vec, td->iloc, center);
2607                 Mat3MulVecfl(smat, vec);
2608
2609                 VecAddf(td->loc, vec, center);
2610
2611                 VecSubf(vec,td->loc,td->iloc);
2612                 protectedTransBits(td->protectflag, vec);
2613                 VecAddf(td->loc, td->iloc, vec);
2614
2615
2616                 if(td->flag & TD_USEQUAT) {
2617                         Mat3MulSerie(fmat, td->mtx, mat, td->smtx, 0, 0, 0, 0, 0);
2618                         Mat3ToQuat(fmat, quat); // Actual transform
2619
2620                         if(td->ext->quat){
2621                                 QuatMul(td->ext->quat, quat, td->ext->iquat);
2622
2623                                 /* is there a reason not to have this here? -jahka */
2624                                 protectedQuaternionBits(td->protectflag, td->ext->quat, td->ext->iquat);
2625                         }
2626                 }
2627         }
2628         /**
2629          * HACK WARNING
2630          *
2631          * This is some VERY ugly special case to deal with pose mode.
2632          *
2633          * The problem is that mtx and smtx include each bone orientation.
2634          *
2635          * That is needed to rotate each bone properly, HOWEVER, to calculate
2636          * the translation component, we only need the actual armature object's
2637          * matrix (and inverse). That is not all though. Once the proper translation
2638          * has been computed, it has to be converted back into the bone's space.
2639          */
2640         else if (t->flag & T_POSE) {
2641                 float pmtx[3][3], imtx[3][3];
2642
2643                 // Extract and invert armature object matrix
2644                 Mat3CpyMat4(pmtx, t->poseobj->obmat);
2645                 Mat3Inv(imtx, pmtx);
2646
2647                 if ((td->flag & TD_NO_LOC) == 0)
2648                 {
2649                         VecSubf(vec, td->center, center);
2650
2651                         Mat3MulVecfl(pmtx, vec);        // To Global space
2652                         Mat3MulVecfl(mat, vec);         // Applying rotation
2653                         Mat3MulVecfl(imtx, vec);        // To Local space
2654
2655                         VecAddf(vec, vec, center);
2656                         /* vec now is the location where the object has to be */
2657
2658                         VecSubf(vec, vec, td->center); // Translation needed from the initial location
2659
2660                         Mat3MulVecfl(pmtx, vec);        // To Global space
2661                         Mat3MulVecfl(td->smtx, vec);// To Pose space
2662
2663                         protectedTransBits(td->protectflag, vec);
2664
2665                         VecAddf(td->loc, td->iloc, vec);
2666
2667                         constraintTransLim(t, td);
2668                 }
2669
2670                 /* rotation */
2671                 if ((t->flag & T_V3D_ALIGN)==0) { // align mode doesn't rotate objects itself
2672                         /* euler or quaternion/axis-angle? */
2673                         if (td->rotOrder == ROT_MODE_QUAT) {
2674                                 Mat3MulSerie(fmat, td->mtx, mat, td->smtx, 0, 0, 0, 0, 0);
2675
2676                                 Mat3ToQuat(fmat, quat); // Actual transform
2677
2678                                 QuatMul(td->ext->quat, quat, td->ext->iquat);
2679                                 /* this function works on end result */
2680                                 protectedQuaternionBits(td->protectflag, td->ext->quat, td->ext->iquat);
2681
2682                         }
2683                         else if (td->rotOrder == ROT_MODE_AXISANGLE) {
2684                                 /* calculate effect based on quats */
2685                                 float iquat[4];
2686
2687                                 /* td->ext->(i)quat is in axis-angle form, not quats! */
2688                                 AxisAngleToQuat(iquat, &td->ext->iquat[1], td->ext->iquat[0]);
2689
2690                                 Mat3MulSerie(fmat, td->mtx, mat, td->smtx, 0, 0, 0, 0, 0);
2691                                 Mat3ToQuat(fmat, quat); // Actual transform
2692
2693                                 QuatMul(td->ext->quat, quat, iquat);
2694
2695                                 /* make temp copy (since stored in same place) */
2696                                 QUATCOPY(quat, td->ext->quat); // this is just a 4d vector copying macro
2697                                 QuatToAxisAngle(quat, &td->ext->quat[1], &td->ext->quat[0]);
2698
2699                                 /* this function works on end result */
2700                                 protectedAxisAngleBits(td->protectflag, td->ext->quat, td->ext->iquat);
2701                         }
2702                         else {
2703                                 float eulmat[3][3];
2704
2705                                 Mat3MulMat3(totmat, mat, td->mtx);
2706                                 Mat3MulMat3(smat, td->smtx, totmat);
2707
2708                                 /* calculate the total rotatation in eulers */
2709                                 VECCOPY(eul, td->ext->irot);
2710                                 EulOToMat3(eul, td->rotOrder, eulmat);
2711
2712                                 /* mat = transform, obmat = bone rotation */
2713                                 Mat3MulMat3(fmat, smat, eulmat);
2714
2715                                 Mat3ToCompatibleEulO(fmat, eul, td->ext->rot, td->rotOrder);
2716
2717                                 /* and apply (to end result only) */
2718                                 protectedRotateBits(td->protectflag, eul, td->ext->irot);
2719                                 VECCOPY(td->ext->rot, eul);
2720                         }
2721
2722                         constraintRotLim(t, td);
2723                 }
2724         }
2725         else {
2726                 if ((td->flag & TD_NO_LOC) == 0)
2727                 {
2728                         /* translation */
2729                         VecSubf(vec, td->center, center);
2730                         Mat3MulVecfl(mat, vec);
2731                         VecAddf(vec, vec, center);
2732                         /* vec now is the location where the object has to be */
2733                         VecSubf(vec, vec, td->center);
2734                         Mat3MulVecfl(td->smtx, vec);
2735
2736                         protectedTransBits(td->protectflag, vec);
2737
2738                         VecAddf(td->loc, td->iloc, vec);
2739                 }
2740
2741
2742                 constraintTransLim(t, td);
2743
2744                 /* rotation */
2745                 if ((t->flag & T_V3D_ALIGN)==0) { // align mode doesn't rotate objects itself
2746                         /* euler or quaternion? */
2747                     if ((td->rotOrder == ROT_MODE_QUAT) || (td->flag & TD_USEQUAT)) {
2748                                 Mat3MulSerie(fmat, td->mtx, mat, td->smtx, 0, 0, 0, 0, 0);
2749                                 Mat3ToQuat(fmat, quat); // Actual transform
2750
2751                                 QuatMul(td->ext->quat, quat, td->ext->iquat);
2752                                 /* this function works on end result */
2753                                 protectedQuaternionBits(td->protectflag, td->ext->quat, td->ext->iquat);
2754                         }
2755                         else if (td->rotOrder == ROT_MODE_AXISANGLE) {
2756                                 /* calculate effect based on quats */
2757                                 float iquat[4];
2758
2759                                 /* td->ext->(i)quat is in axis-angle form, not quats! */
2760                                 AxisAngleToQuat(iquat, &td->ext->iquat[1], td->ext->iquat[0]);
2761
2762                                 Mat3MulSerie(fmat, td->mtx, mat, td->smtx, 0, 0, 0, 0, 0);
2763                                 Mat3ToQuat(fmat, quat); // Actual transform
2764
2765                                 QuatMul(td->ext->quat, quat, iquat);
2766
2767                                 /* make temp copy (since stored in same place) */
2768                                 QUATCOPY(quat, td->ext->quat); // this is just a 4d vector copying macro
2769                                 QuatToAxisAngle(quat, &td->ext->quat[1], &td->ext->quat[0]);
2770
2771                                 /* this function works on end result */
2772                                 protectedAxisAngleBits(td->protectflag, td->ext->quat, td->ext->iquat);
2773                         }
2774                         else {
2775                                 float obmat[3][3];
2776
2777                                 Mat3MulMat3(totmat, mat, td->mtx);
2778                                 Mat3MulMat3(smat, td->smtx, totmat);
2779
2780                                 /* calculate the total rotatation in eulers */
2781                                 VecAddf(eul, td->ext->irot, td->ext->drot); /* we have to correct for delta rot */
2782                                 EulOToMat3(eul, td->rotOrder, obmat);
2783                                 /* mat = transform, obmat = object rotation */
2784                                 Mat3MulMat3(fmat, smat, obmat);
2785
2786                                 Mat3ToCompatibleEulO(fmat, eul, td->ext->rot, td->rotOrder);
2787
2788                                 /* correct back for delta rot */
2789                                 VecSubf(eul, eul, td->ext->drot);
2790
2791                                 /* and apply */
2792                                 protectedRotateBits(td->protectflag, eul, td->ext->irot);
2793                                 VECCOPY(td->ext->rot, eul);
2794                         }
2795
2796                         constraintRotLim(t, td);
2797                 }
2798         }
2799 }
2800
2801 static void applyRotation(TransInfo *t, float angle, float axis[3])
2802 {
2803         TransData *td = t->data;
2804         float mat[3][3];
2805         int i;
2806
2807         VecRotToMat3(axis, angle, mat);
2808
2809         for(i = 0 ; i < t->total; i++, td++) {
2810
2811                 if (td->flag & TD_NOACTION)
2812                         break;
2813
2814                 if (td->flag & TD_SKIP)
2815                         continue;
2816
2817                 if (t->con.applyRot) {
2818                         t->con.applyRot(t, td, axis, NULL);
2819                         VecRotToMat3(axis, angle * td->factor, mat);
2820                 }
2821                 else if (t->flag & T_PROP_EDIT) {
2822                         VecRotToMat3(axis, angle * td->factor, mat);
2823                 }
2824
2825                 ElementRotation(t, td, mat, t->around);
2826         }
2827 }
2828
2829 int Rotation(TransInfo *t, short mval[2])
2830 {
2831         char str[64];
2832
2833         float final;
2834
2835         float axis[3];
2836         float mat[3][3];
2837
2838         VECCOPY(axis, t->viewinv[2]);
2839         VecMulf(axis, -1.0f);
2840         Normalize(axis);
2841
2842         final = t->values[0];
2843
2844         applyNDofInput(&t->ndof, &final);
2845
2846         snapGrid(t, &final);
2847
2848         if (t->con.applyRot) {
2849                 t->con.applyRot(t, NULL, axis, &final);
2850         }
2851
2852         applySnapping(t, &final);
2853
2854         if (hasNumInput(&t->num)) {
2855                 char c[20];
2856
2857                 applyNumInput(&t->num, &final);
2858
2859                 outputNumInput(&(t->num), c);
2860
2861                 sprintf(str, "Rot: %s %s %s", &c[0], t->con.text, t->proptext);
2862
2863                 /* Clamp between -180 and 180 */
2864                 while (final >= 180.0)
2865                         final -= 360.0;
2866
2867                 while (final <= -180.0)
2868                         final += 360.0;
2869
2870                 final *= (float)(M_PI / 180.0);
2871         }
2872         else {
2873                 sprintf(str, "Rot: %.2f%s %s", 180.0*final/M_PI, t->con.text, t->proptext);
2874         }
2875
2876         VecRotToMat3(axis, final, mat);
2877
2878         // TRANSFORM_FIX_ME
2879 //      t->values[0] = final;           // used in manipulator
2880 //      Mat3CpyMat3(t->mat, mat);       // used in manipulator
2881
2882         applyRotation(t, final, axis);
2883
2884         recalcData(t);
2885
2886         ED_area_headerprint(t->sa, str);
2887
2888         return 1;
2889 }
2890
2891
2892 /* ************************** TRACKBALL *************************** */
2893
2894 void initTrackball(TransInfo *t)
2895 {
2896         t->mode = TFM_TRACKBALL;
2897         t->transform = Trackball;
2898
2899         initMouseInputMode(t, &t->mouse, INPUT_TRACKBALL);
2900
2901         t->ndof.axis = 40;
2902         /* Scale down input for rotation */
2903         t->ndof.factor[0] = 0.2f;
2904         t->ndof.factor[1] = 0.2f;
2905
2906         t->idx_max = 1;
2907         t->num.idx_max = 1;
2908         t->snap[0] = 0.0f;
2909         t->snap[1] = (float)((5.0/180)*M_PI);
2910         t->snap[2] = t->snap[1] * 0.2f;
2911
2912         t->flag |= T_NO_CONSTRAINT;
2913 }
2914
2915 static void applyTrackball(TransInfo *t, float axis1[3], float axis2[3], float angles[2])
2916 {
2917         TransData *td = t->data;
2918         float mat[3][3], smat[3][3], totmat[3][3];
2919         int i;
2920
2921         VecRotToMat3(axis1, angles[0], smat