OCCT

// Created on: 1995-12-04
// Created by: Laurent BOURESCHE
// Copyright (c) 1995-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.

#include <GeomFill_Boundary.hxx>
#include <GeomFill_CoonsAlgPatch.hxx>
#include <gp_Pnt.hxx>
#include <gp_Vec.hxx>
#include <gp_XYZ.hxx>
#include <Law_Linear.hxx>
#include <Standard_Type.hxx>

IMPLEMENT_STANDARD_RTTIEXT(GeomFill_CoonsAlgPatch, Standard_Transient)

//=================================================================================================

GeomFill_CoonsAlgPatch::GeomFill_CoonsAlgPatch(const occ::handle<GeomFill_Boundary>& B1,
                                               const occ::handle<GeomFill_Boundary>& B2,
                                               const occ::handle<GeomFill_Boundary>& B3,
                                               const occ::handle<GeomFill_Boundary>& B4)
{
  bound[0] = B1;
  bound[1] = B2;
  bound[2] = B3;
  bound[3] = B4;
  double deb0, deb1, fin0, fin1;

  B2->Bounds(deb1, fin1);
  occ::handle<Law_Linear> aLaw0 = new Law_Linear();
  aLaw0->Set(deb1, 1., fin1, 0.);
  a[0] = aLaw0;

  B1->Bounds(deb0, fin0);
  occ::handle<Law_Linear> aLaw1 = new Law_Linear();
  aLaw1->Set(deb0, 0., fin0, 1.);
  a[1] = aLaw1;

  gp_XYZ temp;
  temp = B4->Value(deb1).XYZ().Added(B1->Value(deb0).XYZ());
  temp.Multiply(0.5);
  c[0].SetXYZ(temp);
  temp = B1->Value(fin0).XYZ().Added(B2->Value(deb1).XYZ());
  temp.Multiply(0.5);
  c[1].SetXYZ(temp);
  temp = B2->Value(fin1).XYZ().Added(B3->Value(fin0).XYZ());
  temp.Multiply(0.5);
  c[2].SetXYZ(temp);
  temp = B3->Value(deb0).XYZ().Added(B4->Value(fin1).XYZ());
  temp.Multiply(0.5);
  c[3].SetXYZ(temp);
}

//=================================================================================================

void GeomFill_CoonsAlgPatch::SetFunc(const occ::handle<Law_Function>& f1,
                                     const occ::handle<Law_Function>& f2)
{
  a[0] = f1;
  a[1] = f2;
}

//=================================================================================================

void GeomFill_CoonsAlgPatch::Func(occ::handle<Law_Function>& f1,
                                  occ::handle<Law_Function>& f2) const
{
  f1 = a[0];
  f2 = a[1];
}

//=================================================================================================

gp_Pnt GeomFill_CoonsAlgPatch::Value(const double U, const double V) const
{
  double a0, a1, a2, a3;
  a0 = a[0]->Value(V);
  a1 = a[1]->Value(U);
  a2 = 1. - a0;
  a3 = 1. - a1;
  gp_XYZ cor, cortemp;

  cor = bound[0]->Value(V).XYZ();
  cor.Multiply(a0);

  cortemp = bound[1]->Value(V).XYZ();
  cortemp.Multiply(a1);
  cor.Add(cortemp);

  cortemp = bound[2]->Value(V).XYZ();
  cortemp.Multiply(a2);
  cor.Add(cortemp);

  cortemp = bound[3]->Value(V).XYZ();
  cortemp.Multiply(a3);
  cor.Add(cortemp);

  cortemp = c[0].XYZ();
  cortemp.Multiply(-a0 * a3);
  cor.Add(cortemp);

  cortemp = c[1].XYZ();
  cortemp.Multiply(-a0 * a1);
  cor.Add(cortemp);

  cortemp = c[2].XYZ();
  cortemp.Multiply(-a1 * a2);
  cor.Add(cortemp);

  cortemp = c[3].XYZ();
  cortemp.Multiply(-a2 * a3);
  cor.Add(cortemp);

  return gp_Pnt(cor);
}

//=================================================================================================

gp_Vec GeomFill_CoonsAlgPatch::D1U(const double U, const double V) const
{
  double a0, a1, a2, a3, bid;
  a0 = a[0]->Value(V);
  a[1]->D1(U, bid, a1);
  a2 = 1 - a0;
  a3 = -a1;
  gp_XYZ cor, cortemp;
  gp_Pnt pbid;
  gp_Vec vbid;

  bound[0]->D1(U, pbid, vbid);
  cor = vbid.XYZ();
  cor.Multiply(a0);

  cortemp = bound[1]->Value(V).XYZ();
  cortemp.Multiply(a1);
  cor.Add(cortemp);

  bound[2]->D1(U, pbid, vbid);
  cortemp = vbid.XYZ();
  cortemp.Multiply(a2);
  cor.Add(cortemp);

  cortemp = bound[3]->Value(V).XYZ();
  cortemp.Multiply(a3);
  cor.Add(cortemp);

  cortemp = c[0].XYZ();
  cortemp.Multiply(-a0 * a3);
  cor.Add(cortemp);

  cortemp = c[1].XYZ();
  cortemp.Multiply(-a0 * a1);
  cor.Add(cortemp);

  cortemp = c[2].XYZ();
  cortemp.Multiply(-a1 * a2);
  cor.Add(cortemp);

  cortemp = c[3].XYZ();
  cortemp.Multiply(-a2 * a3);
  cor.Add(cortemp);

  vbid.SetXYZ(cor);
  return vbid;
}

//=================================================================================================

gp_Vec GeomFill_CoonsAlgPatch::D1V(const double U, const double V) const
{
  double a0, a1, a2, a3, bid;
  a[0]->D1(V, bid, a0);
  a1 = a[1]->Value(U);
  a2 = -a0;
  a3 = 1. - a1;
  gp_XYZ cor, cortemp;
  gp_Pnt pbid;
  gp_Vec vbid;

  cor = bound[0]->Value(U).XYZ();
  cor.Multiply(a0);

  bound[1]->D1(V, pbid, vbid);
  cortemp = vbid.XYZ();
  cortemp.Multiply(a1);
  cor.Add(cortemp);

  cortemp = bound[2]->Value(U).XYZ();
  cortemp.Multiply(a2);
  cor.Add(cortemp);

  bound[3]->D1(V, pbid, vbid);
  cortemp = vbid.XYZ();
  cortemp.Multiply(a3);
  cor.Add(cortemp);

  cortemp = c[0].XYZ();
  cortemp.Multiply(-a0 * a3);
  cor.Add(cortemp);

  cortemp = c[1].XYZ();
  cortemp.Multiply(-a0 * a1);
  cor.Add(cortemp);

  cortemp = c[2].XYZ();
  cortemp.Multiply(-a1 * a2);
  cor.Add(cortemp);

  cortemp = c[3].XYZ();
  cortemp.Multiply(-a2 * a3);
  cor.Add(cortemp);

  vbid.SetXYZ(cor);
  return vbid;
}

//=================================================================================================

gp_Vec GeomFill_CoonsAlgPatch::DUV(const double U, const double V) const
{
  double a0, a1, a2, a3, bid;
  a[0]->D1(V, bid, a0);
  a[1]->D1(U, bid, a1);
  a2 = -a0;
  a3 = -a1;

  gp_XYZ cor, cortemp;
  gp_Pnt pbid;
  gp_Vec vbid;

  bound[0]->D1(U, pbid, vbid);
  cor = vbid.XYZ();
  cor.Multiply(a0);

  bound[1]->D1(V, pbid, vbid);
  cortemp = vbid.XYZ();
  cortemp.Multiply(a1);
  cor.Add(cortemp);

  bound[2]->D1(U, pbid, vbid);
  cortemp = vbid.XYZ();
  cortemp.Multiply(a2);
  cor.Add(cortemp);

  bound[3]->D1(V, pbid, vbid);
  cortemp = vbid.XYZ();
  cortemp.Multiply(a3);
  cor.Add(cortemp);

  cortemp = c[0].XYZ();
  cortemp.Multiply(-a0 * a3);
  cor.Add(cortemp);

  cortemp = c[1].XYZ();
  cortemp.Multiply(-a0 * a1);
  cor.Add(cortemp);

  cortemp = c[2].XYZ();
  cortemp.Multiply(-a1 * a2);
  cor.Add(cortemp);

  cortemp = c[3].XYZ();
  cortemp.Multiply(-a2 * a3);
  cor.Add(cortemp);

  vbid.SetXYZ(cor);
  return vbid;
}

//=================================================================================================

const occ::handle<GeomFill_Boundary>& GeomFill_CoonsAlgPatch::Bound(const int I) const
{
  return bound[I];
}

//=================================================================================================

const gp_Pnt& GeomFill_CoonsAlgPatch::Corner(const int I) const
{
  return c[I];
}

//=================================================================================================

const occ::handle<Law_Function>& GeomFill_CoonsAlgPatch::Func(const int I) const
{
  return a[I];
}