LibGame  v0.4.0
The LG Game Engine - Copyright (C) 2024-2025 ETMSoftware
lg_quaternions.h
1 /*
2  * LibGame - Copyright (C) Emmanuel Thomas-Maurin 2011-2025
3  * All rights reserved
4  */
5 
6 #ifndef LG_QUATERNIONS_H
7 #define LG_QUATERNIONS_H
8 
9 #define POW2(x) (x * x)
10 #define POW3(x) (x * x * x)
11 
12 #define RAD_TO_DEG 57.295779513 /* or (180.0 / (float)M_PI) */
13 #define DEG_TO_RAD 0.017453293 /* or ((float)M_PI / 180.0) */
14 
15 /* Euler angles */
16 typedef struct {
17  double x_rot; /* Rotation around X axis in radians - Use DEG_TO_RAD macro when necessary */
18  double y_rot;
19  double z_rot;
20 } LG_EulerAng;
21 
22 /* Axis and angle */
23 typedef struct {
24  vec3_t axis; /* Unit vector - should/must always be normalized ? */
25  double angle; /* In radians */
26 } LG_AxAng;
27 
28 /* Quaternion */
29 typedef struct {
30  double x; /* Vector part */
31  double y;
32  double z;
33  double w; /* Scalar part */
34 } LG_Quat;
35 
36 /* 3 x 3, column-major order matrix -> move that to math_3d.h ? */
37 typedef union {
38  float m[3][3];
39  struct {
40  float m00, m01, m02;
41  float m10, m11, m12;
42  float m20, m21, m22;
43  };
44 } mat3_t;
45 
46 #define ROT_SEQ "XYZ"
47 /*
48  * Convenient precomputed quat values
49  *
50  * half_pi_up = -(M_PI / 2.0) * 0.925
51  * half_pi_down = -(M_PI / 2.0) * 1.15
52  */
53 typedef struct {
54  LG_Quat id;
55  LG_Quat x_pi;
56  LG_Quat x_half_pi;
57  LG_Quat x_half_pi_inv;
58  LG_Quat x_half_pi_up;
59  LG_Quat x_half_pi_down;
60  LG_Quat y_pi;
61  LG_Quat y_half_pi;
62  LG_Quat y_half_pi_inv;
63  LG_Quat y_half_pi_up;
64  LG_Quat y_half_pi_down;
65  LG_Quat z_pi;
66  LG_Quat z_half_pi;
67  LG_Quat z_half_pi_inv;
68  LG_Quat z_half_pi_up;
69  LG_Quat z_half_pi_down;
70  LG_Quat x_small;
71  LG_Quat x_small_inv;
72  LG_Quat y_small;
73  LG_Quat y_small_inv;
74  LG_Quat z_small;
75  LG_Quat z_small_inv;
76 } LG_QuatV;
77 
78 LG_Quat lg_quat(double, double, double, double);
79 
81 
83 
85 
87 
89 
91 
93 
95 
97 
98 int lg_quat_copy(LG_Quat *, const LG_Quat *);
99 
100 zboolean lg_quats_are_equal(LG_Quat *, LG_Quat *);
101 
102 void lg_quat_conjugate(LG_Quat *);
103 
105 
106 void lg_quat_invert(LG_Quat *);
107 
109 
110 double lg_quat_magnitude(LG_Quat);
111 
112 double lg_quats_dot(LG_Quat *, LG_Quat *);
113 
115 
117 
118 LG_Quat lg_quat_slerp(LG_Quat *, LG_Quat *, float);
119 
120 LG_EulerAng lg_euler_ang(double, double, double);
121 
122 LG_AxAng lg_axis_ang(vec3_t, double);
123 
125 
126 mat3_t mat3(float, float, float, float, float, float, float, float, float);
127 
129 
130 LG_QuatV *lg_quatv();
131 
132 /* === WARNING: FOLLOWING STUFF IS EXPERIMENTAL - USEFUL ? === */
133 
135 
137 
138 float lg_quat_get_yaw(LG_Quat *);
139 
140 float lg_quat_get_pitch(LG_Quat *);
141 
142 float lg_quat_get_roll(LG_Quat *);
143 
144 #endif /* LG_QUATERNIONS_H */
lg_axis_ang
LG_AxAng lg_axis_ang(vec3_t axis, double angle)
Definition: lg_quaternions.c:530
mat3_t
Definition: lg_quaternions.h:37
lg_euler_ang
LG_EulerAng lg_euler_ang(double x_rot, double y_rot, double z_rot)
Definition: lg_quaternions.c:510
lg_quat_normalize
void lg_quat_normalize(LG_Quat *q)
Definition: lg_quaternions.c:35
LG_Quat
Definition: lg_quaternions.h:29
mat3
mat3_t mat3(float m00, float m10, float m20, float m01, float m11, float m21, float m02, float m12, float m22)
Definition: lg_quaternions.c:624
lg_quat_to_axis_angle
void lg_quat_to_axis_angle(LG_Quat q, LG_AxAng *axis_ang)
Definition: lg_quaternions.c:189
lg_quat_from_euler_ang
LG_Quat lg_quat_from_euler_ang(LG_EulerAng an, const char *rot_order)
Definition: lg_quaternions.c:112
lg_quat_conjugate
void lg_quat_conjugate(LG_Quat *q)
Definition: lg_quaternions.c:339
LG_EulerAng
Definition: lg_quaternions.h:16
lg_quat
LG_Quat lg_quat(double x, double y, double z, double w)
Definition: lg_quaternions.c:23
LG_QuatV
Definition: lg_quaternions.h:53
lg_quat_get_conjugate
LG_Quat lg_quat_get_conjugate(LG_Quat q)
Definition: lg_quaternions.c:352
lg_quat_rotate_vec3
vec3_t lg_quat_rotate_vec3(LG_Quat q, vec3_t v)
Definition: lg_quaternions.c:282
lg_quat_magnitude
double lg_quat_magnitude(LG_Quat q)
Definition: lg_quaternions.c:393
lg_quat_slerp
LG_Quat lg_quat_slerp(LG_Quat *q_1, LG_Quat *q_2, float slerp_k)
Definition: lg_quaternions.c:449
lg_quat_get_roll
float lg_quat_get_roll(LG_Quat *q)
Definition: lg_quaternions.c:827
lg_quat_to_rot_matrix
mat4_t lg_quat_to_rot_matrix(LG_Quat q2)
Definition: lg_quaternions.c:258
vec3_t
Definition: math_3d.h:128
lg_quat_get_pitch
float lg_quat_get_pitch(LG_Quat *q)
Definition: lg_quaternions.c:815
lg_quat_set_identity
void lg_quat_set_identity(LG_Quat *q)
Definition: lg_quaternions.c:417
lg_quat_get_identity
LG_Quat lg_quat_get_identity()
Definition: lg_quaternions.c:430
lg_quatv
LG_QuatV * lg_quatv()
Definition: lg_quaternions.c:683
lg_axis_angle_to_euler_ang
LG_EulerAng lg_axis_angle_to_euler_ang(LG_AxAng axis_ang)
Definition: lg_quaternions.c:563
lg_quat_get_yaw
float lg_quat_get_yaw(LG_Quat *q)
Definition: lg_quaternions.c:803
m3_transpose
mat3_t m3_transpose(mat3_t matrix)
Definition: lg_quaternions.c:644
lg_quats_multiply
LG_Quat lg_quats_multiply(LG_Quat q1, LG_Quat q2)
Definition: lg_quaternions.c:80
lg_quat_get_normalized
LG_Quat lg_quat_get_normalized(LG_Quat q)
Definition: lg_quaternions.c:60
lg_quat_copy
int lg_quat_copy(LG_Quat *q_dest, const LG_Quat *q_src)
Definition: lg_quaternions.c:300
lg_quat_from_3x3_rot_matrix
LG_Quat lg_quat_from_3x3_rot_matrix(mat3_t m)
Definition: lg_quaternions.c:221
lg_quat_get_invert
LG_Quat lg_quat_get_invert(LG_Quat q)
Definition: lg_quaternions.c:379
LG_AxAng
Definition: lg_quaternions.h:23
lg_quat_get_yaw_pitch_roll
vec3_t lg_quat_get_yaw_pitch_roll(LG_Quat *q)
Definition: lg_quaternions.c:791
lg_quats_dot
double lg_quats_dot(LG_Quat *q1, LG_Quat *q2)
Definition: lg_quaternions.c:405
lg_quat_to_euler_ang
LG_EulerAng lg_quat_to_euler_ang(LG_Quat q)
Definition: lg_quaternions.c:756
lg_quats_are_equal
zboolean lg_quats_are_equal(LG_Quat *q1, LG_Quat *q2)
Definition: lg_quaternions.c:323
lg_quat_from_axis_angle
LG_Quat lg_quat_from_axis_angle(LG_AxAng axis_ang)
Definition: lg_quaternions.c:167
lg_quat_invert
void lg_quat_invert(LG_Quat *q)
Definition: lg_quaternions.c:367
mat4_t
Definition: math_3d.h:184