28 lines
570 B
C++
28 lines
570 B
C++
#include "AngleUsing.h"
|
|
|
|
#include "Angle.h"
|
|
#include <math.h>
|
|
|
|
namespace Passer {
|
|
namespace LinearAlgebra {
|
|
|
|
typedef AngleUsing<signed short> Angle16;
|
|
|
|
template <> Angle16::AngleUsing(float angle) {
|
|
if (!isfinite(angle)) {
|
|
value = 0;
|
|
return;
|
|
}
|
|
|
|
// map float [-180..180) to integer [-32768..32767]
|
|
this->value = (signed short)((angle / 360.0F) * 65536.0F);
|
|
}
|
|
|
|
template <> float Angle16::ToFloat() const {
|
|
float f = ((this->value * 180) / 32768.0F);
|
|
return f;
|
|
}
|
|
|
|
} // namespace LinearAlgebra
|
|
} // namespace Passer
|
|
using namespace Passer::LinearAlgebra; |