[occt.git] / src / Contap / Contap_SurfFunction.gxx

// Created on: 1993-06-03
// Created by: Jacques GOUSSARD
// Copyright (c) 1993-1999 Matra Datavision
// 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.

// jag 940616 #define Tolpetit 1.e-16


#include <gp.hxx>


Contap_SurfFunction::Contap_SurfFunction ():
       myMean(1.),
       myType(Contap_ContourStd),
       myDir(0.,0.,1.),
       myCosAng(0.), // PI/2 - Angle de depouille
       tol(1.e-6),
       computed(Standard_False),
       derived(Standard_False)
{}

void Contap_SurfFunction::Set(const TheSurface& S)
{
  mySurf = S;
  Standard_Integer i;
  Standard_Integer nbs = TheContTool::NbSamplePoints(S);
  Standard_Real U,V;
  gp_Vec norm;
  if (nbs > 0) {
    myMean = 0.;
    for (i = 1; i <= nbs; i++) {
      TheContTool::SamplePoint(S,i,U,V);
//      TheSurfaceTool::D1(S,U,V,solpt,d1u,d1v);
//      myMean = myMean + d1u.Crossed(d1v).Magnitude();
      TheSurfProps::Normale(S,U,V,solpt,norm);
      myMean = myMean + norm.Magnitude();
    }
    myMean = myMean / ((Standard_Real)nbs);
  }
  computed = Standard_False;
  derived = Standard_False;
}


Standard_Integer Contap_SurfFunction::NbVariables () const
{
  return 2;
}

Standard_Integer Contap_SurfFunction::NbEquations () const
{
  return 1;
}


Standard_Boolean Contap_SurfFunction::Value(const math_Vector& X,
					    math_Vector& F)
{
  Usol = X(1); Vsol = X(2);
//  TheSurfaceTool::D1(mySurf,Usol,Vsol,solpt,d1u,d1v);
//  gp_Vec norm(d1u.Crossed(d1v));
  gp_Vec norm;
  TheSurfProps::Normale(mySurf,Usol,Vsol,solpt,norm);
  switch (myType) {
  case Contap_ContourStd:
    {
      F(1) = valf = (norm.Dot(myDir))/myMean;
    }
    break;
  case Contap_ContourPrs:
    {
      F(1) = valf = (norm.Dot(gp_Vec(myEye,solpt)))/myMean;
    }
    break;
  case Contap_DraftStd:
    {
      F(1) = valf = (norm.Dot(myDir)-myCosAng*norm.Magnitude())/myMean;
    }
    break;
  default:
    {
    }
  }
  computed = Standard_False;
  derived = Standard_False;
  return Standard_True;
}


Standard_Boolean Contap_SurfFunction::Derivatives(const math_Vector& X,
						  math_Matrix& Grad)
{
//  gp_Vec d2u,d2v,d2uv;
  Usol = X(1); Vsol = X(2);
//  TheSurfaceTool::D2(mySurf,Usol,Vsol,solpt,d1u,d1v,d2u,d2v,d2uv);

  gp_Vec norm,dnu,dnv;
  TheSurfProps::NormAndDn(mySurf,Usol,Vsol,solpt,norm,dnu,dnv);

  switch (myType) {
  case Contap_ContourStd:
    {
//      Grad(1,1) = ((d2u.Crossed(d1v) + d1u.Crossed(d2uv)).Dot(myDir))/myMean;
//      Grad(1,2) = ((d2uv.Crossed(d1v) + d1u.Crossed(d2v)).Dot(myDir))/myMean;
      Grad(1,1) = (dnu.Dot(myDir))/myMean;
      Grad(1,2) = (dnv.Dot(myDir))/myMean;
    }
    break;
  case Contap_ContourPrs:
    {
      gp_Vec Ep(myEye,solpt);
      Grad(1,1) = (dnu.Dot(Ep))/myMean;
      Grad(1,2) = (dnv.Dot(Ep))/myMean;
    }
    break;
  case Contap_DraftStd:
    {
//      gp_Vec norm(d1u.Crossed(d1v).Normalized());
//      gp_Vec dnorm(d2u.Crossed(d1v) + d1u.Crossed(d2uv));
//      Grad(1,1) = (dnorm.Dot(myDir)-myCosAng*dnorm.Dot(norm))/myMean;
//      dnorm = d2uv.Crossed(d1v) + d1u.Crossed(d2v);
//      Grad(1,2) = (dnorm.Dot(myDir)-myCosAng*dnorm.Dot(norm))/myMean;
      norm.Normalize();
      Grad(1,1) = (dnu.Dot(myDir)-myCosAng*dnu.Dot(norm))/myMean;
      Grad(1,2) = (dnv.Dot(myDir)-myCosAng*dnv.Dot(norm))/myMean;
    }
    break;
  case Contap_DraftPrs:
  default:
    {
    }
  }
  Fpu = Grad(1,1); Fpv = Grad(1,2);
  computed = Standard_False;
  derived = Standard_True;
  return Standard_True;
}


Standard_Boolean Contap_SurfFunction::Values (const math_Vector& X,
					      math_Vector& F,
					      math_Matrix& Grad)
{
//  gp_Vec d2u,d2v,d2uv;

  Usol = X(1); Vsol = X(2);
//  TheSurfaceTool::D2(mySurf,Usol,Vsol,solpt,d1u,d1v,d2u,d2v,d2uv);
//  gp_Vec norm(d1u.Crossed(d1v));
  gp_Vec norm,dnu,dnv;
  TheSurfProps::NormAndDn(mySurf,Usol,Vsol,solpt,norm,dnu,dnv);

  switch (myType) {

  case Contap_ContourStd:
    {
      F(1)      = (norm.Dot(myDir))/myMean;
//      Grad(1,1) = ((d2u.Crossed(d1v) + d1u.Crossed(d2uv)).Dot(myDir))/myMean;
//      Grad(1,2) = ((d2uv.Crossed(d1v) + d1u.Crossed(d2v)).Dot(myDir))/myMean;
      Grad(1,1) = (dnu.Dot(myDir))/myMean;
      Grad(1,2) = (dnv.Dot(myDir))/myMean;
    }
    break;
  case Contap_ContourPrs:
    {
      gp_Vec Ep(myEye,solpt);
      F(1)      = (norm.Dot(Ep))/myMean;
//      Grad(1,1) = ((d2u.Crossed(d1v) + d1u.Crossed(d2uv)).Dot(Ep))/myMean;
//      Grad(1,2) = ((d2uv.Crossed(d1v) + d1u.Crossed(d2v)).Dot(Ep))/myMean;
      Grad(1,1) = (dnu.Dot(Ep))/myMean;
      Grad(1,2) = (dnv.Dot(Ep))/myMean;
    }
    break;
  case Contap_DraftStd:
    {
      F(1) = (norm.Dot(myDir)-myCosAng*norm.Magnitude())/myMean;
      norm.Normalize();
/*
      gp_Vec dnorm(d2u.Crossed(d1v) + d1u.Crossed(d2uv));
      Grad(1,1) = (dnorm.Dot(myDir)-myCosAng*dnorm.Dot(norm))/myMean;
      dnorm = d2uv.Crossed(d1v) + d1u.Crossed(d2v);
      Grad(1,2) = (dnorm.Dot(myDir)-myCosAng*dnorm.Dot(norm))/myMean;
*/
      Grad(1,1) = (dnu.Dot(myDir)-myCosAng*dnu.Dot(norm))/myMean;
      Grad(1,2) = (dnv.Dot(myDir)-myCosAng*dnv.Dot(norm))/myMean;
    }
    break;
  case Contap_DraftPrs:
  default:
    {
    }
  }
  valf = F(1);
  Fpu = Grad(1,1); Fpv = Grad(1,2);
  computed = Standard_False;
  derived = Standard_True;
  return Standard_True;
}


Standard_Boolean Contap_SurfFunction::IsTangent ()
{
  if (!computed) {
    computed = Standard_True;
    if(!derived) {
//      gp_Vec d2u,d2v,d2uv;
//      TheSurfaceTool::D2(mySurf, Usol, Vsol, solpt, d1u, d1v, d2u, d2v, d2uv);
      gp_Vec norm,dnu,dnv;
      TheSurfProps::NormAndDn(mySurf,Usol,Vsol,solpt,norm,dnu,dnv);

      switch (myType) {
      case Contap_ContourStd:
	{
//	  Fpu = ((d2u.Crossed(d1v) + d1u.Crossed(d2uv)).Dot(myDir))/myMean;
//	  Fpv = ((d2uv.Crossed(d1v) + d1u.Crossed(d2v)).Dot(myDir))/myMean;
	  Fpu = (dnu.Dot(myDir))/myMean;
	  Fpv = (dnv.Dot(myDir))/myMean;
	}
	break;
      case Contap_ContourPrs:
	{
	  gp_Vec Ep(myEye,solpt);
//	  Fpu = ((d2u.Crossed(d1v) + d1u.Crossed(d2uv)).Dot(Ep))/myMean;
//	  Fpv = ((d2uv.Crossed(d1v) + d1u.Crossed(d2v)).Dot(Ep))/myMean;
	  Fpu = (dnu.Dot(Ep))/myMean;
	  Fpv = (dnv.Dot(Ep))/myMean;
	}
	break;
      case Contap_DraftStd:
	{
/*
	  gp_Vec norm(d1u.Crossed(d1v).Normalized());
	  gp_Vec dnorm(d2u.Crossed(d1v) + d1u.Crossed(d2uv));
	  Fpu = (dnorm.Dot(myDir)-myCosAng*dnorm.Dot(norm))/myMean;
	  dnorm = d2uv.Crossed(d1v) + d1u.Crossed(d2v);
	  Fpv = (dnorm.Dot(myDir)-myCosAng*dnorm.Dot(norm))/myMean;
*/
	  norm.Normalize();
	  Fpu = (dnu.Dot(myDir)-myCosAng*dnu.Dot(norm))/myMean;
	  Fpv = (dnv.Dot(myDir)-myCosAng*dnv.Dot(norm))/myMean;
	}
	break;
      case Contap_DraftPrs:
      default:
	{
	}
      }
      derived = Standard_True;
    }
    tangent = Standard_False;
    Standard_Real D = Sqrt (Fpu * Fpu + Fpv * Fpv);

    if (D <= gp::Resolution()) {
      tangent = Standard_True;
    }
    else {
      d2d = gp_Dir2d(-Fpv,Fpu);
      gp_Vec d1u,d1v;
      TheSurfaceTool::D1(mySurf, Usol, Vsol, solpt, d1u, d1v); // ajout jag 02.95

      gp_XYZ d3dxyz(-Fpv*d1u.XYZ());
      d3dxyz.Add(Fpu*d1v.XYZ());
      d3d.SetXYZ(d3dxyz);
    
      //jag 940616    if (d3d.Magnitude() <= Tolpetit) {
      if (d3d.Magnitude() <= tol) {
	tangent = Standard_True;
      }
    }
  }
  return tangent;
}
Commit	Line	Data
b311480e	1	// Created on: 1993-06-03
	2	// Created by: Jacques GOUSSARD
	3	// Copyright (c) 1993-1999 Matra Datavision
973c2be1	4	// Copyright (c) 1999-2014 OPEN CASCADE SAS
b311480e	5	//
973c2be1	6	// This file is part of Open CASCADE Technology software library.
b311480e	7	//
d5f74e42	8	// This library is free software; you can redistribute it and/or modify it under
d5f74e42	9	// the terms of the GNU Lesser General Public License version 2.1 as published
973c2be1	10	// by the Free Software Foundation, with special exception defined in the file
	11	// OCCT_LGPL_EXCEPTION.txt. Consult the file LICENSE_LGPL_21.txt included in OCCT
	12	// distribution for complete text of the license and disclaimer of any warranty.
b311480e	13	//
973c2be1	14	// Alternatively, this file may be used under the terms of Open CASCADE
973c2be1	15	// commercial license or contractual agreement.
733a0e55	16
7fd59977	17	// jag 940616 #define Tolpetit 1.e-16
	18
	19
	20	#include <gp.hxx>
	21
	22
	23	Contap_SurfFunction::Contap_SurfFunction ():
	24	myMean(1.),
	25	myType(Contap_ContourStd),
	26	myDir(0.,0.,1.),
	27	myCosAng(0.), // PI/2 - Angle de depouille
	28	tol(1.e-6),
	29	computed(Standard_False),
	30	derived(Standard_False)
	31	{}
	32
	33	void Contap_SurfFunction::Set(const TheSurface& S)
	34	{
	35	mySurf = S;
	36	Standard_Integer i;
	37	Standard_Integer nbs = TheContTool::NbSamplePoints(S);
	38	Standard_Real U,V;
	39	gp_Vec norm;
	40	if (nbs > 0) {
	41	myMean = 0.;
	42	for (i = 1; i <= nbs; i++) {
	43	TheContTool::SamplePoint(S,i,U,V);
	44	// TheSurfaceTool::D1(S,U,V,solpt,d1u,d1v);
	45	// myMean = myMean + d1u.Crossed(d1v).Magnitude();
	46	TheSurfProps::Normale(S,U,V,solpt,norm);
	47	myMean = myMean + norm.Magnitude();
	48	}
	49	myMean = myMean / ((Standard_Real)nbs);
	50	}
	51	computed = Standard_False;
	52	derived = Standard_False;
	53	}
	54
	55
	56	Standard_Integer Contap_SurfFunction::NbVariables () const
	57	{
	58	return 2;
	59	}
	60
	61	Standard_Integer Contap_SurfFunction::NbEquations () const
	62	{
	63	return 1;
	64	}
	65
	66
	67	Standard_Boolean Contap_SurfFunction::Value(const math_Vector& X,
	68	math_Vector& F)
	69	{
	70	Usol = X(1); Vsol = X(2);
	71	// TheSurfaceTool::D1(mySurf,Usol,Vsol,solpt,d1u,d1v);
	72	// gp_Vec norm(d1u.Crossed(d1v));
	73	gp_Vec norm;
	74	TheSurfProps::Normale(mySurf,Usol,Vsol,solpt,norm);
	75	switch (myType) {
	76	case Contap_ContourStd:
	77	{
	78	F(1) = valf = (norm.Dot(myDir))/myMean;
	79	}
	80	break;
81	case Contap_ContourPrs:
82	{
83	F(1) = valf = (norm.Dot(gp_Vec(myEye,solpt)))/myMean;
84	}
85	break;
86	case Contap_DraftStd:
87	{
88	F(1) = valf = (norm.Dot(myDir)-myCosAng*norm.Magnitude())/myMean;
89	}
90	break;
91	default:
92	{
93	}
94	}
95	computed = Standard_False;
96	derived = Standard_False;
97	return Standard_True;
98	}
99
100
101	Standard_Boolean Contap_SurfFunction::Derivatives(const math_Vector& X,
102	math_Matrix& Grad)
103	{
104	// gp_Vec d2u,d2v,d2uv;
105	Usol = X(1); Vsol = X(2);
106	// TheSurfaceTool::D2(mySurf,Usol,Vsol,solpt,d1u,d1v,d2u,d2v,d2uv);
107
108	gp_Vec norm,dnu,dnv;
109	TheSurfProps::NormAndDn(mySurf,Usol,Vsol,solpt,norm,dnu,dnv);
110
111	switch (myType) {
112	case Contap_ContourStd:
113	{
114	// Grad(1,1) = ((d2u.Crossed(d1v) + d1u.Crossed(d2uv)).Dot(myDir))/myMean;
115	// Grad(1,2) = ((d2uv.Crossed(d1v) + d1u.Crossed(d2v)).Dot(myDir))/myMean;
116	Grad(1,1) = (dnu.Dot(myDir))/myMean;
117	Grad(1,2) = (dnv.Dot(myDir))/myMean;
118	}
119	break;
120	case Contap_ContourPrs:
121	{
122	gp_Vec Ep(myEye,solpt);
123	Grad(1,1) = (dnu.Dot(Ep))/myMean;
124	Grad(1,2) = (dnv.Dot(Ep))/myMean;
125	}
126	break;
127	case Contap_DraftStd:
128	{
129	// gp_Vec norm(d1u.Crossed(d1v).Normalized());
130	// gp_Vec dnorm(d2u.Crossed(d1v) + d1u.Crossed(d2uv));
131	// Grad(1,1) = (dnorm.Dot(myDir)-myCosAng*dnorm.Dot(norm))/myMean;
132	// dnorm = d2uv.Crossed(d1v) + d1u.Crossed(d2v);
133	// Grad(1,2) = (dnorm.Dot(myDir)-myCosAng*dnorm.Dot(norm))/myMean;
134	norm.Normalize();
135	Grad(1,1) = (dnu.Dot(myDir)-myCosAng*dnu.Dot(norm))/myMean;
136	Grad(1,2) = (dnv.Dot(myDir)-myCosAng*dnv.Dot(norm))/myMean;
137	}
138	break;
139	case Contap_DraftPrs:
140	default:
141	{
142	}
143	}
144	Fpu = Grad(1,1); Fpv = Grad(1,2);
145	computed = Standard_False;
146	derived = Standard_True;
147	return Standard_True;
148	}
149
150
151	Standard_Boolean Contap_SurfFunction::Values (const math_Vector& X,
152	math_Vector& F,
153	math_Matrix& Grad)
154	{
155	// gp_Vec d2u,d2v,d2uv;
156
157	Usol = X(1); Vsol = X(2);
158	// TheSurfaceTool::D2(mySurf,Usol,Vsol,solpt,d1u,d1v,d2u,d2v,d2uv);
159	// gp_Vec norm(d1u.Crossed(d1v));
160	gp_Vec norm,dnu,dnv;
161	TheSurfProps::NormAndDn(mySurf,Usol,Vsol,solpt,norm,dnu,dnv);
162
163	switch (myType) {
164
165	case Contap_ContourStd:
166	{
167	F(1) = (norm.Dot(myDir))/myMean;
168	// Grad(1,1) = ((d2u.Crossed(d1v) + d1u.Crossed(d2uv)).Dot(myDir))/myMean;
169	// Grad(1,2) = ((d2uv.Crossed(d1v) + d1u.Crossed(d2v)).Dot(myDir))/myMean;
170	Grad(1,1) = (dnu.Dot(myDir))/myMean;
171	Grad(1,2) = (dnv.Dot(myDir))/myMean;
172	}
173	break;
174	case Contap_ContourPrs:
175	{
176	gp_Vec Ep(myEye,solpt);
177	F(1) = (norm.Dot(Ep))/myMean;
178	// Grad(1,1) = ((d2u.Crossed(d1v) + d1u.Crossed(d2uv)).Dot(Ep))/myMean;
179	// Grad(1,2) = ((d2uv.Crossed(d1v) + d1u.Crossed(d2v)).Dot(Ep))/myMean;
180	Grad(1,1) = (dnu.Dot(Ep))/myMean;
181	Grad(1,2) = (dnv.Dot(Ep))/myMean;
182	}
183	break;
184	case Contap_DraftStd:
185	{
186	F(1) = (norm.Dot(myDir)-myCosAng*norm.Magnitude())/myMean;
187	norm.Normalize();
188	/*
189	gp_Vec dnorm(d2u.Crossed(d1v) + d1u.Crossed(d2uv));
190	Grad(1,1) = (dnorm.Dot(myDir)-myCosAng*dnorm.Dot(norm))/myMean;
191	dnorm = d2uv.Crossed(d1v) + d1u.Crossed(d2v);
192	Grad(1,2) = (dnorm.Dot(myDir)-myCosAng*dnorm.Dot(norm))/myMean;
193	*/
194	Grad(1,1) = (dnu.Dot(myDir)-myCosAng*dnu.Dot(norm))/myMean;
195	Grad(1,2) = (dnv.Dot(myDir)-myCosAng*dnv.Dot(norm))/myMean;
196	}
197	break;
198	case Contap_DraftPrs:
199	default:
200	{
201	}
202	}
203	valf = F(1);
204	Fpu = Grad(1,1); Fpv = Grad(1,2);
205	computed = Standard_False;
206	derived = Standard_True;
207	return Standard_True;
208	}
209
210
211	Standard_Boolean Contap_SurfFunction::IsTangent ()
212	{
213	if (!computed) {
214	computed = Standard_True;
215	if(!derived) {
216	// gp_Vec d2u,d2v,d2uv;
217	// TheSurfaceTool::D2(mySurf, Usol, Vsol, solpt, d1u, d1v, d2u, d2v, d2uv);
218	gp_Vec norm,dnu,dnv;
219	TheSurfProps::NormAndDn(mySurf,Usol,Vsol,solpt,norm,dnu,dnv);
220
221	switch (myType) {
222	case Contap_ContourStd:
223	{
224	// Fpu = ((d2u.Crossed(d1v) + d1u.Crossed(d2uv)).Dot(myDir))/myMean;
225	// Fpv = ((d2uv.Crossed(d1v) + d1u.Crossed(d2v)).Dot(myDir))/myMean;
226	Fpu = (dnu.Dot(myDir))/myMean;
227	Fpv = (dnv.Dot(myDir))/myMean;
228	}
229	break;
230	case Contap_ContourPrs:
231	{
232	gp_Vec Ep(myEye,solpt);
233	// Fpu = ((d2u.Crossed(d1v) + d1u.Crossed(d2uv)).Dot(Ep))/myMean;
234	// Fpv = ((d2uv.Crossed(d1v) + d1u.Crossed(d2v)).Dot(Ep))/myMean;
235	Fpu = (dnu.Dot(Ep))/myMean;
236	Fpv = (dnv.Dot(Ep))/myMean;
237	}
238	break;
239	case Contap_DraftStd:
240	{
241	/*
242	gp_Vec norm(d1u.Crossed(d1v).Normalized());
243	gp_Vec dnorm(d2u.Crossed(d1v) + d1u.Crossed(d2uv));
244	Fpu = (dnorm.Dot(myDir)-myCosAng*dnorm.Dot(norm))/myMean;
245	dnorm = d2uv.Crossed(d1v) + d1u.Crossed(d2v);
246	Fpv = (dnorm.Dot(myDir)-myCosAng*dnorm.Dot(norm))/myMean;
247	*/
248	norm.Normalize();
249	Fpu = (dnu.Dot(myDir)-myCosAng*dnu.Dot(norm))/myMean;
250	Fpv = (dnv.Dot(myDir)-myCosAng*dnv.Dot(norm))/myMean;
251	}
252	break;
253	case Contap_DraftPrs:
254	default:
255	{
256	}
257	}
258	derived = Standard_True;
259	}
260	tangent = Standard_False;
261	Standard_Real D = Sqrt (Fpu * Fpu + Fpv * Fpv);
262
263	if (D <= gp::Resolution()) {
264	tangent = Standard_True;
265	}
266	else {
267	d2d = gp_Dir2d(-Fpv,Fpu);
268	gp_Vec d1u,d1v;
269	TheSurfaceTool::D1(mySurf, Usol, Vsol, solpt, d1u, d1v); // ajout jag 02.95
270
271	gp_XYZ d3dxyz(-Fpv*d1u.XYZ());
272	d3dxyz.Add(Fpu*d1v.XYZ());
273	d3d.SetXYZ(d3dxyz);
274
275	//jag 940616 if (d3d.Magnitude() <= Tolpetit) {
276	if (d3d.Magnitude() <= tol) {
277	tangent = Standard_True;
278	}
279	}
280	}
281	return tangent;
282	}