FormsBrokenSpaceConstraintImpl.hpp

Go to the documentation of this file.

/**
 * @file FormsBrokenSpaceConstraintImpl.hpp
 * @brief Integrator for broken space constraints
 * @date 2024-07-01
 *
 * @copyright Copyright (c) 2024
 *
 */
 
#ifndef __FORMSBROKENSPACECONSTRAINTIMPL_HPP__
#define __FORMSBROKENSPACECONSTRAINTIMPL_HPP__
 
namespace MoFEM {
 
/**
 * @brief  Operator for broken loop side
 *
 * That is used follow pattern,
 *
 * First: Iterate over skeleton FEs adjacent to Domain FEs
 * Note:  BoundaryEle, i.e. uses skeleton interation rule
 *
 * ans then
 *
 * Iterate over domain FEs adjacent to skelton, particularly one
 * domain element.
 *
 * You use this to integrate over skelton, but field which is on adjacent domain
 * element.
 *
 * @tparam E
 */
template <typename E> struct OpBrokenLoopSide : public OpLoopSide<E> {
 
  using OP = OpLoopSide<E>;
  using OpLoopSide<E>::OpLoopSide;
 
  MoFEMErrorCode doWork(int side, EntityType type,
                        EntitiesFieldData::EntData &data) {
    MoFEMFunctionBegin;
 
    auto prev_side_fe_ptr = OP::getSidePtrFE();
    if (OP::sideFEName == prev_side_fe_ptr->getFEName()) {
      auto prev_fe_uid =
          prev_side_fe_ptr->numeredEntFiniteElementPtr->getFEUId();
      OP::sideFEPtr->feName = OP::sideFEName;
      CHKERR OP::sideFEPtr->setSideFEPtr(OP::getPtrFE());
      CHKERR OP::sideFEPtr->copyBasicMethod(*OP::getFEMethod());
      CHKERR OP::sideFEPtr->copyPetscData(*OP::getFEMethod());
      CHKERR OP::sideFEPtr->copyKsp(*OP::getFEMethod());
      CHKERR OP::sideFEPtr->copySnes(*OP::getFEMethod());
      CHKERR OP::sideFEPtr->copyTs(*OP::getFEMethod());
      OP::sideFEPtr->cacheWeakPtr = prev_side_fe_ptr->cacheWeakPtr;
      OP::sideFEPtr->loopSize = 1;
      CHKERR OP::sideFEPtr->preProcess();
      OP::sideFEPtr->nInTheLoop = 0;
      OP::sideFEPtr->numeredEntFiniteElementPtr =
          prev_side_fe_ptr->numeredEntFiniteElementPtr;
      CHKERR (*OP::sideFEPtr)();
      CHKERR OP::sideFEPtr->postProcess();
    } else {
      SETERRQ(PETSC_COMM_SELF, MOFEM_DATA_INCONSISTENCY,
              "sideFEName is different");
    }
 
    MoFEMFunctionReturn(0);
  };
};
 
struct BrokenBaseSideData {
  BrokenBaseSideData() : entData(false) {}
  inline auto &getSense() { return eleSense; }
  inline auto &getSide() { return eleSide; }
  inline auto &getType() { return eleType; }
  inline auto &getData() { return entData; }
  inline auto &getFlux() { return fluxMat; }
  inline auto &getVarFlux() { return fluxVarMat; }
 
private:
  int eleSense = 0;
  int eleSide = 1;
  EntityType eleType = MBENTITYSET;
  EntitiesFieldData::EntData entData;
  MatrixDouble fluxMat;
  MatrixDouble fluxVarMat;
};
 
template <typename OpBase> struct OpGetBrokenBaseSideData : public OpBase {
 
  using OP = OpBase;
 
  OpGetBrokenBaseSideData(
      const std::string field_name,
      boost::shared_ptr<std::vector<BrokenBaseSideData>> broken_base_side_data);
 
  MoFEMErrorCode doWork(int row_side, EntityType row_type,
                        EntitiesFieldData::EntData &row_data);
 
private:
  boost::shared_ptr<std::vector<BrokenBaseSideData>> brokenBaseSideData;
};
 
template <typename OpBase>
OpGetBrokenBaseSideData<OpBase>::OpGetBrokenBaseSideData(
    const std::string field_name,
    boost::shared_ptr<std::vector<BrokenBaseSideData>> broken_base_side_data)
    : OP(field_name, field_name, OP::OPROW),
      brokenBaseSideData(broken_base_side_data) {}
 
template <typename OpBase>
MoFEMErrorCode
OpGetBrokenBaseSideData<OpBase>::doWork(int row_side, EntityType row_type,
                                        EntitiesFieldData::EntData &row_data) {
  MoFEMFunctionBegin;
  brokenBaseSideData->resize(OP::getLoopSize());
 
  const auto n_in_the_loop = OP::getNinTheLoop();
  const auto face_sense = OP::getSkeletonSense();
 
#ifndef NDEBUG
  if (face_sense != -1 && face_sense != 1)
    SETERRQ(PETSC_COMM_SELF, MOFEM_DATA_INCONSISTENCY, "face sense not set");
#endif // NDEBUG
 
  auto set_data = [&](auto &side_data) {
    side_data.getSide() = row_side;
    side_data.getType() = row_type;
    side_data.getSense() = face_sense;
    side_data.getData().sEnse = row_data.sEnse;
    side_data.getData().sPace = row_data.sPace;
    side_data.getData().bAse = row_data.bAse;
    side_data.getData().iNdices = row_data.iNdices;
    side_data.getData().localIndices = row_data.localIndices;
    side_data.getData().dOfs = row_data.dOfs;
    side_data.getData().fieldEntities = row_data.fieldEntities;
    side_data.getData().fieldData = row_data.fieldData;
  };
 
  auto set_base = [&](auto &side_data) {
    auto base = side_data.getData().getBase();
    for (auto dd = 0; dd != BaseDerivatives::LastDerivative; ++dd) {
      for (auto bb = 0; bb != LASTBASE; ++bb) {
        side_data.getData().baseFunctionsAndBaseDerivatives[dd][bb].reset();
      }
      if (auto base_ptr = row_data.baseFunctionsAndBaseDerivatives[dd][base]) {
        side_data.getData().baseFunctionsAndBaseDerivatives[dd][base] =
            boost::make_shared<MatrixDouble>(*base_ptr);
      }
    }
  };
 
  set_data((*brokenBaseSideData)[n_in_the_loop]);
  set_base((*brokenBaseSideData)[n_in_the_loop]);
 
  MoFEMFunctionReturn(0);
}
 
template <typename OpBase> struct OpSetFlux : public OpBase {
 
  using OP = OpBase;
 
  OpSetFlux(
      boost::shared_ptr<std::vector<BrokenBaseSideData>> broken_base_side_data,
      boost::shared_ptr<MatrixDouble> flux_ptr);
 
  MoFEMErrorCode doWork(int row_side, EntityType row_type,
                        EntitiesFieldData::EntData &row_data);
 
private:
  boost::shared_ptr<std::vector<BrokenBaseSideData>> brokenBaseSideData;
  boost::shared_ptr<MatrixDouble> fluxPtr;
};
 
template <typename OpBase>
OpSetFlux<OpBase>::OpSetFlux(
    boost::shared_ptr<std::vector<BrokenBaseSideData>> broken_base_side_data,
    boost::shared_ptr<MatrixDouble> flux_ptr)
    : OP(NOSPACE, OP::OPSPACE), brokenBaseSideData(broken_base_side_data),
      fluxPtr(flux_ptr) {}
 
template <typename OpBase>
MoFEMErrorCode OpSetFlux<OpBase>::doWork(int side, EntityType type,
                                         EntitiesFieldData::EntData &data) {
  MoFEMFunctionBegin;
  auto swap_flux = [&](auto &side_data) { side_data.getFlux().swap(*fluxPtr); };
  swap_flux((*brokenBaseSideData)[OP::getNinTheLoop()]);
  MoFEMFunctionReturn(0);
}
template <typename OpBase> struct OpSetVarFlux : public OpBase {
 
  using OP = OpBase;
 
  OpSetVarFlux(
      boost::shared_ptr<std::vector<BrokenBaseSideData>> broken_base_side_data,
      boost::shared_ptr<MatrixDouble> flux_var_ptr);
 
  MoFEMErrorCode doWork(int row_side, EntityType row_type,
                        EntitiesFieldData::EntData &row_data);
 
private:
  boost::shared_ptr<std::vector<BrokenBaseSideData>> brokenBaseSideData;
  boost::shared_ptr<MatrixDouble> fluxVarPtr;
};
 
template <typename OpBase>
OpSetVarFlux<OpBase>::OpSetVarFlux(
    boost::shared_ptr<std::vector<BrokenBaseSideData>> broken_base_side_data,
    boost::shared_ptr<MatrixDouble> flux_var_ptr)
    : OP(NOSPACE, OP::OPSPACE), brokenBaseSideData(broken_base_side_data),
      fluxVarPtr(flux_var_ptr) {}
 
template <typename OpBase>
MoFEMErrorCode OpSetVarFlux<OpBase>::doWork(int side, EntityType type,
                                            EntitiesFieldData::EntData &data) {
  MoFEMFunctionBegin;
  auto swap_flux = [&](auto &side_data) {
    side_data.getVarFlux().swap(*fluxVarPtr);
  };
  swap_flux((*brokenBaseSideData)[OP::getNinTheLoop()]);
  MoFEMFunctionReturn(0);
}
 
 
template <typename OpBase> struct OpBrokenBaseImpl : public OpBase {
 
  using OP = OpBase;
 
  OpBrokenBaseImpl(
      boost::shared_ptr<std::vector<BrokenBaseSideData>> broken_base_side_data,
      boost::shared_ptr<Range> ents_ptr = nullptr)
      : OP(NOSPACE, OP::OPSPACE), brokenBaseSideData(broken_base_side_data) {
    OP::entsPtr = ents_ptr;
    OP::assembleTranspose = false;
    OP::onlyTranspose = false;
    OP::sYmm = false;
  }
 
  OpBrokenBaseImpl(
      const std::string row_field,
      boost::shared_ptr<std::vector<BrokenBaseSideData>> broken_base_side_data,
      const bool assmb_transpose, const bool only_transpose,
      boost::shared_ptr<Range> ents_ptr = nullptr)
      : OP(row_field, row_field, OP::OPROW, ents_ptr),
        brokenBaseSideData(broken_base_side_data) {
    OP::entsPtr = ents_ptr;
    OP::assembleTranspose = assmb_transpose;
    OP::onlyTranspose = only_transpose;
    OP::sYmm = false;
  }
 
  MoFEMErrorCode doWork(int row_side, EntityType row_type,
                        EntitiesFieldData::EntData &row_data);
 
protected:
  boost::shared_ptr<std::vector<BrokenBaseSideData>> brokenBaseSideData;
};
 
template <typename OpBase>
MoFEMErrorCode
OpBrokenBaseImpl<OpBase>::doWork(int row_side, EntityType row_type,
                                 EntitiesFieldData::EntData &row_data) {
  MoFEMFunctionBegin;
 
  if (OP::entsPtr) {
    if (OP::entsPtr->find(this->getFEEntityHandle()) == OP::entsPtr->end())
      MoFEMFunctionReturnHot(0);
  }
 
#ifndef NDEBUG
  if (!brokenBaseSideData) {
    SETERRQ(PETSC_COMM_SELF, MOFEM_IMPOSSIBLE_CASE, "space not set");
  }
#endif // NDEBUG
 
  auto do_work_rhs = [this](int row_side, EntityType row_type,
                            EntitiesFieldData::EntData &row_data, int sense) {
    MoFEMFunctionBegin;
    // get number of dofs on row
    OP::nbRows = row_data.getIndices().size();
    if (!OP::nbRows)
      MoFEMFunctionReturnHot(0);
    // get number of integration points
    OP::nbIntegrationPts = OP::getGaussPts().size2();
    // get row base functions
    OP::nbRowBaseFunctions = OP::getNbOfBaseFunctions(row_data);
    // resize and clear the right hand side vector
    OP::locF.resize(OP::nbRows, false);
    OP::locF.clear();
    // integrate local vector
    CHKERR this->iNtegrate(row_data);
    // assemble local vector
    OP::locF *= sense;
    CHKERR this->aSsemble(row_data);
    MoFEMFunctionReturn(0);
  };
 
  auto do_work_lhs = [this](int row_side, int col_side, EntityType row_type,
                            EntityType col_type,
                            EntitiesFieldData::EntData &row_data,
                            EntitiesFieldData::EntData &col_data, int sense) {
    MoFEMFunctionBegin;
 
    auto check_if_assemble_transpose = [&] {
      if (this->sYmm) {
        if (OP::rowSide != OP::colSide || OP::rowType != OP::colType)
          return true;
        else
          return false;
      } else if (OP::assembleTranspose) {
        return true;
      }
      return false;
    };
 
    OP::rowSide = row_side;
    OP::rowType = row_type;
    OP::colSide = col_side;
    OP::colType = col_type;
    OP::nbCols = col_data.getIndices().size();
    OP::locMat.resize(OP::nbRows, OP::nbCols, false);
    OP::locMat.clear();
    CHKERR this->iNtegrate(row_data, col_data);
    OP::locMat *= sense;
    CHKERR this->aSsemble(row_data, col_data, check_if_assemble_transpose());
    MoFEMFunctionReturn(0);
  };
 
  switch (OP::opType) {
  case OP::OPROW:
 
    OP::nbRows = row_data.getIndices().size();
    if (!OP::nbRows)
      MoFEMFunctionReturnHot(0);
    OP::nbIntegrationPts = OP::getGaussPts().size2();
    OP::nbRowBaseFunctions = OP::getNbOfBaseFunctions(row_data);
 
    if (!OP::nbRows)
      MoFEMFunctionReturnHot(0);
 
    for (auto &bd : *brokenBaseSideData) {
 
#ifndef NDEBUG
      if (!bd.getData().getNSharedPtr(bd.getData().getBase())) {
        SETERRQ(PETSC_COMM_SELF, MOFEM_DATA_INCONSISTENCY, 
                "base functions not set");
      }
#endif
 
      CHKERR do_work_lhs(
 
          // side
          row_side, bd.getSide(),
 
          // type
          row_type, bd.getType(),
 
          // row_data
          row_data, bd.getData(),
 
          // sense
          bd.getSense()
 
      );
    }
 
    break;
  case OP::OPSPACE:
    for (auto &bd : *brokenBaseSideData) {
      CHKERR do_work_rhs(bd.getSide(), bd.getType(), bd.getData(),
                         bd.getSense());
    }
    break;
  default:
    CHK_MOAB_THROW(MOFEM_IMPOSSIBLE_CASE,
                   (std::string("wrong op type ") +
                    OpBaseDerivativesBase::OpTypeNames[OP::opType])
                       .c_str());
  }
 
  MoFEMFunctionReturn(0);
}
 
template <int FIELD_DIM, IntegrationType I, typename OpBrokenBase>
struct OpBrokenSpaceConstrainImpl;
 
template <int FIELD_DIM, typename OpBrokenBase>
struct OpBrokenSpaceConstrainImpl<FIELD_DIM, GAUSS, OpBrokenBase>
    : public OpBrokenBase {
 
  using OP = OpBrokenBase;
 
  OpBrokenSpaceConstrainImpl(
      const std::string row_field,
      boost::shared_ptr<std::vector<BrokenBaseSideData>> broken_base_side_data,
      boost::shared_ptr<double> beta_ptr, const bool assmb_transpose,
      const bool only_transpose, boost::shared_ptr<Range> ents_ptr = nullptr)
      : OP(row_field, broken_base_side_data, assmb_transpose, only_transpose,
           ents_ptr),
        scalarBetaPtr(beta_ptr) {}
 
  OpBrokenSpaceConstrainImpl(
      const std::string row_field,
      boost::shared_ptr<std::vector<BrokenBaseSideData>> broken_base_side_data,
      double beta, const bool assmb_transpose, const bool only_transpose,
      boost::shared_ptr<Range> ents_ptr = nullptr)
      : OpBrokenSpaceConstrainImpl(row_field, broken_base_side_data,
                                   boost::make_shared<double>(beta),
                                   assmb_transpose, only_transpose, ents_ptr) {}
 
protected:
  boost::shared_ptr<double> scalarBetaPtr;
  MoFEMErrorCode iNtegrate(EntitiesFieldData::EntData &row_data,
                           EntitiesFieldData::EntData &col_data);
};
 
template <int FIELD_DIM, typename OpBase>
MoFEMErrorCode OpBrokenSpaceConstrainImpl<FIELD_DIM, GAUSS, OpBase>::iNtegrate(
    EntitiesFieldData::EntData &row_data,
    EntitiesFieldData::EntData &col_data) {
  MoFEMFunctionBegin;
 
  auto nb_row_dofs = row_data.getIndices().size();
  auto nb_col_dofs = col_data.getIndices().size();
  if (!nb_row_dofs || !nb_col_dofs)
    MoFEMFunctionReturnHot(0);
 
  FTENSOR_INDEX(FIELD_DIM, i);
  FTENSOR_INDEX(3, J);
 
  auto t_w = this->getFTensor0IntegrationWeight();
  auto t_normal = OpBase::getFTensor1NormalsAtGaussPts();
  size_t nb_base_functions = col_data.getN().size2() / 3;
 
#ifndef NDEBUG
  if (nb_row_dofs % FIELD_DIM != 0 || nb_col_dofs % FIELD_DIM != 0) {
    SETERRQ(PETSC_COMM_SELF, MOFEM_DATA_INCONSISTENCY,
            "number of dofs not divisible by field dimension");
  }
  if (nb_row_dofs > row_data.getN().size2() * FIELD_DIM ||
      nb_col_dofs > col_data.getN().size2() * FIELD_DIM) {
    SETERRQ(PETSC_COMM_SELF, MOFEM_DATA_INCONSISTENCY,
            "number of dofs exceeds number of base functions");
  }
#endif // NDEBUG
 
  auto t_col_base = col_data.getFTensor1N<3>();
 
  for (size_t gg = 0; gg != OpBase::nbIntegrationPts; ++gg) {
 
    int cc = 0;
    for (; cc != nb_col_dofs / FIELD_DIM; cc++) {
      auto t_row_base = row_data.getFTensor0N(gg, 0);
      for (auto rr = 0; rr != nb_row_dofs / FIELD_DIM; ++rr) {
        OP::locMat(FIELD_DIM * rr, FIELD_DIM * cc) +=
            (0.5 * t_w * t_row_base) * (t_normal(J) * t_col_base(J));
        ++t_row_base;
      }
 
      ++t_col_base;
    }
 
    for (; cc < nb_base_functions; ++cc)
      ++t_col_base;
 
    ++t_w;
    ++t_normal;
  }
 
  for (auto rr = 0; rr != nb_row_dofs / FIELD_DIM; ++rr) {
    for (auto cc = 0; cc != nb_col_dofs / FIELD_DIM; ++cc) {
      for (auto dd = 1; dd < FIELD_DIM; ++dd) {
        OP::locMat(FIELD_DIM * rr + dd, FIELD_DIM * cc + dd) =
            OP::locMat(FIELD_DIM * rr, FIELD_DIM * cc);
      }
    }
  }
 
  if (scalarBetaPtr)
    OP::locMat *= *scalarBetaPtr;
 
  MoFEMFunctionReturn(0);
}
 
template <int FIELD_DIM, IntegrationType I, typename OpBase>
struct OpBrokenSpaceConstrainDHybridImpl;
 
template <int FIELD_DIM, IntegrationType I, typename OpBase>
struct OpBrokenSpaceConstrainDFluxImpl;
 
template <int FIELD_DIM, typename OpBrokenBase>
struct OpBrokenSpaceConstrainDFluxImpl<FIELD_DIM, GAUSS, OpBrokenBase>
    : public OpBrokenBase {
 
  using OP = OpBrokenBase;
 
  OpBrokenSpaceConstrainDFluxImpl(
      boost::shared_ptr<std::vector<BrokenBaseSideData>> broken_base_side_data,
      boost::shared_ptr<MatrixDouble> lagrange_ptr,
      boost::shared_ptr<double> beta_ptr,
      boost::shared_ptr<Range> ents_ptr = nullptr)
      : OP(broken_base_side_data, ents_ptr), scalarBetaPtr(beta_ptr),
        lagrangePtr(lagrange_ptr) {}
 
  OpBrokenSpaceConstrainDFluxImpl(
      boost::shared_ptr<std::vector<BrokenBaseSideData>> broken_base_side_data,
      boost::shared_ptr<MatrixDouble> lagrange_ptr, double beta,
      boost::shared_ptr<Range> ents_ptr = nullptr)
      : OpBrokenSpaceConstrainDFluxImpl(broken_base_side_data, lagrange_ptr,
                                        boost::make_shared<double>(beta),
                                        ents_ptr) {}
 
private:
  MoFEMErrorCode iNtegrate(EntitiesFieldData::EntData &row_data);
 
  boost::shared_ptr<double> scalarBetaPtr;
  boost::shared_ptr<MatrixDouble> lagrangePtr;
};
 
template <int FIELD_DIM, typename OpBase>
MoFEMErrorCode
OpBrokenSpaceConstrainDFluxImpl<FIELD_DIM, GAUSS, OpBase>::iNtegrate(
    EntitiesFieldData::EntData &row_data) {
  MoFEMFunctionBegin;
 
  FTENSOR_INDEX(FIELD_DIM, i);
  FTENSOR_INDEX(3, J);
 
  auto t_w = this->getFTensor0IntegrationWeight();
  auto t_normal = OpBase::getFTensor1NormalsAtGaussPts();
  auto t_lagrange = getFTensor1FromMat<FIELD_DIM>(*lagrangePtr);
 
  auto t_row_base = row_data.getFTensor1N<3>();
  auto nb_base_functions = row_data.getN().size2() / 3;
 
  for (size_t gg = 0; gg != OpBase::nbIntegrationPts; ++gg) {
    auto t_vec = getFTensor1FromPtr<FIELD_DIM>(&*OP::locF.data().begin());
    size_t rr = 0;
    for (; rr != row_data.getIndices().size() / FIELD_DIM; ++rr) {
      t_vec(i) += (0.5 * t_w * (t_row_base(J) * t_normal(J))) * t_lagrange(i);
      ++t_row_base;
      ++t_vec;
    }
    for (; rr < nb_base_functions; ++rr)
      ++t_row_base;
    ++t_w;
    ++t_normal;
    ++t_lagrange;
  }
 
  if(scalarBetaPtr)
    OP::locF *= *scalarBetaPtr;
 
  MoFEMFunctionReturn(0);
}
 
template <int FIELD_DIM, typename OpBase>
struct OpBrokenSpaceConstrainDHybridImpl<FIELD_DIM, GAUSS, OpBase>
    : public OpBase {
 
  using OP = OpBase;
 
  OpBrokenSpaceConstrainDHybridImpl(
      const std::string row_field,
      boost::shared_ptr<std::vector<BrokenBaseSideData>> broken_side_data_ptr,
      boost::shared_ptr<double> beta_ptr,
      boost::shared_ptr<Range> ents_ptr = nullptr)
      : OpBase(row_field, row_field, OpBase::OPROW, ents_ptr),
        brokenSideDataPtr(broken_side_data_ptr), scalarBetaPtr(beta_ptr) {}
 
  OpBrokenSpaceConstrainDHybridImpl(
      const std::string row_field,
      boost::shared_ptr<std::vector<BrokenBaseSideData>> broken_side_data_ptr,
      double beta, boost::shared_ptr<Range> ents_ptr = nullptr)
      : OpBrokenSpaceConstrainDHybridImpl(row_field, broken_side_data_ptr,
                                          boost::make_shared<double>(beta),
                                          ents_ptr) {}
 
private:
  boost::shared_ptr<double> scalarBetaPtr;
  boost::shared_ptr<std::vector<BrokenBaseSideData>> brokenSideDataPtr;
  MoFEMErrorCode iNtegrate(EntitiesFieldData::EntData &row_data);
};
 
template <int FIELD_DIM, typename OpBase>
MoFEMErrorCode
OpBrokenSpaceConstrainDHybridImpl<FIELD_DIM, GAUSS, OpBase>::iNtegrate(
    EntitiesFieldData::EntData &row_data) {
  MoFEMFunctionBegin;
 
  FTENSOR_INDEX(FIELD_DIM, i);
  FTENSOR_INDEX(3, J);
 
  OP::locF.resize(row_data.getIndices().size(), false);
  OP::locF.clear();
 
  for (auto &bd : *brokenSideDataPtr) {
    auto t_w = this->getFTensor0IntegrationWeight();
    auto t_normal = OpBase::getFTensor1NormalsAtGaussPts();
    auto t_row_base = row_data.getFTensor0N();
    auto t_flux = getFTensor2FromMat<FIELD_DIM, 3>(bd.getFlux());
    auto nb_base_functions = row_data.getN().size2() / 3;
    auto sense = bd.getSense();
    for (size_t gg = 0; gg != OpBase::nbIntegrationPts; ++gg) {
      auto t_vec = getFTensor1FromPtr<FIELD_DIM>(&*OP::locF.data().begin());
      size_t rr = 0;
      for (; rr != row_data.getIndices().size() / FIELD_DIM; ++rr) {
        t_vec(i) +=
            (sense * 0.5 * t_w) * t_row_base * t_normal(J) * t_flux(i, J);
        ++t_row_base;
        ++t_vec;
      }
      for (; rr < nb_base_functions; ++rr)
        ++t_row_base;
      ++t_w;
      ++t_normal;
      ++t_flux;
    }
  }
 
  if(scalarBetaPtr)
    OP::locF *= *scalarBetaPtr;
 
  MoFEMFunctionReturn(0);
}
 
template <int FIELD_DIM, IntegrationType I, typename OpBase>
struct OpTopoDerivativeBrokenSpaceConstrainDHybridImpl;
 
template <int FIELD_DIM, IntegrationType I, typename OpBase>
struct OpTopoDerivativeBrokenSpaceConstrainDFluxImpl;
 
template <typename OpBrokenBase> struct OpBrokenTopoBase : public OpBrokenBase {
  using OP = OpBrokenBase;
 
protected:
 
  OpBrokenTopoBase(
      const std::string row_field,
      boost::shared_ptr<MatrixDouble> tangent1_diff_ptr,
      boost::shared_ptr<MatrixDouble> tangent2_diff_ptr,
      SmartPetscObj<Vec> assemble_vec, Tag th,
      boost::shared_ptr<Range> ents_ptr = nullptr)
      : OP(row_field, row_field, OP::OPROW, ents_ptr),
        tangent1DiffPtr(tangent1_diff_ptr),
        tangent2DiffPtr(tangent2_diff_ptr), assembleVec(assemble_vec),
        thGradTag(th) {}
 
  MoFEMErrorCode aSsemble(EntitiesFieldData::EntData &row_data) {
    MoFEMFunctionBegin;
    if (!this->timeScalingFun.empty())
      this->locF *= this->timeScalingFun(this->getFEMethod()->ts_t);
    if (!this->feScalingFun.empty())
      this->locF *= this->feScalingFun(this->getFEMethod());
    if (assembleVec) {
      auto *vec_ptr = this->locF.data().data();
      const auto nb_dofs = row_data.getIndices().size();
      auto *ind_ptr = row_data.getIndices().data().data();
      return VecSetValues(assembleVec, nb_dofs, ind_ptr, vec_ptr, ADD_VALUES);
    }
    if (thGradTag) {
      const auto field_ents = row_data.getFieldEntities();
      std::vector<EntityHandle> ents(field_ents.size());
      std::transform(field_ents.begin(), field_ents.end(), ents.begin(),
                     [](const auto *fe) { return fe->getEnt(); });
      if (field_ents.empty())
        MoFEMFunctionReturnHot(0);
      if (type_from_handle(ents[0]) != MBVERTEX)
        MoFEMFunctionReturnHot(0);
      auto &moab = this->getMoab();
      VectorDouble topo_values(this->locF.size());
      CHKERR moab.tag_get_data(thGradTag, ents.data(), ents.size(),
                               topo_values.data().data());
      topo_values += this->locF;
      CHKERR moab.tag_set_data(thGradTag, ents.data(), ents.size(),
                               topo_values.data().data());
    }
    MoFEMFunctionReturn(0);
  }
 
  boost::shared_ptr<MatrixDouble> tangent1DiffPtr;
  boost::shared_ptr<MatrixDouble> tangent2DiffPtr;
  SmartPetscObj<Vec> assembleVec;
  Tag thGradTag;
};
 
template <typename OpBase>
struct OpTopoDerivativeBrokenSpaceConstrainDFluxImpl<3, GAUSS, OpBase>
    : public OpBrokenTopoBase<OpBase> {
 
  using OP = OpBrokenTopoBase<OpBase>;
 
  OpTopoDerivativeBrokenSpaceConstrainDFluxImpl(
      const std::string row_field,
      boost::shared_ptr<std::vector<BrokenBaseSideData>> broken_side_data_ptr,
      boost::shared_ptr<MatrixDouble> lamgrange_ptr,
      boost::shared_ptr<MatrixDouble> tangent1_ptr,
      boost::shared_ptr<MatrixDouble> tangent2_ptr,
      boost::shared_ptr<double> beta_ptr, SmartPetscObj<Vec> assemble_vec,
      Tag th, boost::shared_ptr<Range> ents_ptr = nullptr)
      : OP(row_field, tangent1_ptr, tangent2_ptr, assemble_vec, th, ents_ptr),
        brokenSideDataPtr(broken_side_data_ptr), lagrangePtr(lamgrange_ptr),
        scalarBetaPtr(beta_ptr) {}
 
private:
  MoFEMErrorCode iNtegrate(EntitiesFieldData::EntData &row_data);
  boost::shared_ptr<std::vector<BrokenBaseSideData>> brokenSideDataPtr;
  boost::shared_ptr<MatrixDouble> lagrangePtr;
  boost::shared_ptr<double> scalarBetaPtr;
};
 
template <typename OpBase>
MoFEMErrorCode
OpTopoDerivativeBrokenSpaceConstrainDFluxImpl<3, GAUSS, OpBase>::iNtegrate(
    EntitiesFieldData::EntData &row_data) {
  MoFEMFunctionBegin;
 
  FTENSOR_INDEX(3, I);
  FTENSOR_INDEX(3, J);
  FTENSOR_INDEX(3, i);
  FTENSOR_INDEX(3, j);
  FTENSOR_INDEX(3, k);
  FTENSOR_INDEX(3, m);
  FTensor::Number<0> N0;
  FTensor::Number<1> N1;
 
  auto get_ftensor1 = [](MatrixDouble &m) {
    return FTensor::Tensor1<FTensor::PackPtr<double *, 3>, 3>(
        &m(0, 0), &m(0, 1), &m(0, 2));
  };
 
  for (auto &bd : *brokenSideDataPtr) {
 
    auto t_w = this->getFTensor0IntegrationWeight();
    auto t_lagrange = getFTensor1FromMat<3>(*lagrangePtr);
    auto t_adjoint_lambda = getFTensor2FromMat<3, 3>(bd.getVarFlux());
    auto t_t1 = get_ftensor1(*this->tangent1DiffPtr);
    auto t_t2 = get_ftensor1(*this->tangent2DiffPtr);
 
    auto t_diff_base = row_data.getFTensor1DiffN<2>();
    auto nb_base_functions = row_data.getN().size2();
 
    constexpr auto t_kd = FTensor::Kronecker_Delta<double>();
 
    for (size_t gg = 0; gg != OpBase::nbIntegrationPts; ++gg) {
 
      FTensor::Tensor2<double, 3, 3> t_normal_diff;
      t_normal_diff(j, m) = FTensor::levi_civita(i, j, k) * t_t1(k) *
                            (t_kd(i, m) * t_diff_base(N1));
      t_normal_diff(j, m) += FTensor::levi_civita(i, j, k) *
                             (t_kd(k, m) * t_diff_base(N0)) * t_t2(i);
      auto t_vec = getFTensor1FromPtr<3>(&*OP::locF.data().begin());
      size_t rr = 0;
      for (; rr != row_data.getIndices().size() / 3; ++rr) {
        t_vec(m) += (0.5 * t_w) * (t_adjoint_lambda(i, J) * t_lagrange(i)) *
                    t_normal_diff(J, m);
        ++t_diff_base;
        ++t_vec;
      }
      for (; rr < nb_base_functions; ++rr)
        ++t_diff_base;
      ++t_w;
      ++t_lagrange;
      ++t_adjoint_lambda;
      ++t_t1;
      ++t_t2;
    }
  }
 
  if (scalarBetaPtr)
    OP::locF *= *scalarBetaPtr;
 
  MoFEMFunctionReturn(0);
}
 
template <typename OpBase>
struct OpTopoDerivativeBrokenSpaceConstrainDHybridImpl<3, GAUSS, OpBase>
    : public OpBrokenTopoBase<OpBase> {
 
  using OP = OpBrokenTopoBase<OpBase>;
 
  OpTopoDerivativeBrokenSpaceConstrainDHybridImpl(
      const std::string row_field,
      boost::shared_ptr<std::vector<BrokenBaseSideData>> broken_side_data_ptr,
      boost::shared_ptr<MatrixDouble> adjoint_hybrid_ptr,
      boost::shared_ptr<MatrixDouble> tangent1_ptr,
      boost::shared_ptr<MatrixDouble> tangent2_ptr,
      boost::shared_ptr<double> beta_ptr, SmartPetscObj<Vec> assemble_vec,
      Tag th, boost::shared_ptr<Range> ents_ptr = nullptr)
      : OP(row_field, tangent1_ptr, tangent2_ptr, assemble_vec, th, ents_ptr),
        brokenSideDataPtr(broken_side_data_ptr),
        adjointHybridPtr(adjoint_hybrid_ptr), scalarBetaPtr(beta_ptr) {}
 
private:
  boost::shared_ptr<std::vector<BrokenBaseSideData>> brokenSideDataPtr;
  boost::shared_ptr<MatrixDouble> adjointHybridPtr;
  boost::shared_ptr<double> scalarBetaPtr;
  MoFEMErrorCode iNtegrate(EntitiesFieldData::EntData &row_data);
};
 
template <typename OpBase>
MoFEMErrorCode OpTopoDerivativeBrokenSpaceConstrainDHybridImpl<
    3, GAUSS, OpBase>::iNtegrate(EntitiesFieldData::EntData &row_data) {
  MoFEMFunctionBegin;
 
  FTENSOR_INDEX(3, i);
  FTENSOR_INDEX(3, j);
  FTENSOR_INDEX(3, k);
  FTENSOR_INDEX(3, m);
  FTENSOR_INDEX(3, J);
  FTENSOR_INDEX(3, K);
  FTENSOR_INDEX(3, L);
  FTENSOR_INDEX(3, M);
 
  FTensor::Number<0> N0;
  FTensor::Number<1> N1;
 
  OP::locF.resize(row_data.getIndices().size(), false);
  OP::locF.clear();
 
  auto get_ftensor1 = [](MatrixDouble &m) {
    return FTensor::Tensor1<FTensor::PackPtr<double *, 3>, 3>(
        &m(0, 0), &m(0, 1), &m(0, 2));
  };
 
  for (auto &bd : *brokenSideDataPtr) {
    auto t_w = this->getFTensor0IntegrationWeight();
    auto t_t1 = get_ftensor1(*this->tangent1DiffPtr);
    auto t_t2 = get_ftensor1(*this->tangent2DiffPtr);
    auto t_flux = getFTensor2FromMat<3, 3>(bd.getFlux());
    auto t_adjoint_lambda = getFTensor1FromMat<3>(*adjointHybridPtr);
 
    auto nb_base_functions = row_data.getN().size2();
    auto sense = bd.getSense();
    constexpr auto t_kd = FTensor::Kronecker_Delta<double>();
 
    auto t_diff_base = row_data.getFTensor1DiffN<2>();
    for (size_t gg = 0; gg != OpBase::nbIntegrationPts; ++gg) {
      auto t_vec = getFTensor1FromPtr<3>(&*OP::locF.data().begin());
      size_t rr = 0;
      for (; rr != row_data.getIndices().size() / 3; ++rr) {
        FTensor::Tensor2<double, 3, 3> t_normal_diff;
        t_normal_diff(j, m) =
            FTensor::levi_civita(i, j, k) * t_t1(k) *
            (t_kd(i, m) * t_diff_base(N1));
        t_normal_diff(j, m) +=
            FTensor::levi_civita(i, j, k) * (t_kd(k, m) * t_diff_base(N0)) *
            t_t2(i);
 
        t_vec(m) += (sense * 0.5 * t_w) * (t_adjoint_lambda(i) * t_flux(i, J)) *
                    t_normal_diff(J, m);
 
        ++t_diff_base;
        ++t_vec;
      }
      for (; rr < nb_base_functions; ++rr)
        ++t_diff_base;
      ++t_w;
      ++t_t1;
      ++t_t2;
      ++t_flux;
      ++t_adjoint_lambda;
    }
  }
 
  if (scalarBetaPtr)
    OP::locF *= *scalarBetaPtr;
 
  MoFEMFunctionReturn(0);
}
 
} // namespace MoFEM
 
#endif // __FORMSBROKENSPACECONSTRAINTIMPL_HPP__