mass_data.cpp

/*********************************************************************/
/*                                                                   */
/*             Config files library - (C) JM 2020                    */
/*                                                                   */
/*********************************************************************/
/*                          Warszawa, 2020                           */
/*********************************************************************/
/*                                                                   */
/* File: geom_data.h                                                 */
/*                                                                   */
/* Author: J.Mieloszyk, modif. T.Grabowski                           */
/*                                                                   */
/* Contents - data of basic geometry objects (class)                 */
/*                                                                   */
/*                                                                   */
/*********************************************************************/
/*                                                                   */
/*                                                                   */
 
#include "mass_data.h"
 
using namespace std;
 
MASS_OBJECT_DATA::MASS_OBJECT_DATA( void ){ Clean (); }
 
MASS_OBJECT_DATA::~MASS_OBJECT_DATA( void ){}
 
void MASS_OBJECT_DATA::Clean( void )
{
    Active = 1;
 
    Name = "-";
    Type = M_POINT; 
    Color = 3; // FL_YELLOW
    
    Base.GetFrom(0., 0., 0.);
    Tip.GetFrom (0., 0., 1.);
    Side.GetFrom(1., 0., 0.);
    
    R = 0.;
    H = 0.;
    a = 0.;
    b = 0.;
    c = 0.;
    th = 0.;
 
    m   = 0.;
    ro  = 0.;
    Vol = 0.;
 
    CoordinateSystems();
}
 
int MASS_OBJECT_DATA::CheckData(bool CheckMassFlag)
{
    if(m == 0 && CheckMassFlag == 1) return 1;
    
    //if(Base == Tip)  return 2;
    //if(Base == Side) return 3;
    if(Tip == Side)  return 4;
 
    if(Type != M_POINT)
    {
        if(Type == SPHERE || Type == CYLINDER || Type == TUBE || Type == CONE || Type == DISC)
            if(R == 0) return 5;
 
        if(Type == TUBE)
        {
            if(r == 0) return 6;
            if(r >= R) return 9;
        }
 
        if(Type == CYLINDER || Type == TUBE || Type == CONE)
            if(H == 0) return 7;
 
        if(Type == CUBOID)
            if(a == 0 || b == 0 || c == 0) return 8;
    }
 
    VECTOR_3D v1 = Tip;// - Base;
    v1.Normalize();
    VECTOR_3D v2 = Side;// - Base;
    v2.Normalize();
    if(v1 == v2) return 10;
 
    return 0;
}
 
int MASS_OBJECT_DATA::CoordinateSystems()
{
    //SELF
    ks = Tip;   // z - direction
    ks.Normalize();
 
    is = Side;  // x - direction
    is.Normalize();
 
    if(is == ks) 
    {
        clog << "is == ks !!!" << endl << endl; 
        return 1;    
    }
 
    js = ks % is; //cross product of versors k & i, y - direction
    js.Normalize();
 
    //LOCAL
    il.GetFrom(1, 0, 0);
    jl.GetFrom(0, 1, 0);
    kl.GetFrom(0, 0, 1);
    
    //GLOBAL
    ig = il;
    jg = jl;
    kg = kl;
 
    return 0;
}
 
void MASS_OBJECT_DATA::Read(std::ifstream &in)
{
    int Id;
    string sVal;
    
    in >> Id >> Active >> Name >> sVal;
 
    Type = M_POINT;
        if(sVal.compare("M_POINT") == 0) Type = M_POINT;
    else if(sVal.compare("SPHERE") == 0) Type = SPHERE;
    else if(sVal.compare("CUBOID") == 0) Type = CUBOID;
    else if(sVal.compare("CYLINDER") == 0) Type = CYLINDER;
    else if(sVal.compare("TUBE") == 0) Type = TUBE;
    else if(sVal.compare("CONE") == 0) Type = CONE;
    else if(sVal.compare("DISC") == 0) Type = DISC;
    
    in >> m >> ro >> Vol;
 
    in >> CG_g.x >> CG_g.y >> CG_g.z;    
 
    in >> I_l.xx >> I_l.yy >> I_l.zz;
    in >> I_l.xy >> I_l.yz >> I_l.zx;
 
    I_l.yx = I_l.xy;
    I_l.zy = I_l.yz;
    I_l.xz = I_l.zx;
 
    if(Type == M_POINT) //For arbitrary assigned moments of inertia (no rotation allowed!)
    {
        I_s.xx = I_l.xx;
        I_s.yy = I_l.yy;
        I_s.zz = I_l.zz;
        
        I_s.yx = I_s.xy = I_l.xy;
        I_s.zy = I_s.yz = I_l.yz;
        I_s.xz = I_s.zx = I_l.zx;
    }
 
    in >> Base.x >> Base.y >> Base.z;   
    in >> Tip.x >> Tip.y >> Tip.z;          
    in >> Side.x >> Side.y >> Side.z;           
    
    in >> R >> r >> H >> a >> b >> c >> th;
 
    in >> Color;
}
 
void MASS_OBJECT_DATA::Write(std::ofstream &out, int Id)
{
    out << setw(4) << std::left << Id;
    out << setw(8) << std::left << Active;
    out << setw(80) << std::left << Name;
    
    if(Name.length() >= 80)
        out << " ";
 
    switch(Type)
    {
        case M_POINT    : out << setw(12) << std::left << "POINT";  break;
        case SPHERE     : out << setw(12) << std::left << "SPHERE"; break;
        case CUBOID     : out << setw(12) << std::left << "CUBOID"; break;
        case CYLINDER   : out << setw(12) << std::left << "CYLINDER"; break;
        case TUBE       : out << setw(12) << std::left << "TUBE";   break;
        case CONE       : out << setw(12) << std::left << "CONE";   break;
        case DISC       : out << setw(12) << std::left << "DISC";   break;
    }
 
    out << setw(12) << std::left << m;
    out << setw(12) << std::left << ro;
    out << setw(12) << std::left << Vol;
    
    out << setw(12) << std::left << CG_g.x; 
    out << setw(12) << std::left << CG_g.y;  
    out << setw(12) << std::left << CG_g.z;  
 
    out << setw(12) << std::left << I_l.xx;
    out << setw(12) << std::left << I_l.yy;
    out << setw(12) << std::left << I_l.zz;
    out << setw(12) << std::left << I_l.xy;
    out << setw(12) << std::left << I_l.yz;
    out << setw(12) << std::left << I_l.zx;
 
    out << setw(12) << std::left << Base.x; 
    out << setw(12) << std::left << Base.y; 
    out << setw(12) << std::left << Base.z; 
    out << setw(12) << std::left << Tip.x;          
    out << setw(12) << std::left << Tip.y;          
    out << setw(12) << std::left << Tip.z;          
    out << setw(12) << std::left << Side.x;         
    out << setw(12) << std::left << Side.y;         
    out << setw(12) << std::left << Side.z;         
    
    out << setw(12) << std::left << R;
    out << setw(12) << std::left << r;
    out << setw(12) << std::left << H;
    out << setw(12) << std::left << a;
    out << setw(12) << std::left << b;
    out << setw(12) << std::left << c;
    out << setw(12) << std::left << th;
    
    out << setw(4) << std::left << Color << endl;
}