Modeling: Snap 3d cursor rotation to active #112718

Open
MohammadHossein Jamshidi wants to merge 4 commits from Jam3D/blender:snap_3dcursor_rotation_to_active into main

When changing the target branch, be careful to rebase the branch in your fork to match. See documentation.
7 changed files with 246 additions and 2 deletions

View File

@ -27,6 +27,7 @@ void unit_m2(float m[2][2]);
void unit_m3(float m[3][3]);
void unit_m4(float m[4][4]);
void unit_m4_db(double m[4][4]);
void m3_from_single_axis(float mat3[3][3], const float axis[3], const int axis_index);
void copy_m2_m2(float m1[2][2], const float m2[2][2]);
void copy_m3_m3(float m1[3][3], const float m2[3][3]);
@ -455,6 +456,12 @@ void rescale_m4(float mat[4][4], const float scale[3]);
*/
void transform_pivot_set_m4(float mat[4][4], const float pivot[3]);
/**
* \param rot: A 3x3 rotation matrix, skewness considered,
* one primary axis is conserved, normalized never negative.
*/
void remove_skew_m3_m3(float mat3[3][3], const float wmat[3][3], const int fixed_axis);
/**
* \param rot: A 3x3 rotation matrix, normalized never negative.
*/

View File

@ -69,6 +69,40 @@ void unit_m4_db(double m[4][4])
m[3][0] = m[3][1] = m[3][2] = 0.0f;
}
void m3_from_single_axis(float mat3[3][3], const float axis[3], const int axis_index)
{
float len, vec[3], world_ax[3];
int ax_i = mod_i(axis_index, 3);
zero_v3(world_ax);
world_ax[ax_i] = 1;
// 1st axis
normalize_v3_v3(mat3[ax_i], axis);
if (compare_v3v3(mat3[ax_i], world_ax, FLT_EPSILON)) {
unit_m3(mat3);
return;
}
// check not to generate zero axes
cross_v3_v3v3(vec, mat3[ax_i], world_ax);
len = len_v3(vec);
if (compare_ff(len, 0, 0.01f)) {
zero_v3(vec);
vec[mod_i((ax_i - 1), 3)] = 1;
}
else {
copy_v3_v3(vec, world_ax);
}
// remaining axes
for (int i = 0; i < 2; i++) {
ax_i = mod_i((ax_i - 1), 3);
cross_v3_v3v3(mat3[ax_i], vec, axis);
len = normalize_v3(mat3[ax_i]);
copy_v3_v3(vec, mat3[ax_i]);
}
if (UNLIKELY(is_negative_m3(mat3))) {
negate_m3(mat3);
}
}
void copy_m2_m2(float m1[2][2], const float m2[2][2])
{
memcpy(m1, m2, sizeof(float[2][2]));
@ -2210,6 +2244,29 @@ void mat3_to_rot_size(float rot[3][3], float size[3], const float mat3[3][3])
}
}
/* Makes a skewed rotation matrices, keeps an axis fixed,
* and orthogonalizes the other two with respect to fixed axis
*/
void remove_skew_m3_m3(float mat3[3][3], const float wmat[3][3], const int fixed_axis)
{
int cur_axis, prev_axis, f_axis = mod_i(fixed_axis, 3);
float proj[3];
normalize_v3_v3(mat3[f_axis], wmat[f_axis]); // Keep fixed axis as is
for (int i = 1; i <= 2; i++) { // For the two remaining axes do orthogonalization
cur_axis = mod_i((f_axis + i), 3);
copy_v3_v3(mat3[cur_axis], wmat[cur_axis]);
for (int j = f_axis; j < f_axis + i; j++) { // Make it perpendicular to previous axes
prev_axis = mod_i(j, 3);
project_v3_v3v3(proj, mat3[cur_axis], mat3[prev_axis]);
sub_v3_v3(mat3[cur_axis], proj);
}
normalize_v3(mat3[cur_axis]);
}
if (UNLIKELY(is_negative_m3(mat3))) {
negate_m3(mat3);
}
}
void mat4_to_rot(float rot[3][3], const float wmat[4][4])
{
normalize_v3_v3(rot[0], wmat[0]);

View File

@ -12,6 +12,7 @@
#include "MEM_guardedalloc.h"
#include "BLI_listbase.h"
#include "BLI_math_matrix.h"
#include "BLI_math_vector.h"
#include "BKE_curve.h"
@ -242,4 +243,23 @@ bool ED_curve_active_center(Curve *cu, float center[3])
return true;
}
bool ED_curve_active_rot(Curve *cu, float rot[3][3])
{
float _axis[3];
Nurb *nu = nullptr;
void *vert = nullptr;
if (!BKE_curve_nurb_vert_active_get(cu, &nu, &vert)) {
return false;
}
if (nu->type == CU_BEZIER) {
BezTriple *bezt = (BezTriple *)vert;
sub_v3_v3v3(_axis, bezt->vec[2], bezt->vec[1]);
m3_from_single_axis(rot, _axis, 1);
}
else {
unit_m3(rot);
}
return true;
}
/** \} */

View File

@ -100,6 +100,8 @@ int ED_curve_updateAnimPaths(Main *bmain, Curve *cu);
bool ED_curve_active_center(Curve *cu, float center[3]);
bool ED_curve_active_rot(Curve *cu, float rot[3][3]);
/**
* Text box selection.
*

View File

@ -71,6 +71,12 @@ bool ED_object_calc_active_center_for_editmode(Object *obedit,
bool ED_object_calc_active_center_for_posemode(Object *ob, bool select_only, float r_center[3]);
bool ED_object_calc_active_center(Object *ob, bool select_only, float r_center[3]);
bool ED_object_calc_active_world_rot_for_editmode(Object *obedit,
bool select_only,
float r_rot[3][3]);
bool ED_object_calc_active_rot_for_posemode(Object *ob, bool select_only, float r_rot[3][3]);
bool ED_object_calc_active_rot(Object *ob, const bool select_only, float r_rot[3][3]);
/* Object Data Container helper API. */
struct XFormObjectData_Container;
XFormObjectData_Container *ED_object_data_xform_container_create();

View File

@ -136,6 +136,110 @@ bool ED_object_calc_active_center(Object *ob, const bool select_only, float r_ce
return false;
}
// Functions for getting the rotation of active element
bool ED_object_calc_active_world_rot_for_editmode(Object *obedit,
bool select_only,
float r_rot[3][3])
{
switch (obedit->type) {
case OB_MESH: {
BMEditMesh *em = BKE_editmesh_from_object(obedit);
BMEditSelection ese;
if (BM_select_history_active_get(em->bm, &ese)) {
float _axis[3];
BM_editselection_normal(&ese, _axis);
m3_from_single_axis(r_rot, _axis, 2);
mul_m3_m4m3(r_rot, obedit->object_to_world, r_rot);
remove_skew_m3_m3(r_rot, r_rot, 0);
return true;
}
break;
}
case OB_ARMATURE: {
bArmature *arm = static_cast<bArmature *>(obedit->data);
EditBone *ebo = arm->act_edbone;
if (ebo && (!select_only || (ebo->flag & (BONE_SELECTED | BONE_ROOTSEL)))) {
copy_m3_m4(r_rot, ebo->disp_mat);
mul_m3_m4m3(r_rot, obedit->object_to_world, r_rot);
remove_skew_m3_m3(r_rot, r_rot, 1);
return true;
}
break;
}
case OB_CURVES_LEGACY:
case OB_SURF: {
Curve *cu = static_cast<Curve *>(obedit->data);
if (ED_curve_active_rot(cu, r_rot)) {
mul_m3_m4m3(r_rot, obedit->object_to_world, r_rot);
remove_skew_m3_m3(r_rot, r_rot, 1);
return true;
}
break;
}
case OB_MBALL: {
MetaBall *mb = static_cast<MetaBall *>(obedit->data);
MetaElem *ml_act = mb->lastelem;
if (ml_act && (!select_only || (ml_act->flag & SELECT))) {
copy_m3_m4(r_rot, obedit->object_to_world);
remove_skew_m3_m3(r_rot, r_rot, 2);
return true;
}
break;
}
case OB_LATTICE: {
BPoint *actbp = BKE_lattice_active_point_get(static_cast<Lattice *>(obedit->data));
if (actbp) {
copy_m3_m4(r_rot, obedit->object_to_world);
remove_skew_m3_m3(r_rot, r_rot, 2);
return true;
}
break;
}
}
return false;
}
bool ED_object_calc_active_rot_for_posemode(Object *ob, bool select_only, float r_rot[3][3])
{
bPoseChannel *pchan = BKE_pose_channel_active_if_bonecoll_visible(ob);
if (pchan && (!select_only || (pchan->bone->flag & BONE_SELECTED))) {
copy_m3_m4(r_rot, pchan->pose_mat);
return true;
}
return false;
}
bool ED_object_calc_active_rot(Object *ob, const bool select_only, float r_rot[3][3])
{
if (ob->mode & OB_MODE_EDIT) {
if (ED_object_calc_active_world_rot_for_editmode(ob, select_only, r_rot)) {
return true;
}
return false;
}
if (ob->mode & OB_MODE_POSE) {
if (ED_object_calc_active_rot_for_posemode(ob, select_only, r_rot)) {
mul_m3_m4m3(r_rot, ob->object_to_world, r_rot);
remove_skew_m3_m3(r_rot, r_rot, 1);
return true;
}
return false;
}
if (!select_only || (ob->base_flag & BASE_SELECTED)) {
copy_m3_m4(r_rot, ob->object_to_world);
remove_skew_m3_m3(r_rot, r_rot, 2);
return true;
}
return false;
}
/** \} */
/* -------------------------------------------------------------------- */

View File

@ -600,6 +600,19 @@ bool ED_view3d_snap_selected_to_location(bContext *C,
/** \name Snap Selection to Cursor Operator
* \{ */
enum {
SNAP_LOC = 0,
SNAP_ROT,
SNAP_LOC_ROT,
};
static const EnumPropertyItem snap_transform_mode_items[] = {
{SNAP_LOC, "LOC", 0, "Location", ""},
{SNAP_ROT, "ROT", 0, "Rotation", ""},
{SNAP_LOC_ROT, "LOC_ROT", 0, "Location & Rotation", ""},
{0, nullptr, 0, nullptr, nullptr},
};
static int snap_selected_to_cursor_exec(bContext *C, wmOperator *op)
{
const bool use_offset = RNA_boolean_get(op->ptr, "use_offset");
@ -930,11 +943,43 @@ static bool snap_calc_active_center(bContext *C, const bool select_only, float r
return ED_object_calc_active_center(ob, select_only, r_center);
}
static int snap_curs_to_active_exec(bContext *C, wmOperator * /*op*/)
static bool snap_calc_active_rot(bContext *C, const bool select_only, float r_rot[3][3])
{
Object *ob = CTX_data_active_object(C);
if (ob == nullptr) {
return false;
}
return ED_object_calc_active_rot(ob, select_only, r_rot);
}
static int snap_curs_to_active_exec(bContext *C, wmOperator *op)
{
Scene *scene = CTX_data_scene(C);
const int snap_mode = RNA_enum_get(op->ptr, "snap_mode");
bool is_snap_done = false, is_loc_done = false, is_rot_done = false;
float r_center[3], r_rot[3][3];
switch (snap_mode) {
case SNAP_LOC:
is_loc_done = is_snap_done = snap_calc_active_center(C, false, r_center);
break;
case SNAP_ROT:
is_rot_done = is_snap_done = snap_calc_active_rot(C, false, r_rot);
break;
case SNAP_LOC_ROT:
is_loc_done = is_rot_done = is_snap_done = snap_calc_active_center(C, false, r_center) &
snap_calc_active_rot(C, false, r_rot);
break;
if (snap_calc_active_center(C, false, scene->cursor.location)) {
default:
break;
}
if (is_snap_done) {
if (is_loc_done) {
copy_v3_v3(scene->cursor.location, r_center);
}
if (is_rot_done) {
BKE_scene_cursor_mat3_to_rot(&scene->cursor, r_rot, false);
}
WM_event_add_notifier(C, NC_SPACE | ND_SPACE_VIEW3D, nullptr);
DEG_id_tag_update(&scene->id, ID_RECALC_COPY_ON_WRITE);
@ -956,6 +1001,9 @@ void VIEW3D_OT_snap_cursor_to_active(wmOperatorType *ot)
/* flags */
ot->flag = OPTYPE_REGISTER | OPTYPE_UNDO;
/* properties */
ot->prop = RNA_def_enum(ot->srna, "snap_mode", snap_transform_mode_items, 0, "Snap Mode", "");
}
/** \} */