---

Vector.cpp

Go to the documentation of this file.

#define WANT_STREAM                  // include.h will get stream fns
#define WANT_MATH                    // include.h will get math fns
                                     // newmatap.h will get include.h
#include <newmatap.h>                // need matrix applications
#include <newmatio.h>                // need matrix output routines

#ifdef use_namespace
using namespace NEWMAT;              // access NEWMAT namespace
#endif

#include "Vector.h"
#include "Debug.h"
#include <math.h>


double Vector::DotProduct(const BaseClass& a, const BaseClass& b)
{
        ASSERT(a.Ncols() == b.Ncols());

        int nCols = a.Ncols();
        double r = 0;
        
        for (int i = 1; i <= nCols; i++)
                r += a(i) * b(i);

        return r;
}

double Vector::CrossProductMag(const BaseClass& a, const BaseClass& b)
{
        double dAngleAB = 0;
        return DotProduct(a, b) * sin(dAngleAB);
}

/* static */
double Vector::DistFromPtToLine(const BaseClass& x, const BaseClass& a, const BaseClass& b)
{
        double m, t, n = 0, d = 0;
        int i, k = x.Ncols();

        ASSERT(k == a.Ncols() && k == b.Ncols());

        for (i = 1; i <= k; i++)
        {
                m = b(i) - a(i);
                n += m * (x(i) - a(i));
                d += m * m;
        }

        t = n / d;

        if (t >= 0 && t <= 1)
                return Norm2((a - x) + (b - a) * t);
        else
                return ((n = Norm2(a - x)) < (d = Norm2(b - x))) ? n:d;
}

---