#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;