Приаведение тангенса (tangent) к единому виду с другими сущностями, добавлено комплексное произведение двумерных векторов
This commit is contained in:
parent
896c8615f5
commit
fcbec62024
5 changed files with 182 additions and 114 deletions
|
|
@ -93,7 +93,7 @@ BgFP32Versor * make_random_versors(const unsigned int amount)
|
||||||
|
|
||||||
void print_versor(const BgFP32Versor* versor)
|
void print_versor(const BgFP32Versor* versor)
|
||||||
{
|
{
|
||||||
printf("Versor (%f, %f, %f, %f); Delta = %e\n", versor->s0, versor->x1, versor->x2, versor->x3, bg_fp32_versor_get_modulus(versor) - 1.0f);
|
printf("Versor (%f, %f, %f, %f)\n", versor->s0, versor->x1, versor->x2, versor->x3);
|
||||||
}
|
}
|
||||||
|
|
||||||
void print_vector(const BgFP32Vector3* vector)
|
void print_vector(const BgFP32Vector3* vector)
|
||||||
|
|
|
||||||
|
|
@ -74,6 +74,10 @@
|
||||||
<Option compilerVar="CC" />
|
<Option compilerVar="CC" />
|
||||||
</Unit>
|
</Unit>
|
||||||
<Unit filename="rotation3.h" />
|
<Unit filename="rotation3.h" />
|
||||||
|
<Unit filename="tangent.c">
|
||||||
|
<Option compilerVar="CC" />
|
||||||
|
</Unit>
|
||||||
|
<Unit filename="tangent.h" />
|
||||||
<Unit filename="vector2.c">
|
<Unit filename="vector2.c">
|
||||||
<Option compilerVar="CC" />
|
<Option compilerVar="CC" />
|
||||||
</Unit>
|
</Unit>
|
||||||
|
|
|
||||||
|
|
@ -8,16 +8,30 @@
|
||||||
#include "vector2.h"
|
#include "vector2.h"
|
||||||
#include "matrix2x2.h"
|
#include "matrix2x2.h"
|
||||||
|
|
||||||
|
// =================== Types ==================== //
|
||||||
|
|
||||||
typedef struct
|
typedef struct
|
||||||
{
|
{
|
||||||
float _cos, _sin;
|
const float cos, sin;
|
||||||
} BgFP32Tangent;
|
} BgFP32Tangent;
|
||||||
|
|
||||||
typedef struct
|
typedef struct
|
||||||
{
|
{
|
||||||
double _cos, _sin;
|
const double cos, sin;
|
||||||
} BgFP64Tangent;
|
} BgFP64Tangent;
|
||||||
|
|
||||||
|
// ================= Dark Twins ================= //
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
float cos, sin;
|
||||||
|
} __BgFP32DarkTwinTangent;
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
double cos, sin;
|
||||||
|
} __BgFP64DarkTwinTangent;
|
||||||
|
|
||||||
|
// ================= Constants ================== //
|
||||||
|
|
||||||
extern const BgFP32Tangent BG_FP32_IDLE_TANGENT;
|
extern const BgFP32Tangent BG_FP32_IDLE_TANGENT;
|
||||||
extern const BgFP64Tangent BG_FP64_IDLE_TANGENT;
|
extern const BgFP64Tangent BG_FP64_IDLE_TANGENT;
|
||||||
|
|
||||||
|
|
@ -25,212 +39,266 @@ extern const BgFP64Tangent BG_FP64_IDLE_TANGENT;
|
||||||
|
|
||||||
static inline void bg_fp32_tangent_reset(BgFP32Tangent* tangent)
|
static inline void bg_fp32_tangent_reset(BgFP32Tangent* tangent)
|
||||||
{
|
{
|
||||||
tangent->_cos = 1.0f;
|
__BgFP32DarkTwinTangent* twin = (__BgFP32DarkTwinTangent*)tangent;
|
||||||
tangent->_sin = 0.0f;
|
|
||||||
|
twin->cos = 1.0f;
|
||||||
|
twin->sin = 0.0f;
|
||||||
}
|
}
|
||||||
|
|
||||||
static inline void bg_fp64_tangent_reset(BgFP64Tangent* tangent)
|
static inline void bg_fp64_tangent_reset(BgFP64Tangent* tangent)
|
||||||
{
|
{
|
||||||
tangent->_cos = 1.0;
|
__BgFP64DarkTwinTangent* twin = (__BgFP64DarkTwinTangent*)tangent;
|
||||||
tangent->_sin = 0.0;
|
|
||||||
|
twin->cos = 1.0;
|
||||||
|
twin->sin = 0.0;
|
||||||
}
|
}
|
||||||
|
|
||||||
// ==================== Copy ==================== //
|
// ==================== Set ===================== //
|
||||||
|
|
||||||
static inline void bg_fp32_tangent_copy(const BgFP32Tangent* from, BgFP32Tangent* to)
|
|
||||||
{
|
|
||||||
to->_cos = from->_cos;
|
|
||||||
to->_sin = from->_sin;
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void bg_fp64_tangent_copy(const BgFP64Tangent* from, BgFP64Tangent* to)
|
|
||||||
{
|
|
||||||
to->_cos = from->_cos;
|
|
||||||
to->_sin = from->_sin;
|
|
||||||
}
|
|
||||||
|
|
||||||
// ==================== Make ==================== //
|
|
||||||
|
|
||||||
static inline void bg_fp32_tangent_set_values(const float x1, const float x2, BgFP32Tangent* tangent)
|
static inline void bg_fp32_tangent_set_values(const float x1, const float x2, BgFP32Tangent* tangent)
|
||||||
{
|
{
|
||||||
const float square_module = x1 * x1 + x2 * x2;
|
const float square_module = x1 * x1 + x2 * x2;
|
||||||
|
|
||||||
tangent->_cos = x1;
|
__BgFP32DarkTwinTangent* twin = (__BgFP32DarkTwinTangent*)tangent;
|
||||||
tangent->_sin = x2;
|
|
||||||
|
twin->cos = x1;
|
||||||
|
twin->sin = x2;
|
||||||
|
|
||||||
if (1.0f - BG_FP32_TWO_EPSYLON <= square_module && square_module <= 1.0f + BG_FP32_TWO_EPSYLON) {
|
if (1.0f - BG_FP32_TWO_EPSYLON <= square_module && square_module <= 1.0f + BG_FP32_TWO_EPSYLON) {
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (square_module <= BG_FP32_SQUARE_EPSYLON) {
|
if (square_module <= BG_FP32_SQUARE_EPSYLON) {
|
||||||
tangent->_cos = 1.0f;
|
twin->cos = 1.0f;
|
||||||
tangent->_sin = 0.0f;
|
twin->sin = 0.0f;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
const float multiplier = sqrtf(1.0f / square_module);
|
const float multiplier = sqrtf(1.0f / square_module);
|
||||||
|
|
||||||
tangent->_cos = x1 * multiplier;
|
twin->cos = x1 * multiplier;
|
||||||
tangent->_sin = x2 * multiplier;
|
twin->sin = x2 * multiplier;
|
||||||
}
|
}
|
||||||
|
|
||||||
static inline void bg_fp64_tangent_set_values(const double x1, const double x2, BgFP64Tangent* tangent)
|
static inline void bg_fp64_tangent_set_values(const double x1, const double x2, BgFP64Tangent* tangent)
|
||||||
{
|
{
|
||||||
const double square_module = x1 * x1 + x2 * x2;
|
const double square_module = x1 * x1 + x2 * x2;
|
||||||
|
|
||||||
tangent->_cos = x1;
|
__BgFP64DarkTwinTangent* twin = (__BgFP64DarkTwinTangent*)tangent;
|
||||||
tangent->_sin = x2;
|
|
||||||
|
twin->cos = x1;
|
||||||
|
twin->sin = x2;
|
||||||
|
|
||||||
if (1.0 - BG_FP64_TWO_EPSYLON <= square_module && square_module <= 1.0 + BG_FP64_TWO_EPSYLON) {
|
if (1.0 - BG_FP64_TWO_EPSYLON <= square_module && square_module <= 1.0 + BG_FP64_TWO_EPSYLON) {
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (square_module <= BG_FP64_SQUARE_EPSYLON) {
|
if (square_module <= BG_FP64_SQUARE_EPSYLON) {
|
||||||
tangent->_cos = 1.0;
|
twin->cos = 1.0;
|
||||||
tangent->_sin = 0.0;
|
twin->sin = 0.0;
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
const double multiplier = sqrt(1.0 / square_module);
|
const double multiplier = sqrt(1.0 / square_module);
|
||||||
|
|
||||||
tangent->_cos = x1 * multiplier;
|
twin->cos = x1 * multiplier;
|
||||||
tangent->_sin = x2 * multiplier;
|
twin->sin = x2 * multiplier;
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================== Set Angle ================= //
|
// ==================== Copy ==================== //
|
||||||
|
|
||||||
static inline void bg_fp32_tangent_set_angle(const float angle, const angle_unit_t unit, BgFP32Tangent* tangent)
|
static inline void bg_fp32_tangent_copy(const BgFP32Tangent* from, BgFP32Tangent* to)
|
||||||
|
{
|
||||||
|
__BgFP32DarkTwinTangent* twin = (__BgFP32DarkTwinTangent*)to;
|
||||||
|
|
||||||
|
twin->cos = from->cos;
|
||||||
|
twin->sin = from->sin;
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void bg_fp64_tangent_copy(const BgFP64Tangent* from, BgFP64Tangent* to)
|
||||||
|
{
|
||||||
|
__BgFP64DarkTwinTangent* twin = (__BgFP64DarkTwinTangent*)to;
|
||||||
|
|
||||||
|
twin->cos = from->cos;
|
||||||
|
twin->sin = from->sin;
|
||||||
|
}
|
||||||
|
|
||||||
|
// ==================== Swap ==================== //
|
||||||
|
|
||||||
|
static inline void bg_fp32_tangent_swap(BgFP32Tangent* tangent1, BgFP32Tangent* tangent2)
|
||||||
|
{
|
||||||
|
const float cos = tangent1->cos;
|
||||||
|
const float sin = tangent1->sin;
|
||||||
|
|
||||||
|
__BgFP32DarkTwinTangent* twin1 = (__BgFP32DarkTwinTangent*)tangent1;
|
||||||
|
|
||||||
|
twin1->cos = tangent2->cos;
|
||||||
|
twin1->sin = tangent2->sin;
|
||||||
|
|
||||||
|
__BgFP32DarkTwinTangent* twin2 = (__BgFP32DarkTwinTangent*)tangent2;
|
||||||
|
|
||||||
|
twin2->cos = cos;
|
||||||
|
twin2->sin = sin;
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void bg_fp64_tangent_swap(BgFP64Tangent* tangent1, BgFP64Tangent* tangent2)
|
||||||
|
{
|
||||||
|
const double cos = tangent1->cos;
|
||||||
|
const double sin = tangent1->sin;
|
||||||
|
|
||||||
|
__BgFP64DarkTwinTangent* twin1 = (__BgFP64DarkTwinTangent*)tangent1;
|
||||||
|
|
||||||
|
twin1->cos = tangent2->cos;
|
||||||
|
twin1->sin = tangent2->sin;
|
||||||
|
|
||||||
|
__BgFP64DarkTwinTangent* twin2 = (__BgFP64DarkTwinTangent*)tangent2;
|
||||||
|
|
||||||
|
twin2->cos = cos;
|
||||||
|
twin2->sin = sin;
|
||||||
|
}
|
||||||
|
|
||||||
|
// ================== Set Turn ================== //
|
||||||
|
|
||||||
|
static inline void bg_fp32_tangent_set_turn(const float angle, const angle_unit_t unit, BgFP32Tangent* tangent)
|
||||||
{
|
{
|
||||||
const float radians = bg_fp32_angle_to_radians(angle, unit);
|
const float radians = bg_fp32_angle_to_radians(angle, unit);
|
||||||
|
|
||||||
tangent->_cos = cosf(radians);
|
__BgFP32DarkTwinTangent* twin = (__BgFP32DarkTwinTangent*)tangent;
|
||||||
tangent->_sin = sinf(radians);
|
|
||||||
|
twin->cos = cosf(radians);
|
||||||
|
twin->sin = sinf(radians);
|
||||||
}
|
}
|
||||||
|
|
||||||
static inline void bg_fp64_tangent_set_angle(const double angle, const angle_unit_t unit, BgFP64Tangent* tangent)
|
static inline void bg_fp64_tangent_set_turn(const double angle, const angle_unit_t unit, BgFP64Tangent* tangent)
|
||||||
{
|
{
|
||||||
const double radians = bg_fp64_angle_to_radians(angle, unit);
|
const double radians = bg_fp64_angle_to_radians(angle, unit);
|
||||||
|
|
||||||
tangent->_cos = cos(radians);
|
__BgFP64DarkTwinTangent* twin = (__BgFP64DarkTwinTangent*)tangent;
|
||||||
tangent->_sin = sin(radians);
|
|
||||||
|
twin->cos = cos(radians);
|
||||||
|
twin->sin = sin(radians);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============= Copy to twin type ============== //
|
// ============= Copy to twin type ============== //
|
||||||
|
|
||||||
static inline void bg_fp32_tangent_copy_to_double(const BgFP32Tangent* from, BgFP64Tangent* to)
|
static inline void bg_fp32_tangent_set_from_fp64(const BgFP64Tangent* from, BgFP32Tangent* to)
|
||||||
{
|
{
|
||||||
bg_fp64_tangent_set_values((double)from->_cos, (double)from->_sin, to);
|
bg_fp32_tangent_set_values((float)from->cos, (float)from->sin, to);
|
||||||
}
|
}
|
||||||
|
|
||||||
static inline void bg_fp64_tangent_copy_to_single(const BgFP64Tangent* from, BgFP32Tangent* to)
|
static inline void bg_fp64_tangent_set_from_fp32(const BgFP32Tangent* from, BgFP64Tangent* to)
|
||||||
{
|
{
|
||||||
bg_fp32_tangent_set_values((float)from->_cos, (float)from->_sin, to);
|
bg_fp64_tangent_set_values((double)from->cos, (double)from->sin, to);
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================= Inversion ================== //
|
// ================= Inversion ================== //
|
||||||
|
|
||||||
static inline void bg_fp32_tangent_invert(BgFP32Tangent* tangent)
|
static inline void bg_fp32_tangent_invert(BgFP32Tangent* tangent)
|
||||||
{
|
{
|
||||||
tangent->_sin = -tangent->_sin;
|
((__BgFP32DarkTwinTangent*)tangent)->sin = -tangent->sin;
|
||||||
}
|
}
|
||||||
|
|
||||||
static inline void bg_fp64_tangent_invert(BgFP64Tangent* tangent)
|
static inline void bg_fp64_tangent_invert(BgFP64Tangent* tangent)
|
||||||
{
|
{
|
||||||
tangent->_sin = -tangent->_sin;
|
((__BgFP64DarkTwinTangent*)tangent)->sin = -tangent->sin;
|
||||||
}
|
}
|
||||||
|
|
||||||
// ================ Set Inverted ================ //
|
// ================ Set Inverted ================ //
|
||||||
|
|
||||||
static inline void bg_fp32_tangent_set_inverted(const BgFP32Tangent* tangent, BgFP32Tangent* result)
|
static inline void bg_fp32_tangent_set_inverted(const BgFP32Tangent* tangent, BgFP32Tangent* result)
|
||||||
{
|
{
|
||||||
result->_cos = tangent->_cos;
|
__BgFP32DarkTwinTangent* twin = (__BgFP32DarkTwinTangent*)result;
|
||||||
result->_sin = -tangent->_sin;
|
|
||||||
|
twin->cos = tangent->cos;
|
||||||
|
twin->sin = -tangent->sin;
|
||||||
}
|
}
|
||||||
|
|
||||||
static inline void bg_fp64_tangent_set_inverted(const BgFP64Tangent* tangent, BgFP64Tangent* result)
|
static inline void bg_fp64_tangent_set_inverted(const BgFP64Tangent* tangent, BgFP64Tangent* result)
|
||||||
{
|
{
|
||||||
result->_cos = tangent->_cos;
|
__BgFP64DarkTwinTangent* twin = (__BgFP64DarkTwinTangent*)result;
|
||||||
result->_sin = -tangent->_sin;
|
|
||||||
|
twin->cos = tangent->cos;
|
||||||
|
twin->sin = -tangent->sin;
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============== Rotation Matrix =============== //
|
// ============== Rotation Matrix =============== //
|
||||||
|
|
||||||
static inline void bg_fp32_tangent_make_rotation_matrix(const BgFP32Tangent* tangent, BgFP32Matrix2x2* matrix)
|
static inline void bg_fp32_tangent_make_rotation_matrix(const BgFP32Tangent* tangent, BgFP32Matrix2x2* matrix)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = tangent->_cos;
|
matrix->r1c1 = tangent->cos;
|
||||||
matrix->r1c2 = -tangent->_sin;
|
matrix->r1c2 = -tangent->sin;
|
||||||
matrix->r2c1 = tangent->_sin;
|
matrix->r2c1 = tangent->sin;
|
||||||
matrix->r2c2 = tangent->_cos;
|
matrix->r2c2 = tangent->cos;
|
||||||
}
|
}
|
||||||
|
|
||||||
static inline void bg_fp64_tangent_make_rotation_matrix(const BgFP64Tangent* tangent, BgFP64Matrix2x2* matrix)
|
static inline void bg_fp64_tangent_make_rotation_matrix(const BgFP64Tangent* tangent, BgFP64Matrix2x2* matrix)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = tangent->_cos;
|
matrix->r1c1 = tangent->cos;
|
||||||
matrix->r1c2 = -tangent->_sin;
|
matrix->r1c2 = -tangent->sin;
|
||||||
matrix->r2c1 = tangent->_sin;
|
matrix->r2c1 = tangent->sin;
|
||||||
matrix->r2c2 = tangent->_cos;
|
matrix->r2c2 = tangent->cos;
|
||||||
}
|
}
|
||||||
|
|
||||||
// ============== Reverse Matrix ================ //
|
// ============== Reverse Matrix ================ //
|
||||||
|
|
||||||
static inline void bg_fp32_tangent_make_reverse_matrix(const BgFP32Tangent* tangent, BgFP32Matrix2x2* matrix)
|
static inline void bg_fp32_tangent_make_reverse_matrix(const BgFP32Tangent* tangent, BgFP32Matrix2x2* matrix)
|
||||||
{
|
{
|
||||||
matrix->r1c1 = tangent->_cos;
|
matrix->r1c1 = tangent->cos;
|
||||||