Basis.h

//-*- C++ -*-
//-*- coding: utf-8 -*-
//
// Author: Bryan V. Riel, Joshua Cohen
// Copyright 2017-2018

#pragma once

#include "forward.h"

#include "Common.h"
#include "Vector.h"

class isce3::core::Basis {

    public:
        CUDA_HOSTDEV
        Basis() {};

        CUDA_HOSTDEV
        Basis(const Vec3& x0, const Vec3& x1, const Vec3& x2) :
            _x0(x0), _x1(x1), _x2(x2) {}

        CUDA_HOSTDEV explicit Basis(const Vec3& p, const Vec3& v) {
            const Vec3 n =         -p.normalized();
            const Vec3 c = n.cross(v).normalized();
            const Vec3 t = c.cross(n).normalized();
            _x0 = t;
            _x1 = c;
            _x2 = n;
        }

        CUDA_HOSTDEV const Vec3& x0() const { return _x0; }

        CUDA_HOSTDEV const Vec3& x1() const { return _x1; }

        CUDA_HOSTDEV const Vec3& x2() const { return _x2; }

        CUDA_HOSTDEV void x0(const Vec3& x0) { _x0 = x0; }

        CUDA_HOSTDEV void x1(const Vec3& x1) { _x1 = x1; }

        CUDA_HOSTDEV void x2(const Vec3& x2) { _x2 = x2; }

        CUDA_HOSTDEV inline Vec3 project(Vec3& vec) {
            return Vec3 { _x0.dot(vec),
                          _x1.dot(vec),
                          _x2.dot(vec) };
        };

        inline void combine(cartesian_t &vec, cartesian_t &res) {
            for(int ii =0; ii < 3; ii++) {
                res[ii] = vec[0] * _x0[ii] + vec[1] * _x1[ii] + vec[2] * _x2[ii];
            }
        };

    private:
        cartesian_t _x0;
        cartesian_t _x1;
        cartesian_t _x2;
};