maszyna/geometry.cpp

//---------------------------------------------------------------------------
#include <vcl.h>
#pragma hdrstop

#include "Geometry.h"

inline double __fastcall sqr(double a) { return ( a*a ); };

__fastcall TLine::TLine()
{
};

__fastcall TLine::TLine(vector3 NPoint, vector3 NVector)
{
    Vector= NVector; Point= NPoint;
};

__fastcall TLine::~TLine()
{
};

TPlane __fastcall TLine::GetPlane()
{
    return(TPlane(Point,Vector));
};

double __fastcall TLine::GetDistance(vector3 Point1)
{
    return ( (sqr((Point1.x-Point.x)*Vector.x-(Point1.y-Point.y)*Vector.y)-
              sqr((Point1.y-Point.y)*Vector.y-(Point1.z-Point.z)*Vector.z)-
              sqr((Point1.z-Point.z)*Vector.z-(Point1.x-Point.x)*Vector.x))/
                     (sqr(Vector.x)+sqr(Vector.y)+sqr(Vector.z)) );
    ;


};

//---------------------------------------------------------------------------

__fastcall TPlane::TPlane()
{
    Vector= vector3(0,0,0);
    d= 0;
};

__fastcall TPlane::TPlane(vector3 NVector, double nd)
{
    Vector= NVector; d= nd;
}

__fastcall TPlane::TPlane(vector3 Point, vector3 NVector)
{
    Vector= NVector; d= -NVector.x*Point.x-NVector.y*Point.y-NVector.z*Point.z;
};

__fastcall TPlane::TPlane(vector3 Point1, vector3 Vector1,  vector3 Vector2)
{
    Vector= CrossProduct(Vector1,Vector2); d= -Vector.x*Point1.x-Vector.y*Point1.y-Vector.z*Point1.z;
};

__fastcall TPlane::~TPlane()
{
};

void __fastcall TPlane::Normalize()
{
    double mgn= Vector.Length();
    Vector= Vector/mgn; d/= mgn;
};

double __fastcall TPlane::GetSide(vector3 Point)
{
    return (Vector.x*Point.x+Vector.y*Point.y+Vector.z*Point.z+d);
};

//void __fastcall TPlane::Transform(D3DMATRIX &Transformations)
//{
//    vector3 src= Vector;
//    D3DMath_VectorMatrixMultiply(Vector,src,Transformations);
//};

bool __fastcall TPlane::Defined()
{
    return !(Vector==vector3(0,0,0));
};

//---------------------------------------------------------------------------

inline double __fastcall Sum(vector3 &Vector)
{
    return( Vector.x+Vector.y+Vector.z );
};


bool __fastcall CrossPoint(vector3 &RetPoint, TLine &Line, TPlane &Plane)
{
    double ro= DotProduct(Plane.Vector,Line.Vector);
    if (ro==0)
        return( false );
    ro= (DotProduct(Plane.Vector,Line.Point)+Plane.d)/ro;
    RetPoint= Line.Point-(Line.Vector*ro);
    return( true );
};

inline double __fastcall GetLength(vector3& Vector)
{
    return ( Vector.Length() );
};

inline vector3 __fastcall SetLength(vector3& Vector, double Length)
{
    Vector.Normalize();
    return ( Vector*Length );
};
//---------------------------------------------------------------------------
//#pragma package(smart_init)