20 #ifndef _CONSTITUTIVE_LAWS_H_
21 #define _CONSTITUTIVE_LAWS_H_
24 #include "mbsim/utils/function.h"
53 virtual bool isActive(
double g,
double gTol) {
return true; }
54 virtual bool remainsActive(
double s,
double sTol) {
return true; }
55 virtual double project(
double la,
double gdn,
double r,
double laMin=0) {
return 0; }
56 virtual fmatvec::Vec diff(
double la,
double gdn,
double r,
double laMin=0) {
return fmatvec::Vec(2, fmatvec::INIT, 0); }
57 virtual double solve(
double G,
double gdn) {
return 0; }
66 virtual bool isFulfilled(
double la,
double gdn,
double tolla,
double tolgd,
double laMin=0) {
return true; }
87 double operator()(
double g,
double gd,
const void * additional=NULL) { assert(forceFunc);
return (*forceFunc)(g,gd,additional); }
118 virtual bool isActive(
double g,
double gTol) {
return g<=gTol; }
119 virtual bool remainsActive(
double gd,
double gdTol) {
return gd<=gdTol; }
120 virtual double project(
double la,
double gdn,
double r,
double laMin=0);
121 virtual fmatvec::Vec diff(
double la,
double gdn,
double r,
double laMin=0);
122 virtual double solve(
double G,
double gdn);
123 virtual bool isFulfilled(
double la,
double gdn,
double tolla,
double tolgd,
double laMin=0);
127 bool remainsClosed(
double s,
double sTol) {
return s<=sTol; }
149 virtual bool isActive(
double g,
double gTol) {
return true; }
150 virtual double project(
double la,
double gdn,
double r,
double laMin=0);
151 virtual fmatvec::Vec diff(
double la,
double gdn,
double r,
double laMin=0);
152 virtual double solve(
double G,
double gdn);
153 virtual bool isFulfilled(
double la,
double gdn,
double tolla,
double tolgd,
double laMin=0);
157 bool remainsClosed(
double s,
double sTol) {
return true; }
178 virtual double project(
double la,
double gdn,
double gda,
double r,
double laMin=0) = 0;
179 virtual fmatvec::Vec diff(
double la,
double gdn,
double gda,
double r,
double laMin=0) = 0;
180 virtual double solve(
double G,
double gdn,
double gda) = 0;
181 virtual bool isFulfilled(
double la,
double gdn,
double gda,
double tolla,
double tolgd,
double laMin=0) = 0;
182 virtual void initializeUsingXML(TiXmlElement *element) {}
215 virtual double project(
double la,
double gdn,
double gda,
double r,
double laMin=0);
216 virtual fmatvec::Vec diff(
double la,
double gdn,
double gda,
double r,
double laMin=0);
217 virtual double solve(
double G,
double gdn,
double gda);
218 virtual bool isFulfilled(
double la,
double gdn,
double gda,
double tolla,
double tolgd,
double laMin=0);
219 virtual void initializeUsingXML(TiXmlElement *element);
223 double epsilon, gd_limit;
244 virtual double project(
double la,
double gdn,
double gda,
double r,
double laMin=0);
245 virtual fmatvec::Vec diff(
double la,
double gdn,
double gda,
double r,
double laMin=0);
246 virtual double solve(
double G,
double gdn,
double gda);
247 virtual bool isFulfilled(
double la,
double gdn,
double gda,
double tolla,
double tolgd,
double laMin=0);
268 virtual ~FrictionForceLaw() {
if(frictionForceFunc)
delete frictionForceFunc; frictionForceFunc = NULL; };
271 virtual fmatvec::Vec project(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
double laN,
double r) {
return fmatvec::Vec(2); }
272 virtual fmatvec::Mat diff(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
double laN,
double r) {
return fmatvec::Mat(2,2); }
273 virtual fmatvec::Vec solve(
const fmatvec::SqrMat& G,
const fmatvec::Vec& gdn,
double laN) {
return fmatvec::Vec(2); }
274 virtual bool isFulfilled(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
double laN,
double tolla,
double tolgd) {
return true; }
275 virtual fmatvec::Vec dlaTdlaN(
const fmatvec::Vec& gd,
double laN) {
return fmatvec::Vec(2); }
276 virtual int getFrictionDirections() = 0;
277 virtual bool isSticking(
const fmatvec::Vec& s,
double sTol) = 0;
278 virtual double getFrictionCoefficient(
double gd) {
return 0; }
279 virtual bool isSetValued()
const = 0;
280 virtual void initializeUsingXML(TiXmlElement *element) {}
283 fmatvec::Vec operator()(
const fmatvec::Vec &gd,
double laN) { assert(frictionForceFunc);
return (*frictionForceFunc)(gd,laN); }
319 virtual fmatvec::Vec project(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
double laN,
double r);
320 virtual fmatvec::Mat diff(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
double laN,
double r);
321 virtual fmatvec::Vec solve(
const fmatvec::SqrMat& G,
const fmatvec::Vec& gdn,
double laN);
322 virtual bool isFulfilled(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
double laN,
double tolla,
double tolgd);
323 virtual fmatvec::Vec dlaTdlaN(
const fmatvec::Vec& gd,
double laN);
324 virtual int getFrictionDirections() {
return 1; }
325 virtual bool isSticking(
const fmatvec::Vec& s,
double sTol) {
return fabs(s(0)) <= sTol; }
326 virtual double getFrictionCoefficient(
double gd) {
return mu; }
327 virtual bool isSetValued()
const {
return true; }
328 virtual void initializeUsingXML(TiXmlElement *element);
331 void setFrictionCoefficient(
double mu_) { mu = mu_; }
360 virtual fmatvec::Vec project(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
double laN,
double r);
361 virtual fmatvec::Mat diff(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
double laN,
double r);
362 virtual fmatvec::Vec solve(
const fmatvec::SqrMat& G,
const fmatvec::Vec& gdn,
double laN);
363 virtual bool isFulfilled(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
double laN,
double tolla,
double tolgd);
364 virtual fmatvec::Vec dlaTdlaN(
const fmatvec::Vec& gd,
double laN);
365 virtual int getFrictionDirections() {
return 2; }
366 virtual bool isSticking(
const fmatvec::Vec& s,
double sTol) {
return nrm2(s(0,1)) <= sTol; }
367 virtual double getFrictionCoefficient(
double gd) {
return mu; }
368 virtual bool isSetValued()
const {
return true; }
369 virtual void initializeUsingXML(TiXmlElement *element);
372 void setFrictionCoefficient(
double mu_) { mu = mu_; }
402 virtual fmatvec::Vec project(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
double laN,
double r);
403 virtual fmatvec::Mat diff(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
double laN,
double r);
404 virtual fmatvec::Vec solve(
const fmatvec::SqrMat& G,
const fmatvec::Vec& gdn,
double laN);
405 virtual bool isFulfilled(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
double laN,
double tolla,
double tolgd);
406 virtual fmatvec::Vec dlaTdlaN(
const fmatvec::Vec& gd,
double laN);
407 virtual int getFrictionDirections() {
return 1; }
408 virtual bool isSticking(
const fmatvec::Vec& s,
double sTol) {
return fabs(s(0)) <= sTol; }
409 virtual double getFrictionCoefficient(
double gd) {
return (*
fmu)(gd); }
410 virtual bool isSetValued()
const {
return true; }
444 virtual fmatvec::Vec project(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
double laN,
double r);
445 virtual fmatvec::Mat diff(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
double laN,
double r);
446 virtual fmatvec::Vec solve(
const fmatvec::SqrMat& G,
const fmatvec::Vec& gdn,
double laN);
447 virtual bool isFulfilled(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
double laN,
double tolla,
double tolgd);
448 virtual fmatvec::Vec dlaTdlaN(
const fmatvec::Vec& gd,
double laN);
449 virtual int getFrictionDirections() {
return 2; }
450 virtual bool isSticking(
const fmatvec::Vec& s,
double sTol) {
return nrm2(s(0,1)) <= sTol; }
451 virtual double getFrictionCoefficient(
double gd) {
return (*
fmu)(gd); }
452 virtual bool isSetValued()
const {
return true; }
480 virtual fmatvec::Vec project(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double r) = 0;
481 virtual fmatvec::Mat diff(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double r) = 0;
482 virtual fmatvec::Vec solve(
const fmatvec::SqrMat& G,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN) = 0;
483 virtual bool isFulfilled(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double tolla,
double tolgd) = 0;
484 virtual int isSticking(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double laTol,
double gdTol) = 0;
485 virtual int getFrictionDirections() = 0;
486 virtual void initializeUsingXML(TiXmlElement *element) {}
513 virtual fmatvec::Vec project(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double r);
514 virtual fmatvec::Mat diff(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double r);
515 virtual fmatvec::Vec solve(
const fmatvec::SqrMat& G,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN);
516 virtual bool isFulfilled(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double tolla,
double tolgd);
517 virtual int isSticking(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double laTol,
double gdTol);
518 virtual int getFrictionDirections() {
return 1; }
519 virtual void initializeUsingXML(TiXmlElement *element);
522 void setFrictionCoefficient(
double mu_) { mu = mu_; }
523 double getFrictionCoefficient(
double gd) {
return mu; }
552 virtual fmatvec::Vec project(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double r);
553 virtual fmatvec::Mat diff(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double r);
554 virtual fmatvec::Vec solve(
const fmatvec::SqrMat& G,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN);
555 virtual bool isFulfilled(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double tolla,
double tolgd);
556 virtual int isSticking(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double laTol,
double gdTol);
557 virtual int getFrictionDirections() {
return 2; }
558 virtual void initializeUsingXML(TiXmlElement *element);
561 void setFrictionCoefficient(
double mu_) { mu = mu_; }
562 double getFrictionCoefficient(
double gd) {
return mu; }
592 virtual fmatvec::Vec project(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double r);
593 virtual fmatvec::Mat diff(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double r);
594 virtual fmatvec::Vec solve(
const fmatvec::SqrMat& G,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN);
595 virtual bool isFulfilled(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double tolla,
double tolgd);
596 virtual int isSticking(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double laTol,
double gdTol);
597 virtual int getFrictionDirections() {
return 1; }
600 double getFrictionCoefficient(
double gd) {
return (*
fmu)(gd); }
633 virtual fmatvec::Vec project(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double r);
634 virtual fmatvec::Mat diff(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double r);
635 virtual fmatvec::Vec solve(
const fmatvec::SqrMat& G,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN);
636 virtual bool isFulfilled(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double tolla,
double tolgd);
637 virtual int isSticking(
const fmatvec::Vec& la,
const fmatvec::Vec& gdn,
const fmatvec::Vec& gda,
double laN,
double laTol,
double gdTol);
638 virtual int getFrictionDirections() {
return 2; }
641 double getFrictionCoefficient(
double gd) {
return (*
fmu)(gd); }
670 virtual bool isActive(
double g,
double gTol) {
return g<=gTol; }
671 virtual bool remainsActive(
double s,
double sTol) {
return s<=sTol; }
698 virtual bool isActive(
double g,
double gTol) {
return true; }
699 virtual bool remainsActive(
double s,
double sTol) {
return true; }
711 int getFrictionDirections() {
return 1; }
712 bool isSticking(
const fmatvec::Vec& s,
double sTol) {
return fabs(s(0)) <= sTol; }
713 bool isSetValued()
const {
return false; }
714 virtual void initializeUsingXML(TiXmlElement *element);
722 int getFrictionDirections() {
return 2; }
723 bool isSticking(
const fmatvec::Vec& s,
double sTol) {
return nrm2(s(0,1)) <= sTol; }
724 bool isSetValued()
const {
return false; }
725 virtual void initializeUsingXML(TiXmlElement *element);