llmaniprotate.cpp
上传用户:king477883
上传日期:2021-03-01
资源大小:9553k
文件大小:57k
源码类别:

游戏引擎

开发平台:

C++ Builder

  1. /** 
  2.  * @file llmaniprotate.cpp
  3.  * @brief LLManipRotate class implementation
  4.  *
  5.  * $LicenseInfo:firstyear=2002&license=viewergpl$
  6.  * 
  7.  * Copyright (c) 2002-2010, Linden Research, Inc.
  8.  * 
  9.  * Second Life Viewer Source Code
  10.  * The source code in this file ("Source Code") is provided by Linden Lab
  11.  * to you under the terms of the GNU General Public License, version 2.0
  12.  * ("GPL"), unless you have obtained a separate licensing agreement
  13.  * ("Other License"), formally executed by you and Linden Lab.  Terms of
  14.  * the GPL can be found in doc/GPL-license.txt in this distribution, or
  15.  * online at http://secondlifegrid.net/programs/open_source/licensing/gplv2
  16.  * 
  17.  * There are special exceptions to the terms and conditions of the GPL as
  18.  * it is applied to this Source Code. View the full text of the exception
  19.  * in the file doc/FLOSS-exception.txt in this software distribution, or
  20.  * online at
  21.  * http://secondlifegrid.net/programs/open_source/licensing/flossexception
  22.  * 
  23.  * By copying, modifying or distributing this software, you acknowledge
  24.  * that you have read and understood your obligations described above,
  25.  * and agree to abide by those obligations.
  26.  * 
  27.  * ALL LINDEN LAB SOURCE CODE IS PROVIDED "AS IS." LINDEN LAB MAKES NO
  28.  * WARRANTIES, EXPRESS, IMPLIED OR OTHERWISE, REGARDING ITS ACCURACY,
  29.  * COMPLETENESS OR PERFORMANCE.
  30.  * $/LicenseInfo$
  31.  */
  32. #include "llviewerprecompiledheaders.h"
  33. #include "llmaniprotate.h"
  34. // library includes
  35. #include "llmath.h"
  36. #include "llgl.h"
  37. #include "llrender.h"
  38. #include "v4color.h"
  39. #include "llprimitive.h"
  40. #include "llview.h"
  41. #include "llfontgl.h"
  42. // viewer includes
  43. #include "llagent.h"
  44. #include "llbox.h"
  45. #include "llbutton.h"
  46. #include "llviewercontrol.h"
  47. #include "llcriticaldamp.h"
  48. #include "lltooltip.h"
  49. #include "llfloatertools.h"
  50. #include "llselectmgr.h"
  51. #include "llstatusbar.h"
  52. #include "llui.h"
  53. #include "llvoavatar.h"
  54. #include "llviewercamera.h"
  55. #include "llviewerobject.h"
  56. #include "llviewerobject.h"
  57. #include "llviewerwindow.h"
  58. #include "llworld.h"
  59. #include "pipeline.h"
  60. #include "lldrawable.h"
  61. #include "llglheaders.h"
  62. #include "lltrans.h"
  63. const F32 RADIUS_PIXELS = 100.f; // size in screen space
  64. const F32 SQ_RADIUS = RADIUS_PIXELS * RADIUS_PIXELS;
  65. const F32 WIDTH_PIXELS = 8;
  66. const S32 CIRCLE_STEPS = 100;
  67. const F32 DELTA = F_TWO_PI / CIRCLE_STEPS;
  68. const F32 SIN_DELTA = sin( DELTA );
  69. const F32 COS_DELTA = cos( DELTA );
  70. const F32 MAX_MANIP_SELECT_DISTANCE = 100.f;
  71. const F32 SNAP_ANGLE_INCREMENT = 5.625f;
  72. const F32 SNAP_ANGLE_DETENTE = SNAP_ANGLE_INCREMENT;
  73. const F32 SNAP_GUIDE_RADIUS_1 = 2.8f;
  74. const F32 SNAP_GUIDE_RADIUS_2 = 2.4f;
  75. const F32 SNAP_GUIDE_RADIUS_3 = 2.2f;
  76. const F32 SNAP_GUIDE_RADIUS_4 = 2.1f;
  77. const F32 SNAP_GUIDE_RADIUS_5 = 2.05f;
  78. const F32 SNAP_GUIDE_INNER_RADIUS = 2.f;
  79. const F32 AXIS_ONTO_CAM_TOLERANCE = cos( 80.f * DEG_TO_RAD );
  80. const F32 SELECTED_MANIPULATOR_SCALE = 1.05f;
  81. const F32 MANIPULATOR_SCALE_HALF_LIFE = 0.07f;
  82. extern void handle_reset_rotation(void*);  // in LLViewerWindow
  83. LLManipRotate::LLManipRotate( LLToolComposite* composite )
  84. :  LLManip( std::string("Rotate"), composite ),
  85. mRotationCenter(),
  86. mCenterScreen(),
  87. mRotation(),
  88. mMouseDown(),
  89. mMouseCur(),
  90. mRadiusMeters(0.f),
  91. mCenterToCam(),
  92. mCenterToCamNorm(),
  93. mCenterToCamMag(0.f),
  94. mCenterToProfilePlane(),
  95. mCenterToProfilePlaneMag(0.f),
  96. mSendUpdateOnMouseUp( FALSE ),
  97. mSmoothRotate( FALSE ),
  98. mCamEdgeOn(FALSE),
  99. mManipulatorScales(1.f, 1.f, 1.f, 1.f)
  100. { }
  101. void LLManipRotate::handleSelect()
  102. {
  103. // *FIX: put this in mouseDown?
  104. LLSelectMgr::getInstance()->saveSelectedObjectTransform(SELECT_ACTION_TYPE_PICK);
  105. gFloaterTools->setStatusText("rotate");
  106. LLManip::handleSelect();
  107. }
  108. void LLManipRotate::render()
  109. {
  110. LLGLSUIDefault gls_ui;
  111. gGL.getTexUnit(0)->unbind(LLTexUnit::TT_TEXTURE);
  112. LLGLDepthTest gls_depth(GL_TRUE);
  113. LLGLEnable gl_blend(GL_BLEND);
  114. LLGLEnable gls_alpha_test(GL_ALPHA_TEST);
  115. // You can rotate if you can move
  116. LLViewerObject* first_object = mObjectSelection->getFirstMoveableObject(TRUE);
  117. if( !first_object )
  118. {
  119. return;
  120. }
  121. if( !updateVisiblity() )
  122. {
  123. return;
  124. }
  125. glMatrixMode(GL_MODELVIEW);
  126. glPushMatrix();
  127. if (mObjectSelection->getSelectType() == SELECT_TYPE_HUD)
  128. {
  129. F32 zoom = gAgent.mHUDCurZoom;
  130. glScalef(zoom, zoom, zoom);
  131. }
  132. LLVector3 center = gAgent.getPosAgentFromGlobal( mRotationCenter );
  133. LLColor4 highlight_outside( 1.f, 1.f, 0.f, 1.f );
  134. LLColor4 highlight_inside( 0.7f, 0.7f, 0.f, 0.5f );
  135. F32 width_meters = WIDTH_PIXELS * mRadiusMeters / RADIUS_PIXELS;
  136. glPushMatrix();
  137. {
  138. // are we in the middle of a constrained drag?
  139. if (mManipPart >= LL_ROT_X && mManipPart <= LL_ROT_Z)
  140. {
  141. renderSnapGuides();
  142. }
  143. else
  144. {
  145. LLGLEnable cull_face(GL_CULL_FACE);
  146. LLGLDepthTest gls_depth(GL_FALSE);
  147. glPushMatrix();
  148. {
  149. // Draw "sphere" (intersection of sphere with tangent cone that has apex at camera)
  150. glTranslatef( mCenterToProfilePlane.mV[VX], mCenterToProfilePlane.mV[VY], mCenterToProfilePlane.mV[VZ] );
  151. glTranslatef( center.mV[VX], center.mV[VY], center.mV[VZ] );
  152. // Inverse change of basis vectors
  153. LLVector3 forward = mCenterToCamNorm;
  154. LLVector3 left = gAgent.getUpAxis() % forward;
  155. left.normVec();
  156. LLVector3 up = forward % left;
  157. LLVector4 a(-forward);
  158. a.mV[3] = 0;
  159. LLVector4 b(up);
  160. b.mV[3] = 0;
  161. LLVector4 c(left);
  162. c.mV[3] = 0;
  163. LLMatrix4 mat;
  164. mat.initRows(a, b, c, LLVector4(0.f, 0.f, 0.f, 1.f));
  165. glMultMatrixf( &mat.mMatrix[0][0] );
  166. glRotatef( -90, 0.f, 1.f, 0.f);
  167. LLColor4 color;
  168. if (mManipPart == LL_ROT_ROLL || mHighlightedPart == LL_ROT_ROLL)
  169. {
  170. color.setVec(0.8f, 0.8f, 0.8f, 0.8f);
  171. glScalef(mManipulatorScales.mV[VW], mManipulatorScales.mV[VW], mManipulatorScales.mV[VW]);
  172. }
  173. else
  174. {
  175. color.setVec( 0.7f, 0.7f, 0.7f, 0.6f );
  176. }
  177. gl_washer_2d(mRadiusMeters + width_meters, mRadiusMeters, CIRCLE_STEPS, color, color);
  178. if (mManipPart == LL_NO_PART)
  179. {
  180. gGL.color4f( 0.7f, 0.7f, 0.7f, 0.3f );
  181. gl_circle_2d( 0, 0,  mRadiusMeters, CIRCLE_STEPS, TRUE );
  182. }
  183. GLdouble plane_eqn[] = { 0, 0, 1, 0 };
  184. glClipPlane( GL_CLIP_PLANE0, plane_eqn );
  185. }
  186. glPopMatrix();
  187. }
  188. glTranslatef( center.mV[VX], center.mV[VY], center.mV[VZ] );
  189. LLQuaternion rot;
  190. F32 angle_radians, x, y, z;
  191. LLVector3 grid_origin;
  192. LLVector3 grid_scale;
  193. LLQuaternion grid_rotation;
  194. LLSelectMgr::getInstance()->getGrid(grid_origin, grid_rotation, grid_scale);
  195. grid_rotation.getAngleAxis(&angle_radians, &x, &y, &z);
  196. glRotatef(angle_radians * RAD_TO_DEG, x, y, z);
  197. if (mManipPart == LL_ROT_Z)
  198. {
  199. mManipulatorScales = lerp(mManipulatorScales, LLVector4(1.f, 1.f, SELECTED_MANIPULATOR_SCALE, 1.f), LLCriticalDamp::getInterpolant(MANIPULATOR_SCALE_HALF_LIFE));
  200. glPushMatrix();
  201. {
  202. // selected part
  203. glScalef(mManipulatorScales.mV[VZ], mManipulatorScales.mV[VZ], mManipulatorScales.mV[VZ]);
  204. renderActiveRing( mRadiusMeters, width_meters, LLColor4( 0.f, 0.f, 1.f, 1.f) , LLColor4( 0.f, 0.f, 1.f, 0.3f ));
  205. }
  206. glPopMatrix();
  207. }
  208. else if (mManipPart == LL_ROT_Y)
  209. {
  210. mManipulatorScales = lerp(mManipulatorScales, LLVector4(1.f, SELECTED_MANIPULATOR_SCALE, 1.f, 1.f), LLCriticalDamp::getInterpolant(MANIPULATOR_SCALE_HALF_LIFE));
  211. glPushMatrix();
  212. {
  213. glRotatef( 90.f, 1.f, 0.f, 0.f );
  214. glScalef(mManipulatorScales.mV[VY], mManipulatorScales.mV[VY], mManipulatorScales.mV[VY]);
  215. renderActiveRing( mRadiusMeters, width_meters, LLColor4( 0.f, 1.f, 0.f, 1.f), LLColor4( 0.f, 1.f, 0.f, 0.3f));
  216. }
  217. glPopMatrix();
  218. }
  219. else if (mManipPart == LL_ROT_X)
  220. {
  221. mManipulatorScales = lerp(mManipulatorScales, LLVector4(SELECTED_MANIPULATOR_SCALE, 1.f, 1.f, 1.f), LLCriticalDamp::getInterpolant(MANIPULATOR_SCALE_HALF_LIFE));
  222. glPushMatrix();
  223. {
  224. glRotatef( 90.f, 0.f, 1.f, 0.f );
  225. glScalef(mManipulatorScales.mV[VX], mManipulatorScales.mV[VX], mManipulatorScales.mV[VX]);
  226. renderActiveRing( mRadiusMeters, width_meters, LLColor4( 1.f, 0.f, 0.f, 1.f), LLColor4( 1.f, 0.f, 0.f, 0.3f));
  227. }
  228. glPopMatrix();
  229. }
  230. else if (mManipPart == LL_ROT_ROLL)
  231. {
  232. mManipulatorScales = lerp(mManipulatorScales, LLVector4(1.f, 1.f, 1.f, SELECTED_MANIPULATOR_SCALE), LLCriticalDamp::getInterpolant(MANIPULATOR_SCALE_HALF_LIFE));
  233. }
  234. else if (mManipPart == LL_NO_PART)
  235. {
  236. if (mHighlightedPart == LL_NO_PART)
  237. {
  238. mManipulatorScales = lerp(mManipulatorScales, LLVector4(1.f, 1.f, 1.f, 1.f), LLCriticalDamp::getInterpolant(MANIPULATOR_SCALE_HALF_LIFE));
  239. }
  240. LLGLEnable cull_face(GL_CULL_FACE);
  241. LLGLEnable clip_plane0(GL_CLIP_PLANE0);
  242. LLGLDepthTest gls_depth(GL_FALSE);
  243. // First pass: centers. Second pass: sides.
  244. for( S32 i=0; i<2; i++ )
  245. {
  246. glPushMatrix();
  247. {
  248. if (mHighlightedPart == LL_ROT_Z)
  249. {
  250. mManipulatorScales = lerp(mManipulatorScales, LLVector4(1.f, 1.f, SELECTED_MANIPULATOR_SCALE, 1.f), LLCriticalDamp::getInterpolant(MANIPULATOR_SCALE_HALF_LIFE));
  251. glScalef(mManipulatorScales.mV[VZ], mManipulatorScales.mV[VZ], mManipulatorScales.mV[VZ]);
  252. // hovering over part
  253. gl_ring( mRadiusMeters, width_meters, LLColor4( 0.f, 0.f, 1.f, 1.f ), LLColor4( 0.f, 0.f, 1.f, 0.5f ), CIRCLE_STEPS, i);
  254. }
  255. else
  256. {
  257. // default
  258. gl_ring( mRadiusMeters, width_meters, LLColor4( 0.f, 0.f, 0.8f, 0.8f ), LLColor4( 0.f, 0.f, 0.8f, 0.4f ), CIRCLE_STEPS, i);
  259. }
  260. }
  261. glPopMatrix();
  262. glPushMatrix();
  263. {
  264. glRotatef( 90.f, 1.f, 0.f, 0.f );
  265. if (mHighlightedPart == LL_ROT_Y)
  266. {
  267. mManipulatorScales = lerp(mManipulatorScales, LLVector4(1.f, SELECTED_MANIPULATOR_SCALE, 1.f, 1.f), LLCriticalDamp::getInterpolant(MANIPULATOR_SCALE_HALF_LIFE));
  268. glScalef(mManipulatorScales.mV[VY], mManipulatorScales.mV[VY], mManipulatorScales.mV[VY]);
  269. // hovering over part
  270. gl_ring( mRadiusMeters, width_meters, LLColor4( 0.f, 1.f, 0.f, 1.f ), LLColor4( 0.f, 1.f, 0.f, 0.5f ), CIRCLE_STEPS, i);
  271. }
  272. else
  273. {
  274. // default
  275. gl_ring( mRadiusMeters, width_meters, LLColor4( 0.f, 0.8f, 0.f, 0.8f ), LLColor4( 0.f, 0.8f, 0.f, 0.4f ), CIRCLE_STEPS, i);
  276. }
  277. }
  278. glPopMatrix();
  279. glPushMatrix();
  280. {
  281. glRotatef( 90.f, 0.f, 1.f, 0.f );
  282. if (mHighlightedPart == LL_ROT_X)
  283. {
  284. mManipulatorScales = lerp(mManipulatorScales, LLVector4(SELECTED_MANIPULATOR_SCALE, 1.f, 1.f, 1.f), LLCriticalDamp::getInterpolant(MANIPULATOR_SCALE_HALF_LIFE));
  285. glScalef(mManipulatorScales.mV[VX], mManipulatorScales.mV[VX], mManipulatorScales.mV[VX]);
  286. // hovering over part
  287. gl_ring( mRadiusMeters, width_meters, LLColor4( 1.f, 0.f, 0.f, 1.f ), LLColor4( 1.f, 0.f, 0.f, 0.5f ), CIRCLE_STEPS, i);
  288. }
  289. else
  290. {
  291. // default
  292. gl_ring( mRadiusMeters, width_meters, LLColor4( 0.8f, 0.f, 0.f, 0.8f ), LLColor4( 0.8f, 0.f, 0.f, 0.4f ), CIRCLE_STEPS, i);
  293. }
  294. }
  295. glPopMatrix();
  296. if (mHighlightedPart == LL_ROT_ROLL)
  297. {
  298. mManipulatorScales = lerp(mManipulatorScales, LLVector4(1.f, 1.f, 1.f, SELECTED_MANIPULATOR_SCALE), LLCriticalDamp::getInterpolant(MANIPULATOR_SCALE_HALF_LIFE));
  299. }
  300. }
  301. }
  302. }
  303. glPopMatrix();
  304. glPopMatrix();
  305. LLVector3 euler_angles;
  306. LLQuaternion object_rot = first_object->getRotationEdit();
  307. object_rot.getEulerAngles(&(euler_angles.mV[VX]), &(euler_angles.mV[VY]), &(euler_angles.mV[VZ]));
  308. euler_angles *= RAD_TO_DEG;
  309. euler_angles.mV[VX] = llround(fmodf(euler_angles.mV[VX] + 360.f, 360.f), 0.05f);
  310. euler_angles.mV[VY] = llround(fmodf(euler_angles.mV[VY] + 360.f, 360.f), 0.05f);
  311. euler_angles.mV[VZ] = llround(fmodf(euler_angles.mV[VZ] + 360.f, 360.f), 0.05f);
  312. renderXYZ(euler_angles);
  313. }
  314. BOOL LLManipRotate::handleMouseDown(S32 x, S32 y, MASK mask)
  315. {
  316. BOOL handled = FALSE;
  317. LLViewerObject* first_object = mObjectSelection->getFirstMoveableObject(TRUE);
  318. if( first_object )
  319. {
  320. if( mHighlightedPart != LL_NO_PART )
  321. {
  322. handled = handleMouseDownOnPart( x, y, mask );
  323. }
  324. }
  325. return handled;
  326. }
  327. // Assumes that one of the parts of the manipulator was hit.
  328. BOOL LLManipRotate::handleMouseDownOnPart( S32 x, S32 y, MASK mask )
  329. {
  330. BOOL can_rotate = canAffectSelection();
  331. if (!can_rotate)
  332. {
  333. return FALSE;
  334. }
  335. highlightManipulators(x, y);
  336. S32 hit_part = mHighlightedPart;
  337. // we just started a drag, so save initial object positions
  338. LLSelectMgr::getInstance()->saveSelectedObjectTransform(SELECT_ACTION_TYPE_ROTATE);
  339. // save selection center
  340. mRotationCenter = gAgent.getPosGlobalFromAgent( getPivotPoint() ); //LLSelectMgr::getInstance()->getSelectionCenterGlobal();
  341. mManipPart = (EManipPart)hit_part;
  342. LLVector3 center = gAgent.getPosAgentFromGlobal( mRotationCenter );
  343. if( mManipPart == LL_ROT_GENERAL)
  344. {
  345. mMouseDown = intersectMouseWithSphere( x, y, center, mRadiusMeters);
  346. }
  347. else
  348. {
  349. // Project onto the plane of the ring
  350. LLVector3 axis = getConstraintAxis();
  351. F32 axis_onto_cam = llabs( axis * mCenterToCamNorm );
  352. const F32 AXIS_ONTO_CAM_TOL = cos( 85.f * DEG_TO_RAD );
  353. if( axis_onto_cam < AXIS_ONTO_CAM_TOL )
  354. {
  355. LLVector3 up_from_axis = mCenterToCamNorm % axis;
  356. up_from_axis.normVec();
  357. LLVector3 cur_intersection;
  358. getMousePointOnPlaneAgent(cur_intersection, x, y, center, mCenterToCam);
  359. cur_intersection -= center;
  360. mMouseDown = projected_vec(cur_intersection, up_from_axis);
  361. F32 mouse_depth = SNAP_GUIDE_INNER_RADIUS * mRadiusMeters;
  362. F32 mouse_dist_sqrd = mMouseDown.magVecSquared();
  363. if (mouse_dist_sqrd > 0.0001f)
  364. {
  365. mouse_depth = sqrtf((SNAP_GUIDE_INNER_RADIUS * mRadiusMeters) * (SNAP_GUIDE_INNER_RADIUS * mRadiusMeters) - 
  366. mouse_dist_sqrd);
  367. }
  368. LLVector3 projected_center_to_cam = mCenterToCamNorm - projected_vec(mCenterToCamNorm, axis);
  369. mMouseDown += mouse_depth * projected_center_to_cam;
  370. }
  371. else
  372. {
  373. mMouseDown = findNearestPointOnRing( x, y, center, axis ) - center;
  374. mMouseDown.normVec();
  375. }
  376. }
  377. mMouseCur = mMouseDown;
  378. // Route future Mouse messages here preemptively.  (Release on mouse up.)
  379. setMouseCapture( TRUE );
  380. LLSelectMgr::getInstance()->enableSilhouette(FALSE);
  381. return TRUE;
  382. }
  383. LLVector3 LLManipRotate::findNearestPointOnRing( S32 x, S32 y, const LLVector3& center, const LLVector3& axis )
  384. {
  385. // Project the delta onto the ring and rescale it by the radius so that it's _on_ the ring.
  386. LLVector3 proj_onto_ring;
  387. getMousePointOnPlaneAgent(proj_onto_ring, x, y, center, axis);
  388. proj_onto_ring -= center;
  389. proj_onto_ring.normVec();
  390. return center + proj_onto_ring * mRadiusMeters;
  391. }
  392. BOOL LLManipRotate::handleMouseUp(S32 x, S32 y, MASK mask)
  393. {
  394. // first, perform normal processing in case this was a quick-click
  395. handleHover(x, y, mask);
  396. if( hasMouseCapture() )
  397. {
  398. for (LLObjectSelection::iterator iter = mObjectSelection->begin();
  399.  iter != mObjectSelection->end(); iter++)
  400. {
  401. LLSelectNode* selectNode = *iter;
  402. LLViewerObject* object = selectNode->getObject();
  403. // have permission to move and object is root of selection or individually selected
  404. if (object->permMove() && (object->isRootEdit() || selectNode->mIndividualSelection))
  405. {
  406. object->mUnselectedChildrenPositions.clear() ;
  407. }
  408. }
  409. mManipPart = LL_NO_PART;
  410. // Might have missed last update due to timing.
  411. LLSelectMgr::getInstance()->sendMultipleUpdate( UPD_ROTATION | UPD_POSITION );
  412. LLSelectMgr::getInstance()->enableSilhouette(TRUE);
  413. //gAgent.setObjectTracking(gSavedSettings.getBOOL("TrackFocusObject"));
  414. LLSelectMgr::getInstance()->updateSelectionCenter();
  415. LLSelectMgr::getInstance()->saveSelectedObjectTransform(SELECT_ACTION_TYPE_PICK);
  416. }
  417. return LLManip::handleMouseUp(x, y, mask);
  418. }
  419. BOOL LLManipRotate::handleHover(S32 x, S32 y, MASK mask)
  420. {
  421. if( hasMouseCapture() )
  422. {
  423. if( mObjectSelection->isEmpty() )
  424. {
  425. // Somehow the object got deselected while we were dragging it.
  426. setMouseCapture( FALSE );
  427. }
  428. else
  429. {
  430. drag(x, y);
  431. }
  432. lldebugst(LLERR_USER_INPUT) << "hover handled by LLManipRotate (active)" << llendl;
  433. }
  434. else
  435. {
  436. highlightManipulators(x, y);
  437. lldebugst(LLERR_USER_INPUT) << "hover handled by LLManipRotate (inactive)" << llendl;
  438. }
  439. gViewerWindow->setCursor(UI_CURSOR_TOOLROTATE);
  440. return TRUE;
  441. }
  442. LLVector3 LLManipRotate::projectToSphere( F32 x, F32 y, BOOL* on_sphere ) 
  443. {
  444. F32 z = 0.f;
  445. F32 dist_squared = x*x + y*y;
  446. *on_sphere = dist_squared <= SQ_RADIUS;
  447.     if( *on_sphere )
  448. {    
  449.         z = sqrt(SQ_RADIUS - dist_squared);
  450.     }
  451. return LLVector3( x, y, z );
  452. }
  453. // Freeform rotation
  454. void LLManipRotate::drag( S32 x, S32 y )
  455. {
  456. if( !updateVisiblity() )
  457. {
  458. return;
  459. }
  460. if( mManipPart == LL_ROT_GENERAL )
  461. {
  462. mRotation = dragUnconstrained(x, y);
  463. }
  464. else
  465. {
  466. mRotation = dragConstrained(x, y);
  467. }
  468. BOOL damped = mSmoothRotate;
  469. mSmoothRotate = FALSE;
  470. for (LLObjectSelection::iterator iter = mObjectSelection->begin();
  471.  iter != mObjectSelection->end(); iter++)
  472. {
  473. LLSelectNode* selectNode = *iter;
  474. LLViewerObject* object = selectNode->getObject();
  475. // have permission to move and object is root of selection or individually selected
  476. if (object->permMove() && (object->isRootEdit() || selectNode->mIndividualSelection))
  477. {
  478. if (!object->isRootEdit())
  479. {
  480. // child objects should not update if parent is selected
  481. LLViewerObject* editable_root = (LLViewerObject*)object->getParent();
  482. if (editable_root->isSelected())
  483. {
  484. // we will be moved properly by our parent, so skip
  485. continue;
  486. }
  487. }
  488. LLQuaternion new_rot = selectNode->mSavedRotation * mRotation;
  489. std::vector<LLVector3>& child_positions = object->mUnselectedChildrenPositions ;
  490. std::vector<LLQuaternion> child_rotations;
  491. if (object->isRootEdit() && selectNode->mIndividualSelection)
  492. {
  493. object->saveUnselectedChildrenRotation(child_rotations) ;
  494. object->saveUnselectedChildrenPosition(child_positions) ;
  495. }
  496. if (object->getParent() && object->mDrawable.notNull())
  497. {
  498. LLQuaternion invParentRotation = object->mDrawable->mXform.getParent()->getWorldRotation();
  499. invParentRotation.transQuat();
  500. object->setRotation(new_rot * invParentRotation, damped);
  501. rebuild(object);
  502. }
  503. else
  504. {
  505. object->setRotation(new_rot, damped);
  506. rebuild(object);
  507. }
  508. // for individually selected roots, we need to counterrotate all the children
  509. if (object->isRootEdit() && selectNode->mIndividualSelection)
  510. {
  511. //RN: must do non-damped updates on these objects so relative rotation appears constant
  512. // instead of having two competing slerps making the child objects appear to "wobble"
  513. object->resetChildrenRotationAndPosition(child_rotations, child_positions) ;
  514. }
  515. }
  516. }
  517. // update positions
  518. for (LLObjectSelection::iterator iter = mObjectSelection->begin();
  519.  iter != mObjectSelection->end(); iter++)
  520. {
  521. LLSelectNode* selectNode = *iter;
  522. LLViewerObject* object = selectNode->getObject();
  523. // to avoid cumulative position changes we calculate the objects new position using its saved position
  524. if (object && object->permMove())
  525. {
  526. LLVector3 center   = gAgent.getPosAgentFromGlobal( mRotationCenter );
  527. LLVector3 old_position;
  528. LLVector3 new_position;
  529. if (object->isAttachment() && object->mDrawable.notNull())
  530. // need to work in drawable space to handle selected items from multiple attachments 
  531. // (which have no shared frame of reference other than their render positions)
  532. LLXform* parent_xform = object->mDrawable->getXform()->getParent();
  533. new_position = (selectNode->mSavedPositionLocal * parent_xform->getWorldRotation()) + parent_xform->getWorldPosition();
  534. old_position = (object->getPosition() * parent_xform->getWorldRotation()) + parent_xform->getWorldPosition();//object->getRenderPosition();
  535. }
  536. else
  537. {
  538. new_position = gAgent.getPosAgentFromGlobal( selectNode->mSavedPositionGlobal );
  539. old_position = object->getPositionAgent();
  540. }
  541. new_position = (new_position - center) * mRotation; // new relative rotated position
  542. new_position += center;
  543. if (object->isRootEdit() && !object->isAttachment())
  544. {
  545. LLVector3d new_pos_global = gAgent.getPosGlobalFromAgent(new_position);
  546. new_pos_global = LLWorld::getInstance()->clipToVisibleRegions(selectNode->mSavedPositionGlobal, new_pos_global);
  547. new_position = gAgent.getPosAgentFromGlobal(new_pos_global);
  548. }
  549. // for individually selected child objects
  550. if (!object->isRootEdit() && selectNode->mIndividualSelection)
  551. {
  552. LLViewerObject* parentp = (LLViewerObject*)object->getParent();
  553. if (!parentp->isSelected())
  554. {
  555. if (object->isAttachment() && object->mDrawable.notNull())
  556. {
  557. // find position relative to render position of parent
  558. object->setPosition((new_position - parentp->getRenderPosition()) * ~parentp->getRenderRotation());
  559. rebuild(object);
  560. }
  561. else
  562. {
  563. object->setPositionParent((new_position - parentp->getPositionAgent()) * ~parentp->getRotationRegion());
  564. rebuild(object);
  565. }
  566. }
  567. }
  568. else if (object->isRootEdit())
  569. {
  570. if (object->isAttachment() && object->mDrawable.notNull())
  571. {
  572. LLXform* parent_xform = object->mDrawable->getXform()->getParent();
  573. object->setPosition((new_position - parent_xform->getWorldPosition()) * ~parent_xform->getWorldRotation());
  574. rebuild(object);
  575. }
  576. else
  577. {
  578. object->setPositionAgent(new_position);
  579. rebuild(object);
  580. }
  581. }
  582. // for individually selected roots, we need to counter-translate all unselected children
  583. if (object->isRootEdit() && selectNode->mIndividualSelection)
  584. {
  585. // only offset by parent's translation as we've already countered parent's rotation
  586. rebuild(object);
  587. object->resetChildrenPosition(old_position - new_position) ;
  588. }
  589. }
  590. }
  591. // store changes to override updates
  592. for (LLObjectSelection::iterator iter = LLSelectMgr::getInstance()->getSelection()->begin();
  593.  iter != LLSelectMgr::getInstance()->getSelection()->end(); iter++)
  594. {
  595. LLSelectNode* selectNode = *iter;
  596. LLViewerObject*cur = selectNode->getObject();
  597. if( cur->permModify() && cur->permMove() && !cur->isAvatar())
  598. {
  599. selectNode->mLastRotation = cur->getRotation();
  600. selectNode->mLastPositionLocal = cur->getPosition();
  601. }
  602. }
  603. LLSelectMgr::getInstance()->updateSelectionCenter();
  604. // RN: just clear focus so camera doesn't follow spurious object updates
  605. gAgent.clearFocusObject();
  606. dialog_refresh_all();
  607. }
  608. void LLManipRotate::renderActiveRing( F32 radius, F32 width, const LLColor4& front_color, const LLColor4& back_color)
  609. {
  610. LLGLEnable cull_face(GL_CULL_FACE);
  611. {
  612. gl_ring(radius, width, back_color, back_color * 0.5f, CIRCLE_STEPS, FALSE);
  613. gl_ring(radius, width, back_color, back_color * 0.5f, CIRCLE_STEPS, TRUE);
  614. }
  615. {
  616. LLGLDepthTest gls_depth(GL_FALSE);
  617. gl_ring(radius, width, front_color, front_color * 0.5f, CIRCLE_STEPS, FALSE);
  618. gl_ring(radius, width, front_color, front_color * 0.5f, CIRCLE_STEPS, TRUE);
  619. }
  620. }
  621. void LLManipRotate::renderSnapGuides()
  622. {
  623. LLVector3 grid_origin;
  624. LLVector3 grid_scale;
  625. LLQuaternion grid_rotation;
  626. LLVector3 constraint_axis = getConstraintAxis();
  627. LLSelectMgr::getInstance()->getGrid(grid_origin, grid_rotation, grid_scale);
  628. if (!gSavedSettings.getBOOL("SnapEnabled"))
  629. {
  630. return;
  631. }
  632. LLVector3 center = gAgent.getPosAgentFromGlobal( mRotationCenter );
  633. LLVector3 cam_at_axis;
  634. if (mObjectSelection->getSelectType() == SELECT_TYPE_HUD)
  635. {
  636. cam_at_axis.setVec(1.f, 0.f, 0.f);
  637. }
  638. else
  639. {
  640. cam_at_axis = center - gAgent.getCameraPositionAgent();
  641. cam_at_axis.normVec();
  642. }
  643. LLVector3 world_snap_axis;
  644. LLVector3 test_axis = constraint_axis;
  645. BOOL constrain_to_ref_object = FALSE;
  646. if (mObjectSelection->getSelectType() == SELECT_TYPE_ATTACHMENT && gAgent.getAvatarObject())
  647. {
  648. test_axis = test_axis * ~grid_rotation;
  649. }
  650. else if (LLSelectMgr::getInstance()->getGridMode() == GRID_MODE_REF_OBJECT)
  651. {
  652. test_axis = test_axis * ~grid_rotation;
  653. constrain_to_ref_object = TRUE;
  654. }
  655. test_axis.abs();
  656. // find closest global/reference axis to local constraint axis;
  657. if (test_axis.mV[VX] > test_axis.mV[VY] && test_axis.mV[VX] > test_axis.mV[VZ])
  658. {
  659. world_snap_axis = LLVector3::y_axis;
  660. }
  661. else if (test_axis.mV[VY] > test_axis.mV[VZ])
  662. {
  663. world_snap_axis = LLVector3::z_axis;
  664. }
  665. else
  666. {
  667. world_snap_axis = LLVector3::x_axis;
  668. }
  669. LLVector3 projected_snap_axis = world_snap_axis;
  670. if (mObjectSelection->getSelectType() == SELECT_TYPE_ATTACHMENT && gAgent.getAvatarObject())
  671. {
  672. projected_snap_axis = projected_snap_axis * grid_rotation;
  673. }
  674. else if (constrain_to_ref_object)
  675. {
  676. projected_snap_axis = projected_snap_axis * grid_rotation;
  677. }
  678. // project world snap axis onto constraint plane
  679. projected_snap_axis -= projected_vec(projected_snap_axis, constraint_axis);
  680. projected_snap_axis.normVec();
  681. S32 num_rings = mCamEdgeOn ? 2 : 1;
  682. for (S32 ring_num = 0; ring_num < num_rings; ring_num++)
  683. {
  684. LLVector3 center = gAgent.getPosAgentFromGlobal( mRotationCenter );
  685. if (mCamEdgeOn)
  686. {
  687. // draw two opposing rings
  688. if (ring_num == 0)
  689. {
  690. center += constraint_axis * mRadiusMeters * 0.5f;
  691. }
  692. else
  693. {
  694. center -= constraint_axis * mRadiusMeters * 0.5f;
  695. }
  696. }
  697. LLGLDepthTest gls_depth(GL_FALSE);
  698. for (S32 pass = 0; pass < 3; pass++)
  699. {
  700. // render snap guide ring
  701. glPushMatrix();
  702. LLQuaternion snap_guide_rot;
  703. F32 angle_radians, x, y, z;
  704. snap_guide_rot.shortestArc(LLVector3::z_axis, getConstraintAxis());
  705. snap_guide_rot.getAngleAxis(&angle_radians, &x, &y, &z);
  706. glTranslatef(center.mV[VX], center.mV[VY], center.mV[VZ]);
  707. glRotatef(angle_radians * RAD_TO_DEG, x, y, z);
  708. LLColor4 line_color = setupSnapGuideRenderPass(pass);
  709. gGL.color4fv(line_color.mV);
  710. if (mCamEdgeOn)
  711. {
  712. // render an arc
  713. LLVector3 edge_normal = cam_at_axis % constraint_axis;
  714. edge_normal.normVec();
  715. LLVector3 x_axis_snap = LLVector3::x_axis * snap_guide_rot;
  716. LLVector3 y_axis_snap = LLVector3::y_axis * snap_guide_rot;
  717. F32 end_angle = atan2(y_axis_snap * edge_normal, x_axis_snap * edge_normal);
  718. //F32 start_angle = angle_between((-1.f * LLVector3::x_axis) * snap_guide_rot, edge_normal);
  719. F32 start_angle = end_angle - F_PI;
  720. gl_arc_2d(0.f, 0.f, mRadiusMeters * SNAP_GUIDE_INNER_RADIUS, CIRCLE_STEPS, FALSE, start_angle, end_angle);
  721. }
  722. else
  723. {
  724. gl_circle_2d(0.f, 0.f, mRadiusMeters * SNAP_GUIDE_INNER_RADIUS, CIRCLE_STEPS, FALSE);
  725. }
  726. glPopMatrix();
  727. for (S32 i = 0; i < 64; i++)
  728. {
  729. BOOL render_text = TRUE;
  730. F32 deg = 5.625f * (F32)i;
  731. LLVector3 inner_point;
  732. LLVector3 outer_point;
  733. LLVector3 text_point;
  734. LLQuaternion rot(deg * DEG_TO_RAD, constraint_axis);
  735. gGL.begin(LLRender::LINES);
  736. {
  737. inner_point = (projected_snap_axis * mRadiusMeters * SNAP_GUIDE_INNER_RADIUS * rot) + center;
  738. F32 tick_length = 0.f;
  739. if (i % 16 == 0)
  740. {
  741. tick_length = mRadiusMeters * (SNAP_GUIDE_RADIUS_1 - SNAP_GUIDE_INNER_RADIUS);
  742. }
  743. else if (i % 8 == 0)
  744. {
  745. tick_length = mRadiusMeters * (SNAP_GUIDE_RADIUS_2 - SNAP_GUIDE_INNER_RADIUS);
  746. }
  747. else if (i % 4 == 0)
  748. {
  749. tick_length = mRadiusMeters * (SNAP_GUIDE_RADIUS_3 - SNAP_GUIDE_INNER_RADIUS);
  750. }
  751. else if (i % 2 == 0)
  752. {
  753. tick_length = mRadiusMeters * (SNAP_GUIDE_RADIUS_4 - SNAP_GUIDE_INNER_RADIUS);
  754. }
  755. else
  756. {
  757. tick_length = mRadiusMeters * (SNAP_GUIDE_RADIUS_5 - SNAP_GUIDE_INNER_RADIUS);
  758. }
  759. if (mCamEdgeOn)
  760. {
  761. // don't draw ticks that are on back side of circle
  762. F32 dot = cam_at_axis * (projected_snap_axis * rot);
  763. if (dot > 0.f)
  764. {
  765. outer_point = inner_point;
  766. render_text = FALSE;
  767. }
  768. else
  769. {
  770. if (ring_num == 0)
  771. {
  772. outer_point = inner_point + (constraint_axis * tick_length) * rot;
  773. }
  774. else
  775. {
  776. outer_point = inner_point - (constraint_axis * tick_length) * rot;
  777. }
  778. }
  779. }
  780. else
  781. {
  782. outer_point = inner_point + (projected_snap_axis * tick_length) * rot;
  783. }
  784. text_point = outer_point + (projected_snap_axis * mRadiusMeters * 0.1f) * rot;
  785. gGL.vertex3fv(inner_point.mV);
  786. gGL.vertex3fv(outer_point.mV);
  787. }
  788. gGL.end();
  789. //RN: text rendering does own shadow pass, so only render once
  790. if (pass == 1 && render_text && i % 16 == 0)
  791. {
  792. if (world_snap_axis.mV[VX])
  793. {
  794. if (i == 0)
  795. {
  796. renderTickText(text_point, mObjectSelection->isAttachment() ? LLTrans::getString("Forward") : LLTrans::getString("East"), LLColor4::white);
  797. }
  798. else if (i == 16)
  799. {
  800. if (constraint_axis.mV[VZ] > 0.f)
  801. {
  802. renderTickText(text_point, mObjectSelection->isAttachment() ? LLTrans::getString("Left") : LLTrans::getString("North"), LLColor4::white);
  803. }
  804. else
  805. {
  806. renderTickText(text_point, mObjectSelection->isAttachment() ? LLTrans::getString("Right") : LLTrans::getString("South"), LLColor4::white);
  807. }
  808. }
  809. else if (i == 32)
  810. {
  811. renderTickText(text_point, mObjectSelection->isAttachment() ? LLTrans::getString("Back") : LLTrans::getString("West"), LLColor4::white);
  812. }
  813. else
  814. {
  815. if (constraint_axis.mV[VZ] > 0.f)
  816. {
  817. renderTickText(text_point, mObjectSelection->isAttachment() ? LLTrans::getString("Right") : LLTrans::getString("South"), LLColor4::white);
  818. }
  819. else
  820. {
  821. renderTickText(text_point, mObjectSelection->isAttachment() ? LLTrans::getString("Left") : LLTrans::getString("North"), LLColor4::white);
  822. }
  823. }
  824. }
  825. else if (world_snap_axis.mV[VY])
  826. {
  827. if (i == 0)
  828. {
  829. renderTickText(text_point, mObjectSelection->isAttachment() ? LLTrans::getString("Left") : LLTrans::getString("North"), LLColor4::white);
  830. }
  831. else if (i == 16)
  832. {
  833. if (constraint_axis.mV[VX] > 0.f)
  834. {
  835. renderTickText(text_point, LLTrans::getString("Up"), LLColor4::white);
  836. }
  837. else
  838. {
  839. renderTickText(text_point, LLTrans::getString("Down"), LLColor4::white);
  840. }
  841. }
  842. else if (i == 32)
  843. {
  844. renderTickText(text_point, mObjectSelection->isAttachment() ? LLTrans::getString("Right") : LLTrans::getString("South"), LLColor4::white);
  845. }
  846. else
  847. {
  848. if (constraint_axis.mV[VX] > 0.f)
  849. {
  850. renderTickText(text_point, LLTrans::getString("Down"), LLColor4::white);
  851. }
  852. else
  853. {
  854. renderTickText(text_point, LLTrans::getString("Up"), LLColor4::white);
  855. }
  856. }
  857. }
  858. else if (world_snap_axis.mV[VZ])
  859. {
  860. if (i == 0)
  861. {
  862. renderTickText(text_point, LLTrans::getString("Up"), LLColor4::white);
  863. }
  864. else if (i == 16)
  865. {
  866. if (constraint_axis.mV[VY] > 0.f)
  867. {
  868. renderTickText(text_point, mObjectSelection->isAttachment() ? LLTrans::getString("Forward") : LLTrans::getString("East"), LLColor4::white);
  869. }
  870. else
  871. {
  872. renderTickText(text_point, mObjectSelection->isAttachment() ? LLTrans::getString("Back") : LLTrans::getString("West"), LLColor4::white);
  873. }
  874. }
  875. else if (i == 32)
  876. {
  877. renderTickText(text_point, LLTrans::getString("Down"), LLColor4::white);
  878. }
  879. else
  880. {
  881. if (constraint_axis.mV[VY] > 0.f)
  882. {
  883. renderTickText(text_point, mObjectSelection->isAttachment() ? LLTrans::getString("Back") : LLTrans::getString("West"), LLColor4::white);
  884. }
  885. else
  886. {
  887. renderTickText(text_point, mObjectSelection->isAttachment() ? LLTrans::getString("Forward") : LLTrans::getString("East"), LLColor4::white);
  888. }
  889. }
  890. }
  891. }
  892. gGL.color4fv(line_color.mV);
  893. }
  894. // now render projected object axis
  895. if (mInSnapRegime)
  896. {
  897. LLVector3 object_axis;
  898. getObjectAxisClosestToMouse(object_axis);
  899. // project onto constraint plane
  900. LLSelectNode* first_node = mObjectSelection->getFirstMoveableNode(TRUE);
  901. object_axis = object_axis * first_node->getObject()->getRenderRotation();
  902. object_axis = object_axis - (object_axis * getConstraintAxis()) * getConstraintAxis();
  903. object_axis.normVec();
  904. object_axis = object_axis * SNAP_GUIDE_INNER_RADIUS * mRadiusMeters + center;
  905. LLVector3 line_start = center;
  906. gGL.begin(LLRender::LINES);
  907. {
  908. gGL.vertex3fv(line_start.mV);
  909. gGL.vertex3fv(object_axis.mV);
  910. }
  911. gGL.end();
  912. // draw snap guide arrow
  913. gGL.begin(LLRender::TRIANGLES);
  914. {
  915. LLVector3 arrow_dir;
  916. LLVector3 arrow_span = (object_axis - line_start) % getConstraintAxis();
  917. arrow_span.normVec();
  918. arrow_dir = mCamEdgeOn ? getConstraintAxis() : object_axis - line_start;
  919. arrow_dir.normVec();
  920. if (ring_num == 1)
  921. {
  922. arrow_dir *= -1.f;
  923. }
  924. gGL.vertex3fv((object_axis + arrow_dir * mRadiusMeters * 0.1f).mV);
  925. gGL.vertex3fv((object_axis + arrow_span * mRadiusMeters * 0.1f).mV);
  926. gGL.vertex3fv((object_axis - arrow_span * mRadiusMeters * 0.1f).mV);
  927. }
  928. gGL.end();
  929. {
  930. LLGLDepthTest gls_depth(GL_TRUE);
  931. gGL.begin(LLRender::LINES);
  932. {
  933. gGL.vertex3fv(line_start.mV);
  934. gGL.vertex3fv(object_axis.mV);
  935. }
  936. gGL.end();
  937. // draw snap guide arrow
  938. gGL.begin(LLRender::TRIANGLES);
  939. {
  940. LLVector3 arrow_dir;
  941. LLVector3 arrow_span = (object_axis - line_start) % getConstraintAxis();
  942. arrow_span.normVec();
  943. arrow_dir = mCamEdgeOn ? getConstraintAxis() : object_axis - line_start;
  944. arrow_dir.normVec();
  945. if (ring_num == 1)
  946. {
  947. arrow_dir *= -1.f;
  948. }
  949. gGL.vertex3fv((object_axis + arrow_dir * mRadiusMeters * 0.1f).mV);
  950. gGL.vertex3fv((object_axis + arrow_span * mRadiusMeters * 0.1f).mV);
  951. gGL.vertex3fv((object_axis - arrow_span * mRadiusMeters * 0.1f).mV);
  952. }
  953. gGL.end();
  954. }
  955. }
  956. }
  957. }
  958. }
  959. // Returns TRUE if center of sphere is visible.  Also sets a bunch of member variables that are used later (e.g. mCenterToCam)
  960. BOOL LLManipRotate::updateVisiblity()
  961. {
  962. // Don't want to recalculate the center of the selection during a drag.
  963. // Due to packet delays, sometimes half the objects in the selection have their
  964. // new position and half have their old one.  This creates subtle errors in the
  965. // computed center position for that frame.  Unfortunately, these errors
  966. // accumulate.  The result is objects seem to "fly apart" during rotations.
  967. // JC - 03.26.2002
  968. if (!hasMouseCapture())
  969. {
  970. mRotationCenter = gAgent.getPosGlobalFromAgent( getPivotPoint() );//LLSelectMgr::getInstance()->getSelectionCenterGlobal();
  971. }
  972. BOOL visible = FALSE;
  973. LLVector3 center = gAgent.getPosAgentFromGlobal( mRotationCenter );
  974. if (mObjectSelection->getSelectType() == SELECT_TYPE_HUD)
  975. {
  976. mCenterToCam = LLVector3(-1.f / gAgent.mHUDCurZoom, 0.f, 0.f);
  977. mCenterToCamNorm = mCenterToCam;
  978. mCenterToCamMag = mCenterToCamNorm.normVec();
  979. mRadiusMeters = RADIUS_PIXELS / (F32) LLViewerCamera::getInstance()->getViewHeightInPixels();
  980. mRadiusMeters /= gAgent.mHUDCurZoom;
  981. mCenterToProfilePlaneMag = mRadiusMeters * mRadiusMeters / mCenterToCamMag;
  982. mCenterToProfilePlane = -mCenterToProfilePlaneMag * mCenterToCamNorm;
  983. // x axis range is (-aspect * 0.5f, +aspect * 0.5)
  984. // y axis range is (-0.5, 0.5)
  985. // so use getWorldViewHeightRaw as scale factor when converting to pixel coordinates
  986. mCenterScreen.set((S32)((0.5f - center.mV[VY]) / gAgent.mHUDCurZoom * gViewerWindow->getWorldViewHeightScaled()),
  987. (S32)((center.mV[VZ] + 0.5f) / gAgent.mHUDCurZoom * gViewerWindow->getWorldViewHeightScaled()));
  988. visible = TRUE;
  989. }
  990. else
  991. {
  992. visible = LLViewerCamera::getInstance()->projectPosAgentToScreen(center, mCenterScreen );
  993. if( visible )
  994. {
  995. mCenterToCam = gAgent.getCameraPositionAgent() - center;
  996. mCenterToCamNorm = mCenterToCam;
  997. mCenterToCamMag = mCenterToCamNorm.normVec();
  998. LLVector3 cameraAtAxis = LLViewerCamera::getInstance()->getAtAxis();
  999. cameraAtAxis.normVec();
  1000. F32 z_dist = -1.f * (mCenterToCam * cameraAtAxis);
  1001. // Don't drag manip if object too far away
  1002. if (gSavedSettings.getBOOL("LimitSelectDistance"))
  1003. {
  1004. F32 max_select_distance = gSavedSettings.getF32("MaxSelectDistance");
  1005. if (dist_vec(gAgent.getPositionAgent(), center) > max_select_distance)
  1006. {
  1007. visible = FALSE;
  1008. }
  1009. }
  1010. if (mCenterToCamMag > 0.001f)
  1011. {
  1012. F32 fraction_of_fov = RADIUS_PIXELS / (F32) LLViewerCamera::getInstance()->getViewHeightInPixels();
  1013. F32 apparent_angle = fraction_of_fov * LLViewerCamera::getInstance()->getView();  // radians
  1014. mRadiusMeters = z_dist * tan(apparent_angle);
  1015. mCenterToProfilePlaneMag = mRadiusMeters * mRadiusMeters / mCenterToCamMag;
  1016. mCenterToProfilePlane = -mCenterToProfilePlaneMag * mCenterToCamNorm;
  1017. }
  1018. else
  1019. {
  1020. visible = FALSE;
  1021. }
  1022. }
  1023. }
  1024. mCamEdgeOn = FALSE;
  1025. F32 axis_onto_cam = mManipPart >= LL_ROT_X ? llabs( getConstraintAxis() * mCenterToCamNorm ) : 0.f;
  1026. if( axis_onto_cam < AXIS_ONTO_CAM_TOLERANCE )
  1027. {
  1028. mCamEdgeOn = TRUE;
  1029. }
  1030. return visible;
  1031. }
  1032. LLQuaternion LLManipRotate::dragUnconstrained( S32 x, S32 y )
  1033. {
  1034. LLVector3 cam = gAgent.getCameraPositionAgent();
  1035. LLVector3 center =  gAgent.getPosAgentFromGlobal( mRotationCenter );
  1036. mMouseCur = intersectMouseWithSphere( x, y, center, mRadiusMeters);
  1037. F32 delta_x = (F32)(mCenterScreen.mX - x);
  1038. F32 delta_y = (F32)(mCenterScreen.mY - y);
  1039. F32 dist_from_sphere_center = sqrt(delta_x * delta_x + delta_y * delta_y);
  1040. LLVector3 axis = mMouseDown % mMouseCur;
  1041. axis.normVec();
  1042. F32 angle = acos(mMouseDown * mMouseCur);
  1043. LLQuaternion sphere_rot( angle, axis );
  1044. if (is_approx_zero(1.f - mMouseDown * mMouseCur))
  1045. {
  1046. return LLQuaternion::DEFAULT;
  1047. }
  1048. else if (dist_from_sphere_center < RADIUS_PIXELS)
  1049. {
  1050. return sphere_rot;
  1051. }
  1052. else
  1053. {
  1054. LLVector3 intersection;
  1055. getMousePointOnPlaneAgent( intersection, x, y, center + mCenterToProfilePlane, mCenterToCamNorm );
  1056. // amount dragging in sphere from center to periphery would rotate object
  1057. F32 in_sphere_angle = F_PI_BY_TWO;
  1058. F32 dist_to_tangent_point = mRadiusMeters;
  1059. if( !is_approx_zero( mCenterToProfilePlaneMag ) )
  1060. {
  1061. dist_to_tangent_point = sqrt( mRadiusMeters * mRadiusMeters - mCenterToProfilePlaneMag * mCenterToProfilePlaneMag );
  1062. in_sphere_angle = atan2( dist_to_tangent_point, mCenterToProfilePlaneMag );
  1063. }
  1064. LLVector3 profile_center_to_intersection = intersection - (center + mCenterToProfilePlane);
  1065. F32 dist_to_intersection = profile_center_to_intersection.normVec();
  1066. F32 angle = (-1.f + dist_to_intersection / dist_to_tangent_point) * in_sphere_angle;
  1067. LLVector3 axis;
  1068. if (mObjectSelection->getSelectType() == SELECT_TYPE_HUD)
  1069. {
  1070. axis = LLVector3(-1.f, 0.f, 0.f) % profile_center_to_intersection;
  1071. }
  1072. else
  1073. {
  1074. axis = (cam - center) % profile_center_to_intersection;
  1075. axis.normVec();
  1076. }
  1077. return sphere_rot * LLQuaternion( angle, axis );
  1078. }
  1079. }
  1080. LLVector3 LLManipRotate::getConstraintAxis()
  1081. {
  1082. LLVector3 axis;
  1083. if( LL_ROT_ROLL == mManipPart )
  1084. {
  1085. axis = mCenterToCamNorm;
  1086. }
  1087. else
  1088. {
  1089. S32 axis_dir = mManipPart - LL_ROT_X;
  1090. if ((axis_dir >= 0) && (axis_dir < 3))
  1091. {
  1092. axis.mV[axis_dir] = 1.f;
  1093. }
  1094. else
  1095. {
  1096. #ifndef LL_RELEASE_FOR_DOWNLOAD
  1097. llerrs << "Got bogus hit part in LLManipRotate::getConstraintAxis():" << mManipPart << llendl;
  1098. #else
  1099. llwarns << "Got bogus hit part in LLManipRotate::getConstraintAxis():" << mManipPart << llendl;
  1100. #endif
  1101. axis.mV[0] = 1.f;
  1102. }
  1103. LLVector3 grid_origin;
  1104. LLVector3 grid_scale;
  1105. LLQuaternion grid_rotation;
  1106. LLSelectMgr::getInstance()->getGrid(grid_origin, grid_rotation, grid_scale);
  1107. LLSelectNode* first_node = mObjectSelection->getFirstMoveableNode(TRUE);
  1108. if (first_node)
  1109. {
  1110. // *FIX: get agent local attachment grid working
  1111. // Put rotation into frame of first selected root object
  1112. axis = axis * grid_rotation;
  1113. }
  1114. }
  1115. return axis;
  1116. }
  1117. LLQuaternion LLManipRotate::dragConstrained( S32 x, S32 y )
  1118. {
  1119. LLSelectNode* first_object_node = mObjectSelection->getFirstMoveableNode(TRUE);
  1120. LLVector3 constraint_axis = getConstraintAxis();
  1121. LLVector3 center = gAgent.getPosAgentFromGlobal( mRotationCenter );
  1122. F32 angle = 0.f;
  1123. // build snap axes
  1124. LLVector3 grid_origin;
  1125. LLVector3 grid_scale;
  1126. LLQuaternion grid_rotation;
  1127. LLSelectMgr::getInstance()->getGrid(grid_origin, grid_rotation, grid_scale);
  1128. LLVector3 axis1;
  1129. LLVector3 axis2;
  1130. LLVector3 test_axis = constraint_axis;
  1131. if (mObjectSelection->getSelectType() == SELECT_TYPE_ATTACHMENT && gAgent.getAvatarObject())
  1132. {
  1133. test_axis = test_axis * ~grid_rotation;
  1134. }
  1135. else if (LLSelectMgr::getInstance()->getGridMode() == GRID_MODE_REF_OBJECT)
  1136. {
  1137. test_axis = test_axis * ~grid_rotation;
  1138. }
  1139. test_axis.abs();
  1140. // find closest global axis to constraint axis;
  1141. if (test_axis.mV[VX] > test_axis.mV[VY] && test_axis.mV[VX] > test_axis.mV[VZ])
  1142. {
  1143. axis1 = LLVector3::y_axis;
  1144. }
  1145. else if (test_axis.mV[VY] > test_axis.mV[VZ])
  1146. {
  1147. axis1 = LLVector3::z_axis;
  1148. }
  1149. else
  1150. {
  1151. axis1 = LLVector3::x_axis;
  1152. }
  1153. if (mObjectSelection->getSelectType() == SELECT_TYPE_ATTACHMENT && gAgent.getAvatarObject())
  1154. {
  1155. axis1 = axis1 * grid_rotation;
  1156. }
  1157. else if (LLSelectMgr::getInstance()->getGridMode() == GRID_MODE_REF_OBJECT)
  1158. {
  1159. axis1 = axis1 * grid_rotation;
  1160. }
  1161. //project axis onto constraint plane
  1162. axis1 -= (axis1 * constraint_axis) * constraint_axis;
  1163. axis1.normVec();
  1164. // calculate third and final axis
  1165. axis2 = constraint_axis % axis1;
  1166. //F32 axis_onto_cam = llabs( constraint_axis * mCenterToCamNorm );
  1167. if( mCamEdgeOn )
  1168. {
  1169. // We're looking at the ring edge-on.
  1170. LLVector3 snap_plane_center = (center + (constraint_axis * mRadiusMeters * 0.5f));
  1171. LLVector3 cam_to_snap_plane;
  1172. if (mObjectSelection->getSelectType() == SELECT_TYPE_HUD)
  1173. {
  1174. cam_to_snap_plane.setVec(1.f, 0.f, 0.f);
  1175. }
  1176. else
  1177. {
  1178. cam_to_snap_plane = snap_plane_center - gAgent.getCameraPositionAgent();
  1179. cam_to_snap_plane.normVec();
  1180. }
  1181. LLVector3 projected_mouse;
  1182. BOOL hit = getMousePointOnPlaneAgent(projected_mouse, x, y, snap_plane_center, constraint_axis);
  1183. projected_mouse -= snap_plane_center;
  1184. S32 snap_plane = 0;
  1185. F32 dot = cam_to_snap_plane * constraint_axis;
  1186. if (llabs(dot) < 0.01f)
  1187. {
  1188. // looking at ring edge on, project onto view plane and check if mouse is past ring
  1189. getMousePointOnPlaneAgent(projected_mouse, x, y, snap_plane_center, cam_to_snap_plane);
  1190. projected_mouse -= snap_plane_center;
  1191. dot = projected_mouse * constraint_axis;
  1192. if (projected_mouse * constraint_axis > 0)
  1193. {
  1194. snap_plane = 1;
  1195. }
  1196. projected_mouse -= dot * constraint_axis;
  1197. }
  1198. else if (dot > 0.f)
  1199. {
  1200. // look for mouse position outside and in front of snap circle
  1201. if (hit && projected_mouse.magVec() > SNAP_GUIDE_INNER_RADIUS * mRadiusMeters && projected_mouse * cam_to_snap_plane < 0.f)
  1202. {
  1203. snap_plane = 1;
  1204. }
  1205. }
  1206. else
  1207. {
  1208. // look for mouse position inside or in back of snap circle
  1209. if (projected_mouse.magVec() < SNAP_GUIDE_INNER_RADIUS * mRadiusMeters || projected_mouse * cam_to_snap_plane > 0.f || !hit)
  1210. {
  1211. snap_plane = 1;
  1212. }
  1213. }
  1214. if (snap_plane == 0)
  1215. {
  1216. // try other plane
  1217. snap_plane_center = (center - (constraint_axis * mRadiusMeters * 0.5f));
  1218. if (mObjectSelection->getSelectType() == SELECT_TYPE_HUD)
  1219. {
  1220. cam_to_snap_plane.setVec(1.f, 0.f, 0.f);
  1221. }
  1222. else
  1223. {
  1224. cam_to_snap_plane = snap_plane_center - gAgent.getCameraPositionAgent();
  1225. cam_to_snap_plane.normVec();
  1226. }
  1227. hit = getMousePointOnPlaneAgent(projected_mouse, x, y, snap_plane_center, constraint_axis);
  1228. projected_mouse -= snap_plane_center;
  1229. dot = cam_to_snap_plane * constraint_axis;
  1230. if (llabs(dot) < 0.01f)
  1231. {
  1232. // looking at ring edge on, project onto view plane and check if mouse is past ring
  1233. getMousePointOnPlaneAgent(projected_mouse, x, y, snap_plane_center, cam_to_snap_plane);
  1234. projected_mouse -= snap_plane_center;
  1235. dot = projected_mouse * constraint_axis;
  1236. if (projected_mouse * constraint_axis < 0)
  1237. {
  1238. snap_plane = 2;
  1239. }
  1240. projected_mouse -= dot * constraint_axis;
  1241. }
  1242. else if (dot < 0.f)
  1243. {
  1244. // look for mouse position outside and in front of snap circle
  1245. if (hit && projected_mouse.magVec() > SNAP_GUIDE_INNER_RADIUS * mRadiusMeters && projected_mouse * cam_to_snap_plane < 0.f)
  1246. {
  1247. snap_plane = 2;
  1248. }
  1249. }
  1250. else
  1251. {
  1252. // look for mouse position inside or in back of snap circle
  1253. if (projected_mouse.magVec() < SNAP_GUIDE_INNER_RADIUS * mRadiusMeters || projected_mouse * cam_to_snap_plane > 0.f || !hit)
  1254. {
  1255. snap_plane = 2;
  1256. }
  1257. }
  1258. }
  1259. if (snap_plane > 0)
  1260. {
  1261. LLVector3 cam_at_axis;
  1262. if (mObjectSelection->getSelectType() == SELECT_TYPE_HUD)
  1263. {
  1264. cam_at_axis.setVec(1.f, 0.f, 0.f);
  1265. }
  1266. else
  1267. {
  1268. cam_at_axis = snap_plane_center - gAgent.getCameraPositionAgent();
  1269. cam_at_axis.normVec();
  1270. }
  1271. // first, project mouse onto screen plane at point tangent to rotation radius. 
  1272. getMousePointOnPlaneAgent(projected_mouse, x, y, snap_plane_center, cam_at_axis);
  1273. // project that point onto rotation plane
  1274. projected_mouse -= snap_plane_center;
  1275. projected_mouse -= projected_vec(projected_mouse, constraint_axis);
  1276. F32 mouse_lateral_dist = llmin(SNAP_GUIDE_INNER_RADIUS * mRadiusMeters, projected_mouse.magVec());
  1277. F32 mouse_depth = SNAP_GUIDE_INNER_RADIUS * mRadiusMeters;
  1278. if (llabs(mouse_lateral_dist) > 0.01f)
  1279. {
  1280. mouse_depth = sqrtf((SNAP_GUIDE_INNER_RADIUS * mRadiusMeters) * (SNAP_GUIDE_INNER_RADIUS * mRadiusMeters) - 
  1281. (mouse_lateral_dist * mouse_lateral_dist));
  1282. }
  1283. LLVector3 projected_camera_at = cam_at_axis - projected_vec(cam_at_axis, constraint_axis);
  1284. projected_mouse -= mouse_depth * projected_camera_at;
  1285. if (!mInSnapRegime)
  1286. {
  1287. mSmoothRotate = TRUE;
  1288. }
  1289. mInSnapRegime = TRUE;
  1290. // 0 to 360 deg
  1291. F32 mouse_angle = fmodf(atan2(projected_mouse * axis1, projected_mouse * axis2) * RAD_TO_DEG + 360.f, 360.f);
  1292. F32 relative_mouse_angle = fmodf(mouse_angle + (SNAP_ANGLE_DETENTE / 2), SNAP_ANGLE_INCREMENT);
  1293. //fmodf(llround(mouse_angle * RAD_TO_DEG, 7.5f) + 360.f, 360.f);
  1294. LLVector3 object_axis;
  1295. getObjectAxisClosestToMouse(object_axis);
  1296. object_axis = object_axis * first_object_node->mSavedRotation;
  1297. // project onto constraint plane
  1298. object_axis = object_axis - (object_axis * getConstraintAxis()) * getConstraintAxis();
  1299. object_axis.normVec();
  1300. if (relative_mouse_angle < SNAP_ANGLE_DETENTE)
  1301. {
  1302. F32 quantized_mouse_angle = mouse_angle - (relative_mouse_angle - (SNAP_ANGLE_DETENTE * 0.5f));
  1303. angle = (quantized_mouse_angle * DEG_TO_RAD) - atan2(object_axis * axis1, object_axis * axis2);
  1304. }
  1305. else
  1306. {
  1307. angle = (mouse_angle * DEG_TO_RAD) - atan2(object_axis * axis1, object_axis * axis2);
  1308. }
  1309. return LLQuaternion( -angle, constraint_axis );
  1310. }
  1311. else
  1312. {
  1313. if (mInSnapRegime)
  1314. {
  1315. mSmoothRotate = TRUE;
  1316. }
  1317. mInSnapRegime = FALSE;
  1318. LLVector3 up_from_axis = mCenterToCamNorm % constraint_axis;
  1319. up_from_axis.normVec();
  1320. LLVector3 cur_intersection;
  1321. getMousePointOnPlaneAgent(cur_intersection, x, y, center, mCenterToCam);
  1322. cur_intersection -= center;
  1323. mMouseCur = projected_vec(cur_intersection, up_from_axis);
  1324. F32 mouse_depth = SNAP_GUIDE_INNER_RADIUS * mRadiusMeters;
  1325. F32 mouse_dist_sqrd = mMouseCur.magVecSquared();
  1326. if (mouse_dist_sqrd > 0.0001f)
  1327. {
  1328. mouse_depth = sqrtf((SNAP_GUIDE_INNER_RADIUS * mRadiusMeters) * (SNAP_GUIDE_INNER_RADIUS * mRadiusMeters) - 
  1329. mouse_dist_sqrd);
  1330. }
  1331. LLVector3 projected_center_to_cam = mCenterToCamNorm - projected_vec(mCenterToCamNorm, constraint_axis);
  1332. mMouseCur += mouse_depth * projected_center_to_cam;
  1333. F32 dist = (cur_intersection * up_from_axis) - (mMouseDown * up_from_axis);
  1334. angle = dist / (SNAP_GUIDE_INNER_RADIUS * mRadiusMeters) * -F_PI_BY_TWO;
  1335. }
  1336. }
  1337. else
  1338. {
  1339. LLVector3 projected_mouse;
  1340. getMousePointOnPlaneAgent(projected_mouse, x, y, center, constraint_axis);
  1341. projected_mouse -= center;
  1342. mMouseCur = projected_mouse;
  1343. mMouseCur.normVec();
  1344. if (!first_object_node)
  1345. {
  1346. return LLQuaternion::DEFAULT;
  1347. }
  1348. if (gSavedSettings.getBOOL("SnapEnabled") && projected_mouse.magVec() > SNAP_GUIDE_INNER_RADIUS * mRadiusMeters)
  1349. {
  1350. if (!mInSnapRegime)
  1351. {
  1352. mSmoothRotate = TRUE;
  1353. }
  1354. mInSnapRegime = TRUE;
  1355. // 0 to 360 deg
  1356. F32 mouse_angle = fmodf(atan2(projected_mouse * axis1, projected_mouse * axis2) * RAD_TO_DEG + 360.f, 360.f);
  1357. F32 relative_mouse_angle = fmodf(mouse_angle + (SNAP_ANGLE_DETENTE / 2), SNAP_ANGLE_INCREMENT);
  1358. //fmodf(llround(mouse_angle * RAD_TO_DEG, 7.5f) + 360.f, 360.f);
  1359. LLVector3 object_axis;
  1360. getObjectAxisClosestToMouse(object_axis);
  1361. object_axis = object_axis * first_object_node->mSavedRotation;
  1362. // project onto constraint plane
  1363. object_axis = object_axis - (object_axis * getConstraintAxis()) * getConstraintAxis();
  1364. object_axis.normVec();
  1365. if (relative_mouse_angle < SNAP_ANGLE_DETENTE)
  1366. {
  1367. F32 quantized_mouse_angle = mouse_angle - (relative_mouse_angle - (SNAP_ANGLE_DETENTE * 0.5f));
  1368. angle = (quantized_mouse_angle * DEG_TO_RAD) - atan2(object_axis * axis1, object_axis * axis2);
  1369. }
  1370. else
  1371. {
  1372. angle = (mouse_angle * DEG_TO_RAD) - atan2(object_axis * axis1, object_axis * axis2);
  1373. }
  1374. return LLQuaternion( -angle, constraint_axis );
  1375. }
  1376. else
  1377. {
  1378. if (mInSnapRegime)
  1379. {
  1380. mSmoothRotate = TRUE;
  1381. }
  1382. mInSnapRegime = FALSE;
  1383. }
  1384. angle = acos(mMouseCur * mMouseDown);
  1385. F32 dir = (mMouseDown % mMouseCur) * constraint_axis;  // cross product
  1386. if( dir < 0.f )
  1387. {
  1388. angle *= -1.f;
  1389. }
  1390. }
  1391. F32 rot_step = gSavedSettings.getF32("RotationStep");
  1392. F32 step_size = DEG_TO_RAD * rot_step;
  1393. angle -= fmod(angle, step_size);
  1394. return LLQuaternion( angle, constraint_axis );
  1395. }
  1396. LLVector3 LLManipRotate::intersectMouseWithSphere( S32 x, S32 y, const LLVector3& sphere_center, F32 sphere_radius)
  1397. {
  1398. LLVector3 ray_pt;
  1399. LLVector3 ray_dir;
  1400. mouseToRay( x, y, &ray_pt, &ray_dir);
  1401. return intersectRayWithSphere( ray_pt, ray_dir, sphere_center, sphere_radius );
  1402. }
  1403. LLVector3 LLManipRotate::intersectRayWithSphere( const LLVector3& ray_pt, const LLVector3& ray_dir, const LLVector3& sphere_center, F32 sphere_radius)
  1404. {
  1405. LLVector3 ray_pt_to_center = sphere_center - ray_pt;
  1406. F32 center_distance = ray_pt_to_center.normVec();
  1407. F32 dot = ray_dir * ray_pt_to_center;
  1408. if (dot == 0.f)
  1409. {
  1410. return LLVector3::zero;
  1411. }
  1412. // point which ray hits plane centered on sphere origin, facing ray origin
  1413. LLVector3 intersection_sphere_plane = ray_pt + (ray_dir * center_distance / dot); 
  1414. // vector from sphere origin to the point, normalized to sphere radius
  1415. LLVector3 sphere_center_to_intersection = (intersection_sphere_plane - sphere_center) / sphere_radius;
  1416. F32 dist_squared = sphere_center_to_intersection.magVecSquared();
  1417. LLVector3 result;
  1418. if (dist_squared > 1.f)
  1419. {
  1420. result = sphere_center_to_intersection;
  1421. result.normVec();
  1422. }
  1423. else
  1424. {
  1425. result = sphere_center_to_intersection - ray_dir * sqrt(1.f - dist_squared);
  1426. }
  1427. return result;
  1428. }
  1429. // Utility function.  Should probably be moved to another class.
  1430. //static
  1431. void LLManipRotate::mouseToRay( S32 x, S32 y, LLVector3* ray_pt, LLVector3* ray_dir )
  1432. {
  1433. if (LLSelectMgr::getInstance()->getSelection()->getSelectType() == SELECT_TYPE_HUD)
  1434. {
  1435. F32 mouse_x = (((F32)x / gViewerWindow->getWorldViewRectScaled().getWidth()) - 0.5f) / gAgent.mHUDCurZoom;
  1436. F32 mouse_y = ((((F32)y) / gViewerWindow->getWorldViewRectScaled().getHeight()) - 0.5f) / gAgent.mHUDCurZoom;
  1437. *ray_pt = LLVector3(-1.f, -mouse_x, mouse_y);
  1438. *ray_dir = LLVector3(1.f, 0.f, 0.f);
  1439. }
  1440. else
  1441. {
  1442. *ray_pt = gAgent.getCameraPositionAgent();
  1443. LLViewerCamera::getInstance()->projectScreenToPosAgent(x, y, ray_dir);
  1444. *ray_dir -= *ray_pt;
  1445. ray_dir->normVec();
  1446. }
  1447. }
  1448. void LLManipRotate::highlightManipulators( S32 x, S32 y )
  1449. {
  1450. mHighlightedPart = LL_NO_PART;
  1451. //LLBBox bbox = LLSelectMgr::getInstance()->getBBoxOfSelection();
  1452. LLViewerObject *first_object = mObjectSelection->getFirstMoveableObject(TRUE);
  1453. if (!first_object)
  1454. {
  1455. return;
  1456. }
  1457. LLQuaternion object_rot = first_object->getRenderRotation();
  1458. LLVector3 rotation_center = gAgent.getPosAgentFromGlobal(mRotationCenter);
  1459. LLVector3 mouse_dir_x;
  1460. LLVector3 mouse_dir_y;
  1461. LLVector3 mouse_dir_z;
  1462. LLVector3 intersection_roll;
  1463. LLVector3 grid_origin;
  1464. LLVector3 grid_scale;
  1465. LLQuaternion grid_rotation;
  1466. LLSelectMgr::getInstance()->getGrid(grid_origin, grid_rotation, grid_scale);
  1467. LLVector3 rot_x_axis = LLVector3::x_axis * grid_rotation;
  1468. LLVector3 rot_y_axis = LLVector3::y_axis * grid_rotation;
  1469. LLVector3 rot_z_axis = LLVector3::z_axis * grid_rotation;
  1470. F32 proj_rot_x_axis = llabs(rot_x_axis * mCenterToCamNorm);
  1471. F32 proj_rot_y_axis = llabs(rot_y_axis * mCenterToCamNorm);
  1472. F32 proj_rot_z_axis = llabs(rot_z_axis * mCenterToCamNorm);
  1473. F32 min_select_distance = 0.f;
  1474. F32 cur_select_distance = 0.f;
  1475. // test x
  1476. getMousePointOnPlaneAgent(mouse_dir_x, x, y, rotation_center, rot_x_axis);
  1477. mouse_dir_x -= rotation_center;
  1478. // push intersection point out when working at obtuse angle to make ring easier to hit
  1479. mouse_dir_x *= 1.f + (1.f - llabs(rot_x_axis * mCenterToCamNorm)) * 0.1f;
  1480. // test y
  1481. getMousePointOnPlaneAgent(mouse_dir_y, x, y, rotation_center, rot_y_axis);
  1482. mouse_dir_y -= rotation_center;
  1483. mouse_dir_y *= 1.f + (1.f - llabs(rot_y_axis * mCenterToCamNorm)) * 0.1f;
  1484. // test z
  1485. getMousePointOnPlaneAgent(mouse_dir_z, x, y, rotation_center, rot_z_axis);
  1486. mouse_dir_z -= rotation_center;
  1487. mouse_dir_z *= 1.f + (1.f - llabs(rot_z_axis * mCenterToCamNorm)) * 0.1f;
  1488. // test roll
  1489. getMousePointOnPlaneAgent(intersection_roll, x, y, rotation_center, mCenterToCamNorm);
  1490. intersection_roll -= rotation_center;
  1491. F32 dist_x = mouse_dir_x.normVec();
  1492. F32 dist_y = mouse_dir_y.normVec();
  1493. F32 dist_z = mouse_dir_z.normVec();
  1494. F32 distance_threshold = (MAX_MANIP_SELECT_DISTANCE * mRadiusMeters) / gViewerWindow->getWorldViewHeightScaled();
  1495. if (llabs(dist_x - mRadiusMeters) * llmax(0.05f, proj_rot_x_axis) < distance_threshold)
  1496. {
  1497. // selected x
  1498. cur_select_distance = dist_x * mouse_dir_x * mCenterToCamNorm;
  1499. if (cur_select_distance >= -0.05f && (min_select_distance == 0.f || cur_select_distance > min_select_distance))
  1500. {
  1501. min_select_distance = cur_select_distance;
  1502. mHighlightedPart = LL_ROT_X;
  1503. }
  1504. }
  1505. if (llabs(dist_y - mRadiusMeters) * llmax(0.05f, proj_rot_y_axis) < distance_threshold)
  1506. {
  1507. // selected y
  1508. cur_select_distance = dist_y * mouse_dir_y * mCenterToCamNorm;
  1509. if (cur_select_distance >= -0.05f && (min_select_distance == 0.f || cur_select_distance > min_select_distance))
  1510. {
  1511. min_select_distance = cur_select_distance;
  1512. mHighlightedPart = LL_ROT_Y;
  1513. }
  1514. }
  1515. if (llabs(dist_z - mRadiusMeters) * llmax(0.05f, proj_rot_z_axis) < distance_threshold)
  1516. {
  1517. // selected z
  1518. cur_select_distance = dist_z * mouse_dir_z * mCenterToCamNorm;
  1519. if (cur_select_distance >= -0.05f && (min_select_distance == 0.f || cur_select_distance > min_select_distance))
  1520. {
  1521. min_select_distance = cur_select_distance;
  1522. mHighlightedPart = LL_ROT_Z;
  1523. }
  1524. }
  1525. // test for edge-on intersections
  1526. if (proj_rot_x_axis < 0.05f)
  1527. {
  1528. if ((proj_rot_y_axis > 0.05f && (dist_y * llabs(mouse_dir_y * rot_x_axis) < distance_threshold) && dist_y < mRadiusMeters) ||
  1529. (proj_rot_z_axis > 0.05f && (dist_z * llabs(mouse_dir_z * rot_x_axis) < distance_threshold) && dist_z < mRadiusMeters))
  1530. {
  1531. mHighlightedPart = LL_ROT_X;
  1532. }
  1533. }
  1534. if (proj_rot_y_axis < 0.05f)
  1535. {
  1536. if ((proj_rot_x_axis > 0.05f && (dist_x * llabs(mouse_dir_x * rot_y_axis) < distance_threshold) && dist_x < mRadiusMeters) ||
  1537. (proj_rot_z_axis > 0.05f && (dist_z * llabs(mouse_dir_z * rot_y_axis) < distance_threshold) && dist_z < mRadiusMeters))
  1538. {
  1539. mHighlightedPart = LL_ROT_Y;
  1540. }
  1541. }
  1542. if (proj_rot_z_axis < 0.05f)
  1543. {
  1544. if ((proj_rot_x_axis > 0.05f && (dist_x * llabs(mouse_dir_x * rot_z_axis) < distance_threshold) && dist_x < mRadiusMeters) ||
  1545. (proj_rot_y_axis > 0.05f && (dist_y * llabs(mouse_dir_y * rot_z_axis) < distance_threshold) && dist_y < mRadiusMeters))
  1546. {
  1547. mHighlightedPart = LL_ROT_Z;
  1548. }
  1549. }
  1550. // test for roll
  1551. if (mHighlightedPart == LL_NO_PART)
  1552. {
  1553. F32 roll_distance = intersection_roll.magVec();
  1554. F32 width_meters = WIDTH_PIXELS * mRadiusMeters / RADIUS_PIXELS;
  1555. // use larger distance threshold for roll as it is checked only if something else wasn't highlighted
  1556. if (llabs(roll_distance - (mRadiusMeters + (width_meters * 2.f))) < distance_threshold * 2.f)
  1557. {
  1558. mHighlightedPart = LL_ROT_ROLL;
  1559. }
  1560. else if (roll_distance < mRadiusMeters)
  1561. {
  1562. mHighlightedPart = LL_ROT_GENERAL;
  1563. }
  1564. }
  1565. }
  1566. S32 LLManipRotate::getObjectAxisClosestToMouse(LLVector3& object_axis)
  1567. {
  1568. LLSelectNode* first_object_node = mObjectSelection->getFirstMoveableNode(TRUE);
  1569. if (!first_object_node)
  1570. {
  1571. object_axis.clearVec();
  1572. return -1;
  1573. }
  1574. LLQuaternion obj_rotation = first_object_node->mSavedRotation;
  1575. LLVector3 mouse_down_object = mMouseDown * ~obj_rotation;
  1576. LLVector3 mouse_down_abs = mouse_down_object;
  1577. mouse_down_abs.abs();
  1578. S32 axis_index = 0;
  1579. if (mouse_down_abs.mV[VX] > mouse_down_abs.mV[VY] && mouse_down_abs.mV[VX] > mouse_down_abs.mV[VZ])
  1580. {
  1581. if (mouse_down_object.mV[VX] > 0.f)
  1582. {
  1583. object_axis = LLVector3::x_axis;
  1584. }
  1585. else
  1586. {
  1587. object_axis = LLVector3::x_axis_neg;
  1588. }
  1589. axis_index = VX;
  1590. }
  1591. else if (mouse_down_abs.mV[VY] > mouse_down_abs.mV[VZ])
  1592. {
  1593. if (mouse_down_object.mV[VY] > 0.f)
  1594. {
  1595. object_axis = LLVector3::y_axis;
  1596. }
  1597. else
  1598. {
  1599. object_axis = LLVector3::y_axis_neg;
  1600. }
  1601. axis_index = VY;
  1602. }
  1603. else
  1604. {
  1605. if (mouse_down_object.mV[VZ] > 0.f)
  1606. {
  1607. object_axis = LLVector3::z_axis;
  1608. }
  1609. else
  1610. {
  1611. object_axis = LLVector3::z_axis_neg;
  1612. }
  1613. axis_index = VZ;
  1614. }
  1615. return axis_index;
  1616. }
  1617. //virtual
  1618. BOOL LLManipRotate::canAffectSelection()
  1619. {
  1620. BOOL can_rotate = mObjectSelection->getObjectCount() != 0;
  1621. if (can_rotate)
  1622. {
  1623. struct f : public LLSelectedObjectFunctor
  1624. {
  1625. virtual bool apply(LLViewerObject* objectp)
  1626. {
  1627. return objectp->permMove() && (objectp->permModify() || !gSavedSettings.getBOOL("EditLinkedParts"));
  1628. }
  1629. } func;
  1630. can_rotate = mObjectSelection->applyToObjects(&func);
  1631. }
  1632. return can_rotate;
  1633. }