OCCT

// 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.

#include <Aspect_RectangularGrid.hxx>

#include <Standard_NegativeValue.hxx>
#include <Standard_NullValue.hxx>
#include <Standard_NumericError.hxx>

IMPLEMENT_STANDARD_RTTIEXT(Aspect_RectangularGrid,Aspect_Grid)

Aspect_RectangularGrid::Aspect_RectangularGrid(
                               const Standard_Real aXStep,
                               const Standard_Real aYStep,
                               const Standard_Real anXOrigin,
                               const Standard_Real anYOrigin,
                               const Standard_Real aFirstAngle,
                               const Standard_Real aSecondAngle,
                               const Standard_Real aRotationAngle)
:Aspect_Grid(anXOrigin,anYOrigin,aRotationAngle),myXStep(aXStep),myYStep(aYStep),myFirstAngle(aFirstAngle),mySecondAngle(aSecondAngle)

{
  Standard_NumericError_Raise_if(!CheckAngle (aFirstAngle,mySecondAngle),
                                 "networks are parallel");

  Standard_NegativeValue_Raise_if(aXStep < 0. , "invalid x step");
  Standard_NegativeValue_Raise_if(aYStep < 0. , "invalid y step");
  Standard_NullValue_Raise_if(aXStep == 0. , "invalid x step");
  Standard_NullValue_Raise_if(aYStep == 0. , "invalid y step");
}



void Aspect_RectangularGrid::SetXStep(const Standard_Real aStep) {
  Standard_NegativeValue_Raise_if(aStep < 0. , "invalid x step");
  Standard_NullValue_Raise_if(aStep == 0. , "invalid y step");
  myXStep = aStep;
  Init();
  UpdateDisplay();
}

void Aspect_RectangularGrid::SetYStep(const Standard_Real aStep) {
  Standard_NegativeValue_Raise_if(aStep < 0. , "invalid x step");
  Standard_NullValue_Raise_if(aStep == 0. , "invalid y step");
  myYStep = aStep;
  Init();
  UpdateDisplay();
}

void Aspect_RectangularGrid::SetAngle (const Standard_Real anAngle1,
                                       const Standard_Real anAngle2)
{
  Standard_NumericError_Raise_if(!CheckAngle (anAngle1,anAngle2 ),
                                 "axis are parallel");
  myFirstAngle = anAngle1;
  mySecondAngle = anAngle2;
  Init();
  UpdateDisplay();
}

void Aspect_RectangularGrid::SetGridValues(
	const Standard_Real theXOrigin,
	const Standard_Real theYOrigin,
	const Standard_Real theXStep,
	const Standard_Real theYStep,
	const Standard_Real theRotationAngle) {

  myXOrigin = theXOrigin;
  myYOrigin = theYOrigin;
  Standard_NegativeValue_Raise_if(theXStep < 0. , "invalid x step");
  Standard_NullValue_Raise_if(theXStep == 0. , "invalid x step");
  myXStep = theXStep;
  Standard_NegativeValue_Raise_if(theYStep < 0. , "invalid y step");
  Standard_NullValue_Raise_if(theYStep == 0. , "invalid y step");
  myYStep = theYStep;
  myRotationAngle = theRotationAngle;
  Init();
  UpdateDisplay();
}

void Aspect_RectangularGrid::Compute(const Standard_Real X,
                         const Standard_Real Y,
                         Standard_Real& gridX,
                         Standard_Real& gridY) const {
    Standard_Real D1 = b1 * X - a1 * Y - c1;
    Standard_Real D2 = b2 * X - a2 * Y - c2;
    Standard_Integer n1 = Standard_Integer ( Abs(D1)/myXStep + 0.5);
    Standard_Integer n2 = Standard_Integer ( Abs(D2)/myYStep + 0.5);
    Standard_Real offset1 = c1 + Standard_Real(n1) * Sign (myXStep , D1);
    Standard_Real offset2 = c2 + Standard_Real(n2) * Sign (myYStep , D2);
    Standard_Real Delta = a1*b2 - b1*a2;
    gridX = ( offset2*a1 - offset1*a2) /Delta;
    gridY = ( offset2*b1 - offset1*b2) /Delta;
}

Standard_Real Aspect_RectangularGrid::XStep() const {
  return myXStep;
}

Standard_Real Aspect_RectangularGrid::YStep() const {
  return myYStep;
}

Standard_Real Aspect_RectangularGrid::FirstAngle() const {
  return myFirstAngle;
}

Standard_Real Aspect_RectangularGrid::SecondAngle() const {
  return mySecondAngle;
}

void Aspect_RectangularGrid::Init () {

//+zov Fixing CTS17856
//  a1 = Cos (myFirstAngle + RotationAngle() ); 
//  b1 = Sin (myFirstAngle + RotationAngle() );
//  c1 = XOrigin() * b1 - YOrigin() * a1;
//
//  a2 = Cos (mySecondAngle + RotationAngle() + M_PI / 2.); 
//  b2 = Sin (mySecondAngle + RotationAngle() + M_PI / 2.);
//  c2 = XOrigin() * b2 - YOrigin() * a2;

  Standard_Real angle1 = myFirstAngle + RotationAngle();
  Standard_Real angle2 = mySecondAngle + RotationAngle();
  if ( angle1 != 0. ) {
    a1 = -Sin (angle1); 
    b1 = Cos (angle1);
    c1 = XOrigin() * b1 - YOrigin() * a1;
  } else {
    a1 = 0.; b1 = 1.; c1 = XOrigin();
  }

  if ( angle2 != 0. ) {
    angle2 += M_PI / 2.;
    a2 = -Sin (angle2); 
    b2 = Cos (angle2);
    c2 = XOrigin() * b2 - YOrigin() * a2;
  } else {
    a2 = -1.; b2 = 0.; c2 = YOrigin();
  }
//-zov
}

Standard_Boolean Aspect_RectangularGrid::CheckAngle(const Standard_Real alpha,
                                            const Standard_Real beta) const {
  return (Abs( Sin(alpha) * Cos(beta + M_PI / 2.) - Cos(alpha) * Sin(beta + M_PI / 2.)) != 0) ;
}

//=======================================================================
//function : DumpJson
//purpose  : 
//=======================================================================
void Aspect_RectangularGrid::DumpJson (Standard_OStream& theOStream, Standard_Integer theDepth) const
{
  OCCT_DUMP_TRANSIENT_CLASS_BEGIN (theOStream)

  OCCT_DUMP_BASE_CLASS(theOStream, theDepth, Aspect_Grid)

  OCCT_DUMP_FIELD_VALUE_NUMERICAL (theOStream, myXStep)
  OCCT_DUMP_FIELD_VALUE_NUMERICAL (theOStream, myYStep)
  OCCT_DUMP_FIELD_VALUE_NUMERICAL (theOStream, myFirstAngle)
  OCCT_DUMP_FIELD_VALUE_NUMERICAL (theOStream, mySecondAngle)
  OCCT_DUMP_FIELD_VALUE_NUMERICAL (theOStream, a1)
  OCCT_DUMP_FIELD_VALUE_NUMERICAL (theOStream, b1)
  OCCT_DUMP_FIELD_VALUE_NUMERICAL (theOStream, c1)
  OCCT_DUMP_FIELD_VALUE_NUMERICAL (theOStream, a2)
  OCCT_DUMP_FIELD_VALUE_NUMERICAL (theOStream, b2)
  OCCT_DUMP_FIELD_VALUE_NUMERICAL (theOStream, c2)
}