raypath.cpp

// raypath.cpp
//
#include "raypath.hpp"

Real RayArcAttributes::AngleOffsetFromBottom(const R3::XYZ & loc) const {
  const R3::XYZ centerToLoc = Center.VectorTo(loc);
  const Real loctanx = u3.Dot(centerToLoc);
  const Real loctany = u1.Dot(centerToLoc);
  return atan2(loctany,loctanx);
}

R3::XYZ RayArcAttributes::PositionFromAngle(Real angle) const {
  return Center + u1.ScaledBy(Radius*sin(angle))
                + u3.ScaledBy(Radius*cos(angle));
}

R3::XYZ RayArcAttributes::DirectionFromAngle(Real angle) const {
  return u1.ScaledBy(cos(angle)) + u3.ScaledBy(-sin(angle));
}

std::string RayArcAttributes::str() const {
  std::ostringstream s;
  s << "{RayArc:"<<" {Radius: "<<Radius<<" @ Center: "<<Center.str()<<""
    <<"  u1: "<<u1.str()<<" u3: "<<u3.str()<<"}}";
  return s.str();
}