MOAB: Mesh Oriented datABase
(version 5.2.1)
|
00001 /* ***************************************************************** 00002 MESQUITE -- The Mesh Quality Improvement Toolkit 00003 00004 Copyright 2010 Sandia National Laboratories. Developed at the 00005 University of Wisconsin--Madison under SNL contract number 00006 624796. The U.S. Government and the University of Wisconsin 00007 retain certain rights to this software. 00008 00009 This library is free software; you can redistribute it and/or 00010 modify it under the terms of the GNU Lesser General Public 00011 License as published by the Free Software Foundation; either 00012 version 2.1 of the License, or (at your option) any later version. 00013 00014 This library is distributed in the hope that it will be useful, 00015 but WITHOUT ANY WARRANTY; without even the implied warranty of 00016 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 00017 Lesser General Public License for more details. 00018 00019 You should have received a copy of the GNU Lesser General Public License 00020 (lgpl.txt) along with this library; if not, write to the Free Software 00021 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 00022 00023 (2010) kraftche@cae.wisc.edu 00024 00025 ***************************************************************** */ 00026 00027 /** \file TRel2DUntangle.cpp 00028 * \brief 00029 * \author Jason Kraftcheck 00030 */ 00031 00032 #include "Mesquite.hpp" 00033 #include "TUntangleMu.hpp" 00034 #include "MsqMatrix.hpp" 00035 #include "TMPDerivs.hpp" 00036 #include "TMPCommon.hpp" 00037 #include "MsqError.hpp" 00038 00039 namespace MBMesquite 00040 { 00041 00042 TUntangleMu::~TUntangleMu() {} 00043 00044 std::string TUntangleMu::get_name() const 00045 { 00046 return "untangle(" + mBaseMetric->get_name() + ")"; 00047 } 00048 00049 template < unsigned DIM > 00050 inline bool TUntangleMu::eval( const MsqMatrix< DIM, DIM >& T, double& result, MsqError& err ) 00051 { 00052 bool valid = mBaseMetric->evaluate( T, result, err ); 00053 if( MSQ_CHKERR( err ) || !valid ) return false; 00054 00055 const double d = mConstant - result; 00056 const double s = fabs( d ) - d; 00057 result = 0.125 * s * s * s; 00058 return true; 00059 } 00060 00061 template < unsigned DIM > 00062 inline bool TUntangleMu::grad( const MsqMatrix< DIM, DIM >& T, double& result, MsqMatrix< DIM, DIM >& deriv_wrt_T, 00063 MsqError& err ) 00064 { 00065 bool valid = mBaseMetric->evaluate_with_grad( T, result, deriv_wrt_T, err ); 00066 if( MSQ_CHKERR( err ) || !valid ) return false; 00067 00068 if( mConstant < result ) 00069 { 00070 const double s = result - mConstant; 00071 result = s * s * s; 00072 deriv_wrt_T *= 3 * s * s; 00073 } 00074 else 00075 { 00076 result = 0; 00077 deriv_wrt_T = MsqMatrix< DIM, DIM >( 0.0 ); 00078 } 00079 00080 return true; 00081 } 00082 00083 template < unsigned DIM > 00084 inline bool TUntangleMu::hess( const MsqMatrix< DIM, DIM >& T, double& result, MsqMatrix< DIM, DIM >& deriv_wrt_T, 00085 MsqMatrix< DIM, DIM >* second_wrt_T, MsqError& err ) 00086 { 00087 bool valid = mBaseMetric->evaluate_with_hess( T, result, deriv_wrt_T, second_wrt_T, err ); 00088 if( MSQ_CHKERR( err ) || !valid ) return false; 00089 00090 if( mConstant < result ) 00091 { 00092 const double s = result - mConstant; 00093 result = s * s * s; 00094 hess_scale( second_wrt_T, 3 * s * s ); 00095 pluseq_scaled_outer_product( second_wrt_T, 6 * s, deriv_wrt_T ); 00096 deriv_wrt_T *= 3 * s * s; 00097 } 00098 else 00099 { 00100 result = 0; 00101 deriv_wrt_T = MsqMatrix< DIM, DIM >( 0.0 ); 00102 set_scaled_I( second_wrt_T, 0.0 ); // zero everything 00103 } 00104 00105 return true; 00106 } 00107 00108 TMP_T_TEMPL_IMPL_COMMON_ERR( TUntangleMu ) 00109 00110 } // namespace MBMesquite