0026738: Make Boolean operations safely treating arguments when running with fuzzy...

[occt.git] / src / V3d / V3d_DirectionalLight.cxx

// Copyright (c) 1999-2014 OPEN CASCADE SAS
//
// This file is part of Open CASCADE Technology software library.
//
// This library is free software; you can redistribute it and/or modify it under
// the terms of the GNU Lesser General Public License version 2.1 as published
// by the Free Software Foundation, with special exception defined in the file
// OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT
// distribution for complete text of the license and disclaimer of any warranty.
//
// Alternatively, this file may be used under the terms of Open CASCADE
// commercial license or contractual agreement.

/***********************************************************************
     FONCTION :
     ----------
        Classe V3d_DirectionalLight :
     HISTORIQUE DES MODIFICATIONS   :
     --------------------------------
      00-09-92 : GG  ; Creation.
      18-06-96 : FMN ; Ajout MyGraphicStructure1 pour sauvegarder snopick
      24-12-97 : FMN ; Remplacement de math par MathGra
      31-12-97 : CAL ; Suppression de MathGra
      21-01-98 : CAL ; Window de Xw et WNT remplacee par Aspect_Window
      23-02-98 : FMN ; Remplacement PI par Standard_PI
      30-03-98 : ZOV ; PRO6774 (reconstruction of the class hierarchy and suppressing useless methods)
************************************************************************/
/*----------------------------------------------------------------------*/
/*
 * Includes
 */

#include <Aspect_Window.hxx>
#include <gp_Ax1.hxx>
#include <gp_Dir.hxx>
#include <gp_Pnt.hxx>
#include <gp_Trsf.hxx>
#include <gp_Vec.hxx>
#include <Graphic3d_ArrayOfSegments.hxx>
#include <Graphic3d_AspectLine3d.hxx>
#include <Graphic3d_AspectMarker3d.hxx>
#include <Graphic3d_AspectText3d.hxx>
#include <Graphic3d_Group.hxx>
#include <Graphic3d_Structure.hxx>
#include <Graphic3d_Vector.hxx>
#include <Graphic3d_Vertex.hxx>
#include <Standard_Type.hxx>
#include <TColStd_Array2OfReal.hxx>
#include <V3d.hxx>
#include <V3d_BadValue.hxx>
#include <V3d_DirectionalLight.hxx>
#include <V3d_View.hxx>
#include <V3d_Viewer.hxx>

IMPLEMENT_STANDARD_RTTIEXT(V3d_DirectionalLight,V3d_PositionLight)

// =======================================================================
// function : V3d_DirectionalLight
// purpose  :
// =======================================================================
V3d_DirectionalLight::V3d_DirectionalLight (const Handle(V3d_Viewer)& theViewer,
                                            const V3d_TypeOfOrientation theDirection,
                                            const Quantity_NameOfColor theColor,
                                            const Standard_Boolean theIsHeadlight)
: V3d_PositionLight (theViewer)
{
  Graphic3d_Vector aV = V3d::GetProjAxis (theDirection);
  SetType (V3d_DIRECTIONAL);
  SetColor (theColor);
  SetHeadlight (theIsHeadlight);
  SetTarget (0., 0., 0.);
  SetPosition (-aV.X(), -aV.Y(), -aV.Z());
}

// =======================================================================
// function : V3d_DirectionalLight
// purpose  :
// =======================================================================
V3d_DirectionalLight::V3d_DirectionalLight (const Handle(V3d_Viewer)& theViewer,
                                            const Standard_Real theXt,
                                            const Standard_Real theYt,
                                            const Standard_Real theZt,
                                            const Standard_Real theXp,
                                            const Standard_Real theYp,
                                            const Standard_Real theZp,
                                            const Quantity_NameOfColor theColor,
                                            const Standard_Boolean theIsHeadlight)
: V3d_PositionLight (theViewer)
{
  SetType (V3d_DIRECTIONAL);
  SetColor (theColor);
  SetHeadlight (theIsHeadlight);
  SetTarget (theXt, theYt, theZt);
  SetPosition (theXp, theYp, theZp);
}

// =======================================================================
// function : SetSmoothAngle
// purpose  :
// =======================================================================
void V3d_DirectionalLight::SetSmoothAngle (const Standard_Real theValue)
{
  V3d_BadValue_Raise_if (theValue < 0.0 || theValue > M_PI / 2.0,
    "Bad value for smoothing angle");

  myLight.Smoothness = static_cast<Standard_ShortReal> (theValue);
}

// =======================================================================
// function : SetDirection
// purpose  :
// =======================================================================
void V3d_DirectionalLight::SetDirection (const V3d_TypeOfOrientation theDirection)
{
  Graphic3d_Vector aV = V3d::GetProjAxis (theDirection);
  SetDirection (aV.X(), aV.Y(), aV.Z());
}

// =======================================================================
// function : SetDirection
// purpose  :
// =======================================================================
void V3d_DirectionalLight::SetDirection (const Standard_Real theVx,
                                         const Standard_Real theVy,
                                         const Standard_Real theVz)
{
  V3d_BadValue_Raise_if (Sqrt (theVx * theVx + theVy * theVy + theVz * theVz) <= 0.,
                         "V3d_DirectionalLight::SetDirection, "
                         "null vector" );

  Graphic3d_Vector aV (theVx, theVy, theVz);
  aV.Normalize();

  myLight.Direction.x() = static_cast<Standard_ShortReal> (aV.X());
  myLight.Direction.y() = static_cast<Standard_ShortReal> (aV.Y());
  myLight.Direction.z() = static_cast<Standard_ShortReal> (aV.Z());
}

// =======================================================================
// function : SetDisplayPosition
// purpose  :
// =======================================================================
void V3d_DirectionalLight::SetDisplayPosition (const Standard_Real theX,
                                               const Standard_Real theY,
                                               const Standard_Real theZ)
{
  myDisplayPosition.SetCoord(theX, theY, theZ);

  Standard_Real aXt, aYt, aZt;
  Target (aXt, aYt, aZt);

  Standard_Real aXd = aXt - theX;
  Standard_Real aYd = aYt - theY;
  Standard_Real aZd = aZt - theZ;
  if (!Graphic3d_Vector (aXd, aYd, aZd).LengthZero())
  {
    SetDirection (aXd, aYd, aZd);
  }
}

// =======================================================================
// function : SetPosition
// purpose  :
// =======================================================================
void V3d_DirectionalLight::SetPosition (const Standard_Real theXp,
                                        const Standard_Real theYp,
                                        const Standard_Real theZp)
{
  SetDisplayPosition (theXp, theYp, theZp);
}

// =======================================================================
// function : Position
// purpose  :
// =======================================================================
void V3d_DirectionalLight::Position (Standard_Real& theXp,
                                     Standard_Real& theYp,
                                     Standard_Real& theZp) const
{
  DisplayPosition (theXp, theYp, theZp) ;
}

// =======================================================================
// function : DisplayPosition
// purpose  :
// =======================================================================
void V3d_DirectionalLight::DisplayPosition (Standard_Real& theXp,
                                            Standard_Real& theYp,
                                            Standard_Real& theZp) const
{
  myDisplayPosition.Coord (theXp, theYp, theZp) ;
}

// =======================================================================
// function : DisplayPosition
// purpose  :
// =======================================================================
void V3d_DirectionalLight::Symbol (const Handle(Graphic3d_Group)& theSymbol, const Handle(V3d_View)& theView) const
{
  Standard_Real Xi,Yi,Zi,Xf,Yf,Zf,Rayon,PXT,PYT,X,Y,Z,XT,YT,ZT;
  Standard_Real A,B,C,Dist,Beta,CosBeta,SinBeta,Coef,X1,Y1,Z1;
  Standard_Real DX,DY,DZ,VX,VY,VZ;
  Standard_Integer IXP,IYP,j;
  TColStd_Array2OfReal MatRot(0,2,0,2);

  theView->Proj(VX,VY,VZ);
  this->DisplayPosition(Xi,Yi,Zi);
  Rayon = this->Radius();
  theView->Project(Xi,Yi,Zi,PXT,PYT); 
  theView->Convert(PXT,PYT,IXP,IYP);
//  Coordinated 3d in the plane of projection of the source.
  theView->Convert(IXP,IYP,XT,YT,ZT);
  theView->Convert(PXT,PYT+Rayon,IXP,IYP);
  theView->Convert(IXP,IYP,X,Y,Z);
  X = X+Xi-XT; Y = Y+Yi-YT; Z = Z+Zi-ZT;
  Dist = Sqrt( Square(X-Xi) + Square(Y-Yi) + Square(Z-Zi) );
//  Axis of rotation.
  A = (X-Xi)/Dist;
  B = (Y-Yi)/Dist;
  C = (Z-Zi)/Dist;

//  A sphere is drawn
  V3d::CircleInPlane(theSymbol,Xi,Yi,Zi,VX,VY,VZ,Rayon/40.);
  for( j=1 ; j<=3 ; j++ ) {
    Beta = j * M_PI / 4.;
    CosBeta = Cos(Beta);
    SinBeta = Sin(Beta);
    Coef = 1. - CosBeta;
    MatRot(0,0) =  A * A + (1. - A * A) * CosBeta;
    MatRot(0,1) = -C * SinBeta + Coef * A * B;
    MatRot(0,2) =  B * SinBeta + Coef * A * C;
    MatRot(1,0) =  C * SinBeta + Coef * A * B; 
    MatRot(1,1) =  B * B + (1. - B * B) * CosBeta;
    MatRot(1,2) = -A * SinBeta + Coef * B * C;
    MatRot(2,0) = -B * SinBeta + Coef * A * C;
    MatRot(2,1) =  A * SinBeta + Coef * B * C;
    MatRot(2,2) =  C * C + (1. - C * C) * CosBeta;
    Xf = Xi * MatRot(0,0) + Yi * MatRot(0,1) + Zi * MatRot(0,2);
    Yf = Xi * MatRot(1,0) + Yi * MatRot(1,1) + Zi * MatRot(1,2);
    Zf = Xi * MatRot(2,0) + Yi * MatRot(2,1) + Zi * MatRot(2,2);
//    Rotation of the normal
    X1 = VX * MatRot(0,0) + VY * MatRot(0,1) + VZ * MatRot(0,2);
    Y1 = VX * MatRot(1,0) + VY * MatRot(1,1) + VZ * MatRot(1,2);
    Z1 = VX * MatRot(2,0) + VY * MatRot(2,1) + VZ * MatRot(2,2);
    VX = X1 + Xi - Xf ; VY = Y1 + Yi - Yf ; VZ = Z1 + Zi - Zf;
    V3d::CircleInPlane(theSymbol,Xi,Yi,Zi,VX,VY,VZ,Rayon/40.);
  }

//  The arrow is drawn
  Rayon = this->Radius();
  this->Direction(DX,DY,DZ);
  X = Xi + DX*Rayon/10.; Y = Yi + DY*Rayon/10.; Z = Zi + DZ*Rayon/10.;

  Handle(Graphic3d_ArrayOfSegments) aPrims = new Graphic3d_ArrayOfSegments(2);
  aPrims->AddVertex(Standard_ShortReal(Xi),Standard_ShortReal(Yi),Standard_ShortReal(Zi));
  aPrims->AddVertex(Standard_ShortReal(X),Standard_ShortReal(Y),Standard_ShortReal(Z));
  theSymbol->AddPrimitiveArray(aPrims);

  V3d::ArrowOfRadius(theSymbol, X, Y, Z, DX, DY, DZ, M_PI / 15., Rayon / 20.);
}

// =======================================================================
// function : Display
// purpose  :
// =======================================================================
void V3d_DirectionalLight::Display (const Handle(V3d_View)& theView,
                                    const V3d_TypeOfRepresentation theTPres)
{
  Standard_Real X,Y,Z,Rayon;
  Standard_Real X0,Y0,Z0,VX,VY,VZ;
  Standard_Real X1,Y1,Z1;
  Standard_Real DXRef,DYRef,DZRef,DXini,DYini,DZini;
  Standard_Real R1,G1,B1;
  V3d_TypeOfRepresentation Pres;
  V3d_TypeOfUpdate UpdSov;

//  Creation of a structure of markable elements (position of the
//  light, and the domain of lighting represented by a circle)
//  Creation of a structure of non-markable elements (target, meridian and 
//  parallel).

    Pres = theTPres;
    Handle(V3d_Viewer) TheViewer = theView->Viewer();
    UpdSov = TheViewer->UpdateMode();
    TheViewer->SetUpdateMode(V3d_WAIT);
    if (!myGraphicStructure.IsNull()) {
       myGraphicStructure->Disconnect(myGraphicStructure1);
       myGraphicStructure->Clear();
       myGraphicStructure1->Clear();
       if (Pres == V3d_SAMELAST) Pres = myTypeOfRepresentation;
    }
    else {
      if (Pres == V3d_SAMELAST) Pres = V3d_SIMPLE;
      Handle(Graphic3d_Structure) slight = new Graphic3d_Structure(TheViewer->StructureManager());
      myGraphicStructure = slight;
      Handle(Graphic3d_Structure) snopick = new Graphic3d_Structure(TheViewer->StructureManager()); 
      myGraphicStructure1 = snopick;
    }
  
  Handle(Graphic3d_Group) glight  = myGraphicStructure->NewGroup();
  Handle(Graphic3d_Group) gsphere;
  if (Pres == V3d_COMPLETE
   || Pres == V3d_PARTIAL)
  {
    gsphere = myGraphicStructure->NewGroup();
  }
  
  Handle(Graphic3d_Group) gnopick = myGraphicStructure1->NewGroup();
  
  X0 = myTarget.X();
  Y0 = myTarget.Y();
  Z0 = myTarget.Z();

//Display of the position of the light.

  this->Color(Quantity_TOC_RGB,R1,G1,B1);
  Quantity_Color Col1(R1,G1,B1,Quantity_TOC_RGB);
  Handle(Graphic3d_AspectLine3d) Asp1 = new Graphic3d_AspectLine3d();
  Asp1->SetColor(Col1);
  glight->SetPrimitivesAspect(Asp1);
  this->Symbol(glight,theView);
  
  // Display of the markable sphere (limit at the circle).

  if (Pres == V3d_COMPLETE || Pres == V3d_PARTIAL) {
    
    Rayon = this->Radius(); 
    theView->Proj(VX,VY,VZ);
    V3d::CircleInPlane(gsphere,X0,Y0,Z0,VX,VY,VZ,Rayon);
    
//Display of the meridian

    Quantity_Color Col2(Quantity_NOC_GREEN);
    Handle(Graphic3d_AspectLine3d) Asp2 = new Graphic3d_AspectLine3d
      (Col2,Aspect_TOL_SOLID,1.);
    gnopick->SetPrimitivesAspect(Asp2);
    
//    Definition of the axis of circle
    theView->Up(DXRef,DYRef,DZRef);
    this->DisplayPosition(X,Y,Z);
    DXini = X-X0; DYini = Y-Y0; DZini = Z-Z0;
    VX = DYRef*DZini - DZRef*DYini;
    VY = DZRef*DXini - DXRef*DZini;
    VZ = DXRef*DYini - DYRef*DXini;
    
    V3d::CircleInPlane(gnopick,X0,Y0,Z0,VX,VY,VZ,Rayon);
      
//  Display of the parallel

//    Definition of the axis of circle
    theView->Proj(VX,VY,VZ);
    theView->Up(X1,Y1,Z1);
    DXRef = VY * Z1 - VZ * Y1;
    DYRef = VZ * X1 - VX * Z1;
    DZRef = VX * Y1 - VY * X1;
    this->DisplayPosition(X,Y,Z);
    DXini = X-X0; DYini = Y-Y0; DZini = Z-Z0;
    VX = DYRef*DZini - DZRef*DYini;
    VY = DZRef*DXini - DXRef*DZini;
    VZ = DXRef*DYini - DYRef*DXini;
    
    V3d::CircleInPlane(gnopick,X0,Y0,Z0,VX,VY,VZ,Rayon);
    
  }
  
  myGraphicStructure->Connect(myGraphicStructure1,Graphic3d_TOC_DESCENDANT);
//    cout << "MyGraphicStructure exploration \n" << flush; MyGraphicStructure->Exploration();
  myTypeOfRepresentation = Pres;
  myGraphicStructure->Display();
  TheViewer->SetUpdateMode(UpdSov);
}

// =======================================================================
// function : Direction
// purpose  :
// =======================================================================
void V3d_DirectionalLight::Direction (Standard_Real& theVx,
                                      Standard_Real& theVy,
                                      Standard_Real& theVz) const
{
  theVx = myLight.Direction.x();
  theVy = myLight.Direction.y();
  theVz = myLight.Direction.z();
}