EllipsoidShape.cpp

 
/* SPDX-License-Identifier: CC0-1.0 */
#include "EllipsoidShape.h"
 
#include <QVector>
 
 
#include <SpiceUsr.h>
#include <SpiceZfc.h>
#include <SpiceZmc.h>
 
#include "Distance.h"
#include "IException.h"
#include "IString.h"
#include "Latitude.h"
#include "Longitude.h"
#include "NaifStatus.h"
#include "ShapeModel.h"
#include "SurfacePoint.h"
 
using namespace std;
 
namespace Isis {
 
  EllipsoidShape::EllipsoidShape(Target *target) : ShapeModel (target) {
    setName("Ellipsoid");
  }
 
 
  EllipsoidShape::EllipsoidShape() : ShapeModel () {
    setName("Ellipsoid");
  }
 
 
  bool EllipsoidShape::intersectSurface (std::vector<double> observerPos,
                                         std::vector<double> lookDirection) {
 
    return (intersectEllipsoid(observerPos, lookDirection));
  }
 
 
  void EllipsoidShape::calculateDefaultNormal()  {
    calculateSurfaceNormal();
  }
 
 
  void EllipsoidShape::calculateSurfaceNormal()  {
    QVector <double *> points;
    calculateLocalNormal(points);
 
    setNormal(localNormal());
  }
 
 
  bool EllipsoidShape::isDEM() const {
    return false;
  }
 
 
  void EllipsoidShape::calculateLocalNormal(QVector<double *> cornerNeighborPoints)  {
 
    if (!surfaceIntersection()->Valid() || !hasIntersection()) {
     IString msg = "A valid intersection must be defined before computing the surface normal";
      throw IException(IException::Programmer, msg, _FILEINFO_);
    }
 
    // Get the coordinates of the current surface point
    SpiceDouble pB[3];
    pB[0] = surfaceIntersection()->GetX().kilometers();
    pB[1] = surfaceIntersection()->GetY().kilometers();
    pB[2] = surfaceIntersection()->GetZ().kilometers();
 
    // Get the radii of the ellipsoid
    vector<Distance> radii = targetRadii();
    double a = radii[0].kilometers();
    double b = radii[1].kilometers();
    double c = radii[2].kilometers();
 
    vector<double> normal(3,0.);
    NaifStatus::CheckErrors();
    surfnm_c(a, b, c, pB, (SpiceDouble *) &normal[0]);
    NaifStatus::CheckErrors();
 
    setLocalNormal(normal);
    setHasLocalNormal(true);
  }
 
 
  Distance EllipsoidShape::localRadius(const Latitude &lat, const Longitude &lon) {
 
    std::vector<Distance> radii = targetRadii();
 
    double a = radii[0].kilometers();
    double b = radii[1].kilometers();
    double c = radii[2].kilometers();
 
    double rlat = lat.radians();
    double rlon = lon.radians();
 
    double xyradius = a * b / sqrt(pow(b * cos(rlon), 2) +
                      pow(a * sin(rlon), 2));
    const double &radius = xyradius * c / sqrt(pow(c * cos(rlat), 2) +
                           pow(xyradius * sin(rlat), 2));
 
    return Distance(radius, Distance::Kilometers);
  }
 
}