Kimelas/bgc-c
2
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

Изменение функций нормализации, переименование make функий в set values, добавление внутренних restrict функций, гарантирующих оптимизальное выполнение открытых функций, независимо от компилятора

Browse source
This commit is contained in:
Andrey Pokidov 2026-03-24 17:11:09 +07:00
parent e6ac9023ec
commit 6945c69ef2
20 changed files with 324 additions and 337 deletions
Download patch file Download diff file Expand all files Collapse all files

78
basic-geometry/turn2.h
View file

@ -26,9 +26,51 @@ inline void bgc_fp64_turn2_reset(BGC_FP64_Turn2* const turn)
turn->_sin = 0.0;
}
// ================= Normalize ================== //
inline void _bgc_fp32_turn2_normalize(BGC_FP32_Turn2* const turn)
{
const float square_modulus = turn->_cos * turn->_cos + turn->_sin * turn->_sin;
if (bgc_fp32_is_square_unit(square_modulus)) {
return;
}
if (square_modulus <= BGC_FP32_SQUARE_EPSILON || isnan(square_modulus)) {
turn->_cos = 1.0f;
turn->_sin = 0.0f;
return;
}
const float multiplier = sqrtf(1.0f / square_modulus);
turn->_cos *= multiplier;
turn->_sin *= multiplier;
}
inline void _bgc_fp64_turn2_normalize(BGC_FP64_Turn2* const turn)
{
const double square_modulus = turn->_cos * turn->_cos + turn->_sin * turn->_sin;
if (bgc_fp64_is_square_unit(square_modulus)) {
return;
}
if (square_modulus <= BGC_FP64_SQUARE_EPSILON || isnan(square_modulus)) {
turn->_cos = 1.0;
turn->_sin = 0.0;
return;
}
const double multiplier = sqrt(1.0 / square_modulus);
turn->_cos *= multiplier;
turn->_sin *= multiplier;
}
// ================== Set Turn ================== //
inline void bgc_fp32_turn2_make_for_angle(BGC_FP32_Turn2* const turn, const float angle, const int angle_unit)
inline void bgc_fp32_turn2_set_angle(BGC_FP32_Turn2* const turn, const float angle, const int angle_unit)
{
const float radians = bgc_fp32_angle_to_radians(angle, angle_unit);
@ -36,7 +78,7 @@ inline void bgc_fp32_turn2_make_for_angle(BGC_FP32_Turn2* const turn, const floa
turn->_sin = sinf(radians);
}
inline void bgc_fp64_turn2_make_for_angle(BGC_FP64_Turn2* const turn, const double angle, const int angle_unit)
inline void bgc_fp64_turn2_set_angle(BGC_FP64_Turn2* const turn, const double angle, const int angle_unit)
{
const double radians = bgc_fp64_angle_to_radians(angle, angle_unit);
@ -59,32 +101,20 @@ inline int bgc_fp64_turn2_is_idle(const BGC_FP64_Turn2* const turn)
// ==================== Set ===================== //
void _bgc_fp32_turn2_normalize(BGC_FP32_Turn2* const twin);
void _bgc_fp64_turn2_normalize(BGC_FP64_Turn2* const twin);
inline void bgc_fp32_turn2_make(BGC_FP32_Turn2* const turn, const float x1, const float x2)
inline void bgc_fp32_turn2_set_values(BGC_FP32_Turn2* const turn, const float x1, const float x2)
{
const float square_modulus = x1 * x1 + x2 * x2;
turn->_cos = x1;
turn->_sin = x2;
if (!bgc_fp32_is_square_unit(square_modulus)) {
_bgc_fp32_turn2_normalize(turn);
}
_bgc_fp32_turn2_normalize(turn);
}
inline void bgc_fp64_turn2_make(BGC_FP64_Turn2* const turn, const double x1, const double x2)
inline void bgc_fp64_turn2_set_values(BGC_FP64_Turn2* const turn, const double x1, const double x2)
{
const double square_modulus = x1 * x1 + x2 * x2;
turn->_cos = x1;
turn->_sin = x2;
if (!bgc_fp64_is_square_unit(square_modulus)) {
_bgc_fp64_turn2_normalize(turn);
}
_bgc_fp64_turn2_normalize(turn);
}
// =================== Angle =================== //
@ -143,12 +173,12 @@ inline void bgc_fp64_turn2_swap(BGC_FP64_Turn2* const turn1, BGC_FP64_Turn2* con
inline void bgc_fp64_turn2_convert_to_fp32(BGC_FP32_Turn2* const destination, const BGC_FP64_Turn2* const source)
{
bgc_fp32_turn2_make(destination, (float)source->_cos, (float)source->_sin);
bgc_fp32_turn2_set_values(destination, (float)source->_cos, (float)source->_sin);
}
inline void bgc_fp32_turn2_convert_to_fp64(BGC_FP64_Turn2* const destination, const BGC_FP32_Turn2* const source)
{
bgc_fp64_turn2_make(destination, (double)source->_cos, (double)source->_sin);
bgc_fp64_turn2_set_values(destination, (double)source->_cos, (double)source->_sin);
}
// =================== Revert =================== //
@ -197,7 +227,7 @@ inline void bgc_fp64_turn2_get_power(BGC_FP64_Turn2* const power, const BGC_FP64
inline void bgc_fp32_turn2_combine(BGC_FP32_Turn2* const combination, const BGC_FP32_Turn2* const turn1, const BGC_FP32_Turn2* const turn2)
{
bgc_fp32_turn2_make(
bgc_fp32_turn2_set_values(
combination,
turn1->_cos * turn2->_cos - turn1->_sin * turn2->_sin,
turn1->_cos * turn2->_sin + turn1->_sin * turn2->_cos
@ -206,7 +236,7 @@ inline void bgc_fp32_turn2_combine(BGC_FP32_Turn2* const combination, const BGC_
inline void bgc_fp64_turn2_combine(BGC_FP64_Turn2* const combination, const BGC_FP64_Turn2* const turn1, const BGC_FP64_Turn2* const turn2)
{
bgc_fp64_turn2_make(
bgc_fp64_turn2_set_values(
combination,
turn1->_cos * turn2->_cos - turn1->_sin * turn2->_sin,
turn1->_cos * turn2->_sin + turn1->_sin * turn2->_cos
@ -217,7 +247,7 @@ inline void bgc_fp64_turn2_combine(BGC_FP64_Turn2* const combination, const BGC_
inline void bgc_fp32_turn2_exclude(BGC_FP32_Turn2* const difference, const BGC_FP32_Turn2* const base, const BGC_FP32_Turn2* const excludant)
{
bgc_fp32_turn2_make(
bgc_fp32_turn2_set_values(
difference,
base->_cos * excludant->_cos + base->_sin * excludant->_sin,
base->_sin * excludant->_cos - base->_cos * excludant->_sin
@ -226,7 +256,7 @@ inline void bgc_fp32_turn2_exclude(BGC_FP32_Turn2* const difference, const BGC_F
inline void bgc_fp64_turn2_exclude(BGC_FP64_Turn2* const difference, const BGC_FP64_Turn2* const base, const BGC_FP64_Turn2* const excludant)
{
bgc_fp64_turn2_make(
bgc_fp64_turn2_set_values(
difference,
base->_cos * excludant->_cos + base->_sin * excludant->_sin,
base->_sin * excludant->_cos - base->_cos * excludant->_sin