Poly2d.h

#pragma once
 
#include "forward.h"
 
#include <stdexcept>
#include <string>
#include <vector>
#include "Constants.h"

class isce3::core::Poly2d {
public:

    int xOrder;
    int yOrder;
    double xMean;
    double yMean;
    double xNorm;
    double yNorm;
    std::vector<double> coeffs;

    Poly2d(int xo, int yo, double xm, double ym, double xn, double yn) : xOrder(xo),
                                                                         yOrder(yo),
                                                                         xMean(xm),
                                                                         yMean(ym),
                                                                         xNorm(xn),
                                                                         yNorm(yn),
                                                                         coeffs((xo+1)*(yo+1))
                                                                         {}

    Poly2d() : Poly2d(-1,-1,0.,0.,1.,1.) {}

    Poly2d(const Poly2d &p) : xOrder(p.xOrder), yOrder(p.yOrder),
                              xMean(p.xMean), yMean(p.yMean),
                              xNorm(p.xNorm), yNorm(p.yNorm),
                              coeffs(p.coeffs) {}

    inline Poly2d& operator=(const Poly2d&);

    inline void setCoeff(int row, int col, double val);

    inline double getCoeff(int row, int col) const;

    double eval(double y, double x) const;

    void printPoly() const;
};
 
isce3::core::Poly2d & isce3::core::Poly2d::
operator=(const Poly2d &rhs) {
    xOrder = rhs.xOrder;
    yOrder = rhs.yOrder;
    xMean = rhs.xMean;
    yMean = rhs.yMean;
    xNorm = rhs.xNorm;
    yNorm = rhs.yNorm;
    coeffs = rhs.coeffs;
    return *this;
}

void isce3::core::Poly2d::
setCoeff(int row, int col, double val) {
    if ((row < 0) || (row > yOrder)) {
        std::string errstr = "Poly2d::setCoeff - Trying to set coefficient for row " +
                             std::to_string(row+1) + " out of " +
                             std::to_string(yOrder+1);
        throw std::out_of_range(errstr);
    }
    if ((col < 0) || (col > xOrder)) {
        std::string errstr = "Poly2d::setCoeff - Trying to set coefficient for col " +
                             std::to_string(col+1) + " out of " + std::to_string(xOrder+1);
        throw std::out_of_range(errstr);
    }
    coeffs[IDX1D(row,col,xOrder+1)] = val;
}

double isce3::core::Poly2d::
getCoeff(int row, int col) const {
    if ((row < 0) || (row > yOrder)) {
        std::string errstr = "Poly2d::getCoeff - Trying to get coefficient for row " +
                             std::to_string(row+1) + " out of " +
                             std::to_string(yOrder+1);
        throw std::out_of_range(errstr);
    }
    if ((col < 0) || (col > xOrder)) {
        std::string errstr = "Poly2d::getCoeff - Trying to get coefficient for col " +
                             std::to_string(col+1) + " out of " + std::to_string(xOrder+1);
        throw std::out_of_range(errstr);
    }
    return coeffs[IDX1D(row,col,xOrder+1)];
}