MOAB: Mesh Oriented datABase
(version 5.2.1)
|
00001 /* ***************************************************************** 00002 MESQUITE -- The Mesh Quality Improvement Toolkit 00003 00004 Copyright 2006 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 (2006) kraftche@cae.wisc.edu 00024 00025 ***************************************************************** */ 00026 00027 /** \file JacobianCalculator.cpp 00028 * \brief 00029 * \author Jason Kraftcheck 00030 */ 00031 00032 #include "Mesquite.hpp" 00033 #include "JacobianCalculator.hpp" 00034 #include "MappingFunction.hpp" 00035 #include "MsqError.hpp" 00036 #include "TopologyInfo.hpp" 00037 00038 namespace MBMesquite 00039 { 00040 00041 void JacobianCalculator::get_Jacobian_2D( const MappingFunction2D* mf, NodeSet ho_bits, Sample location, 00042 const Vector3D* verts, size_t num_type_vert, MsqMatrix< 3, 2 >& J_out, 00043 MsqError& err ) 00044 { 00045 size_t num_vtx = 0; 00046 mf->derivatives( location, ho_bits, mIndices, mDerivs2D, num_vtx, err );MSQ_ERRRTN( err ); 00047 mf->convert_connectivity_indices( num_type_vert, mIndices, num_vtx, err );MSQ_ERRRTN( err ); 00048 const MsqVector< 2 >* d = mDerivs2D; 00049 const size_t* const e = mIndices + num_vtx; 00050 Vector3D c[2] = { Vector3D( 0, 0, 0 ), Vector3D( 0, 0, 0 ) }; 00051 for( const size_t* i = mIndices; i != e; ++i, ++d ) 00052 { 00053 c[0] += ( *d )[0] * verts[*i]; 00054 c[1] += ( *d )[1] * verts[*i]; 00055 } 00056 J_out.set_column( 0, MsqMatrix< 3, 1 >( c[0].to_array() ) ); 00057 J_out.set_column( 1, MsqMatrix< 3, 1 >( c[1].to_array() ) ); 00058 } 00059 00060 void JacobianCalculator::get_Jacobian_3D( const MappingFunction3D* mf, NodeSet ho_bits, Sample location, 00061 const Vector3D* verts, size_t num_type_vert, MsqMatrix< 3, 3 >& J_out, 00062 MsqError& err ) 00063 { 00064 size_t num_vtx = 0; 00065 mf->derivatives( location, ho_bits, mIndices, mDerivs3D, num_vtx, err );MSQ_ERRRTN( err ); 00066 mf->convert_connectivity_indices( num_type_vert, mIndices, num_vtx, err );MSQ_ERRRTN( err ); 00067 const MsqVector< 3 >* d = mDerivs3D; 00068 const size_t* const e = mIndices + num_vtx; 00069 Vector3D c[3] = { Vector3D( 0, 0, 0 ), Vector3D( 0, 0, 0 ), Vector3D( 0, 0, 0 ) }; 00070 for( const size_t* i = mIndices; i != e; ++i, ++d ) 00071 { 00072 c[0] += ( *d )[0] * verts[*i]; 00073 ; 00074 c[1] += ( *d )[1] * verts[*i]; 00075 ; 00076 c[2] += ( *d )[2] * verts[*i]; 00077 ; 00078 } 00079 J_out.set_column( 0, MsqMatrix< 3, 1 >( c[0].to_array() ) ); 00080 J_out.set_column( 1, MsqMatrix< 3, 1 >( c[1].to_array() ) ); 00081 J_out.set_column( 2, MsqMatrix< 3, 1 >( c[2].to_array() ) ); 00082 } 00083 00084 } // namespace MBMesquite