blob: 091e8af85d97d2aa557ba5f43de222191ad4b9d1 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
|
/* SPDX-License-Identifier: GPL-2.0-or-later */
/** \file
* \ingroup bli
*/
#include "BLI_math_base.h"
#include "BLI_math_rotation.hh"
#include "BLI_math_vector.h"
#include "BLI_math_vector.hh"
namespace blender::math {
float3 rotate_direction_around_axis(const float3 &direction, const float3 &axis, const float angle)
{
BLI_ASSERT_UNIT_V3(direction);
BLI_ASSERT_UNIT_V3(axis);
const float3 axis_scaled = axis * math::dot(direction, axis);
const float3 diff = direction - axis_scaled;
const float3 cross = math::cross(axis, diff);
return axis_scaled + diff * std::cos(angle) + cross * std::sin(angle);
}
float3 rotate_around_axis(const float3 &vector,
const float3 ¢er,
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
|