Vector3d.cpp

 
#include "tools/Vector3d.h"
#include <cmath>
 
 
Vector3d::Vector3d()
{
    setZero();
}
 
Vector3d::Vector3d(const Vector3d &v)
{
    set(v.x, v.y, v.z);
}
 
Vector3d::Vector3d(double x, double y, double z)
{
    set(x, y, z);
}
 
void Vector3d::set(double nx, double ny, double nz)
{
    x = nx;
    y = ny;
    z = nz;
}
 
void Vector3d::setComponent(int i, double val)
{
    if (i == 0)
    {
        x = val;
    }
    else if (i == 1)
    {
        y = val;
    }
    else
    {
        z = val;
    }
}
 
void Vector3d::setZero()
{
    set(0, 0, 0);
}
 
void Vector3d::set(Vector3d other)
{
    set(other.x, other.y, other.z);
}
 
void Vector3d::scale(double s)
{
    x *= s;
    y *= s;
    z *= s;
}
 
void Vector3d::normalize()
{
    double d = length();
    if (d != 0.0)
    {
        scale(1.0 / d);
    }
}
 
double Vector3d::dot(Vector3d a, Vector3d b)
{
    return a.x * b.x + a.y * b.y + a.z * b.z;
}
 
double Vector3d::length()
{
    return sqrt(x * x + y * y + z * z);
}
 
bool Vector3d::sameValues(Vector3d other)
{
    return (x == other.x) && (y == other.y) && (z == other.z);
}
 
void Vector3d::add(Vector3d a, Vector3d b, Vector3d &result)
{
  result.set(a.x + b.x,
    a.y + b.y,
    a.z + b.z);
}
 
void Vector3d::sub(Vector3d a, Vector3d b, Vector3d &result)
{
    result.set(a.x - b.x,
                a.y - b.y,
                a.z - b.z);
}
 
void Vector3d::cross(Vector3d a, Vector3d b, Vector3d &result)
{
    result.set(a.y * b.z - a.z * b.y,
                a.z * b.x - a.x * b.z,
                a.x * b.y - a.y * b.x);
}
 
void Vector3d::ortho(Vector3d v, Vector3d &result)
{
    int k = largestAbsComponent(v) - 1;
    if (k < 0)
    {
        k = 2;
    }
    result.setZero();
    result.setComponent(k, 1.0);
    cross(v, result, result);
    result.normalize();
}
 
int Vector3d::largestAbsComponent(Vector3d v)
{
    double xAbs = fabs(v.x);
    double yAbs = fabs(v.y);
    double zAbs = fabs(v.z);
    if (xAbs > yAbs)
    {
        if (xAbs > zAbs)
        {
            return 0;
        }
        return 2;
    }
    if (yAbs > zAbs)
    {
        return 1;
    }
    return 2;
}