Differential D15346 Diff 53840 source/blender/blenlib/intern/math_rotation.cc

Changeset View

Standalone View

Show All 17 Lines	float3 rotate_direction_around_axis(const float3 &direction, const float3 &axis, const float angle)

const float3 axis_scaled = axis * math::dot(direction, axis);		const float3 axis_scaled = axis * math::dot(direction, axis);
const float3 diff = direction - axis_scaled;		const float3 diff = direction - axis_scaled;
const float3 cross = math::cross(axis, diff);		const float3 cross = math::cross(axis, diff);

return axis_scaled + diff * std::cos(angle) + cross * std::sin(angle);		return axis_scaled + diff * std::cos(angle) + cross * std::sin(angle);
}		}

		float3 rotate_around_axis(const float3 &vector,
		const float3 &center,
		const float3 &axis,
		const float angle)

		{
		float3 result = vector - center;
		float mat[3][3];
		axis_angle_normalized_to_mat3(mat, axis, angle);
		mul_m3_v3(mat, result);
		return result + center;
		}

} // namespace blender::math		} // namespace blender::math