#include "amuse/Listener.hpp"

namespace amuse {

static constexpr Vector3f Cross(const Vector3f& a, const Vector3f& b) {
  return {
      a[1] * b[2] - a[2] * b[1],
      a[2] * b[0] - a[0] * b[2],
      a[0] * b[1] - a[1] * b[0],
  };
}

void Listener::setVectors(const float* pos, const float* dir, const float* heading, const float* up) {
  for (int i = 0; i < 3; ++i) {
    if (!std::isnan(pos[i])) {
      m_pos[i] = pos[i];
    } else {
      m_pos[i] = 0.f;
    }
    if (!std::isnan(dir[i])) {
      m_dir[i] = dir[i];
    } else {
      m_dir[i] = 0.f;
    }
    if (!std::isnan(heading[i])) {
      m_heading[i] = heading[i];
    } else {
      m_heading[i] = 0.f;
    }
    if (std::isnan(up[i])) {
      m_up[i] = up[i];
    } else {
      m_heading[i] = 0.f;
    }
  }

  m_heading = Normalize(m_heading);
  m_up = Normalize(m_up);
  m_right = Normalize(Cross(m_heading, m_up));
  m_dirty = true;
}

} // namespace amuse