Добавление функций определения поворотов (versor) между направлениями и базисами
This commit is contained in:
parent
e6a94ab8d9
commit
2a4d5522d3
12 changed files with 784 additions and 287 deletions
|
|
@ -53,12 +53,12 @@ structure_fp32_t* make_structures(const unsigned int amount)
|
||||||
|
|
||||||
void print_versor_fp32(const BgcVersorFP32* versor)
|
void print_versor_fp32(const BgcVersorFP32* versor)
|
||||||
{
|
{
|
||||||
printf("Versor (%f, %f, %f, %f)\n", versor->s0, versor->x1, versor->x2, versor->x3);
|
printf("Versor (s0 = %0.12f, x1 = %0.12f, x2 = %0.12f, x3 = %0.12f)\n", versor->s0, versor->x1, versor->x2, versor->x3);
|
||||||
}
|
}
|
||||||
|
|
||||||
void print_versor_fp64(const BgcVersorFP64* versor)
|
void print_versor_fp64(const BgcVersorFP64* versor)
|
||||||
{
|
{
|
||||||
printf("Versor (%lf, %lf, %lf, %lf)\n", versor->s0, versor->x1, versor->x2, versor->x3);
|
printf("Versor (s0 = %0.20f, x1 = %0.20f, x2 = %0.20f, x3 = %0.20f)\n", versor->s0, versor->x1, versor->x2, versor->x3);
|
||||||
}
|
}
|
||||||
|
|
||||||
void print_vector_fp32(const BgcVector3FP32* vector)
|
void print_vector_fp32(const BgcVector3FP32* vector)
|
||||||
|
|
@ -149,7 +149,328 @@ int main() {
|
||||||
}
|
}
|
||||||
*/
|
*/
|
||||||
|
|
||||||
int main() {
|
void test_basis_difference_fp32()
|
||||||
|
{
|
||||||
|
|
||||||
|
BgcVector3FP32 initial_primary, initial_auxiliary;
|
||||||
|
BgcVector3FP32 final_primary, final_auxiliary;
|
||||||
|
BgcVersorFP32 turn;
|
||||||
|
|
||||||
|
// No turn
|
||||||
|
bgc_vector3_set_values_fp32(1.0f, 0.0f, 0.0f, &initial_primary);
|
||||||
|
bgc_vector3_set_values_fp32(0.0f, 1.0f, 0.0f, &initial_auxiliary);
|
||||||
|
|
||||||
|
bgc_vector3_set_values_fp32(1.0f, 0.0f, 0.0f, &final_primary);
|
||||||
|
bgc_vector3_set_values_fp32(0.0f, 1.0f, 0.0f, &final_auxiliary);
|
||||||
|
|
||||||
|
bgc_versor_make_basis_difference_fp32(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
||||||
|
|
||||||
|
printf("\nNo turn:\n");
|
||||||
|
print_versor_fp32(&turn);
|
||||||
|
|
||||||
|
// Turn around (1, 1, 0) axis on 180 degrees
|
||||||
|
bgc_vector3_set_values_fp32(1.0f, 0.0f, 0.0f, &initial_primary);
|
||||||
|
bgc_vector3_set_values_fp32(0.0f, 1.0f, 0.0f, &initial_auxiliary);
|
||||||
|
|
||||||
|
bgc_vector3_set_values_fp32(0.0f, 1.0f, 0.0f, &final_primary);
|
||||||
|
bgc_vector3_set_values_fp32(1.0f, 0.0f, 0.0f, &final_auxiliary);
|
||||||
|
|
||||||
|
bgc_versor_make_basis_difference_fp32(&initial_primary, &initial_auxiliary, &final_primary, &final_auxiliary, &turn);
|
||||||
|
|
||||||
|
printf("\nTurn around (1, 1, 0) axis on 180 degrees:\n");
|
||||||
|
print_versor_fp32(&turn);
|
||||||
|
|
||||||
|
// 180 degree turn
|
||||||