#include "./turn2.h"

const BGC_FP32_Turn2 BGC_FP32_IDLE_TURN2 = { 1.0f, 0.0f };

const BGC_FP64_Turn2 BGC_FP64_IDLE_TURN2 = { 1.0, 0.0 };

extern inline void bgc_fp32_turn2_reset(BGC_FP32_Turn2* const turn);
extern inline void bgc_fp64_turn2_reset(BGC_FP64_Turn2* const turn);

extern void _bgc_fp32_turn2_normalize(BGC_FP32_Turn2* const turn);
extern void _bgc_fp64_turn2_normalize(BGC_FP64_Turn2* const turn);

extern inline void bgc_fp32_turn2_set_values(BGC_FP32_Turn2* const turn, const float x, const float y);
extern inline void bgc_fp64_turn2_set_values(BGC_FP64_Turn2* const turn, const double x, const double y);

extern inline void bgc_fp32_turn2_set_angle(BGC_FP32_Turn2* const turn, const float angle, const int angle_unit);
extern inline void bgc_fp64_turn2_set_angle(BGC_FP64_Turn2* const turn, const double angle, const int angle_unit);

extern inline int bgc_fp32_turn2_is_idle(const BGC_FP32_Turn2* const turn);
extern inline int bgc_fp64_turn2_is_idle(const BGC_FP64_Turn2* const turn);

extern inline float bgc_fp32_turn2_get_angle(const BGC_FP32_Turn2* const turn, const int angle_unit);
extern inline double bgc_fp64_turn2_get_angle(const BGC_FP64_Turn2* const turn, const int angle_unit);

extern inline void bgc_fp32_turn2_copy(BGC_FP32_Turn2* const destination, const BGC_FP32_Turn2* const source);
extern inline void bgc_fp64_turn2_copy(BGC_FP64_Turn2* const destination, const BGC_FP64_Turn2* const source);

extern inline void bgc_fp32_turn2_swap(BGC_FP32_Turn2* const turn1, BGC_FP32_Turn2* const turn2);
extern inline void bgc_fp64_turn2_swap(BGC_FP64_Turn2* const turn1, BGC_FP64_Turn2* const turn2);

extern inline void bgc_fp64_turn2_convert_to_fp32(BGC_FP32_Turn2* const destination, const BGC_FP64_Turn2* const source);
extern inline void bgc_fp32_turn2_convert_to_fp64(BGC_FP64_Turn2* const destination, const BGC_FP32_Turn2* const source);

extern inline void bgc_fp32_turn2_revert(BGC_FP32_Turn2* const turn);
extern inline void bgc_fp64_turn2_revert(BGC_FP64_Turn2* const turn);

extern inline void bgc_fp32_turn2_get_reverse(BGC_FP32_Turn2* const reverse, const BGC_FP32_Turn2* const turn);
extern inline void bgc_fp64_turn2_get_reverse(BGC_FP64_Turn2* const reverse, const BGC_FP64_Turn2* const turn);

extern inline void bgc_fp32_turn2_get_power(BGC_FP32_Turn2* const power, const BGC_FP32_Turn2* const base, const float exponent);
extern inline void bgc_fp64_turn2_get_power(BGC_FP64_Turn2* const power, const BGC_FP64_Turn2* const base, const double exponent);

extern inline void bgc_fp32_turn2_combine(BGC_FP32_Turn2* const combination, const BGC_FP32_Turn2* const turn1, const BGC_FP32_Turn2* const turn2);
extern inline void bgc_fp64_turn2_combine(BGC_FP64_Turn2* const combination, const BGC_FP64_Turn2* const turn1, const BGC_FP64_Turn2* const turn2);

extern inline void bgc_fp32_turn2_exclude(BGC_FP32_Turn2* const difference, const BGC_FP32_Turn2* const turn, const BGC_FP32_Turn2* const excludant);
extern inline void bgc_fp64_turn2_exclude(BGC_FP64_Turn2* const difference, const BGC_FP64_Turn2* const turn, const BGC_FP64_Turn2* const excludant);

extern inline void bgc_fp32_turn2_get_rotation_matrix(BGC_FP32_Matrix2x2* const matrix, const BGC_FP32_Turn2* const turn);
extern inline void bgc_fp64_turn2_get_rotation_matrix(BGC_FP64_Matrix2x2* const matrix, const BGC_FP64_Turn2* const turn);

extern inline void bgc_fp32_turn2_get_reverse_matrix(BGC_FP32_Matrix2x2* const matrix, const BGC_FP32_Turn2* const turn);
extern inline void bgc_fp64_turn2_get_reverse_matrix(BGC_FP64_Matrix2x2* const matrix, const BGC_FP64_Turn2* const turn);

extern inline void bgc_fp32_turn2_vector(BGC_FP32_Vector2* const turned_vector, const BGC_FP32_Turn2* const turn, const BGC_FP32_Vector2* const vector);
extern inline void bgc_fp64_turn2_vector(BGC_FP64_Vector2* const turned_vector, const BGC_FP64_Turn2* const turn, const BGC_FP64_Vector2* const vector);

extern inline void bgc_fp32_turn2_vector_back(BGC_FP32_Vector2* const turned_vector, const BGC_FP32_Turn2* const turn, const BGC_FP32_Vector2* const vector);
extern inline void bgc_fp64_turn2_vector_back(BGC_FP64_Vector2* const turned_vector, const BGC_FP64_Turn2* const turn, const BGC_FP64_Vector2* const vector);

extern inline int bgc_fp32_turn2_are_close(const BGC_FP32_Turn2* const turn1, const BGC_FP32_Turn2* const turn2);
extern inline int bgc_fp64_turn2_are_close(const BGC_FP64_Turn2* const turn1, const BGC_FP64_Turn2* const turn2);