Simbody  3.5
 All Classes Namespaces Files Functions Variables Typedefs Enumerations Enumerator Friends Macros Modules Pages
SimTK::PGSImpulseSolver Class Reference

Projected Gauss Seidel impulse solver. More...

+ Inheritance diagram for SimTK::PGSImpulseSolver:

Public Member Functions

 PGSImpulseSolver (Real roll2slipTransitionSpeed)
 
bool solve (int phase, const Array_< MultiplierIndex > &participating, const Matrix &A, const Vector &D, const Array_< MultiplierIndex > &expanding, Vector &piExpand, Vector &verrStart, Vector &verrApplied, Vector &pi, Array_< UncondRT > &unconditional, Array_< UniContactRT > &uniContact, Array_< UniSpeedRT > &uniSpeed, Array_< BoundedRT > &bounded, Array_< ConstraintLtdFrictionRT > &consLtdFriction, Array_< StateLtdFrictionRT > &stateLtdFriction) const override
 Solve with conditional constraints. More...
 
bool solveBilateral (const Array_< MultiplierIndex > &participating, const Matrix &A, const Vector &D, const Vector &rhs, Vector &pi) const override
 Solve with only unconditional constraints. More...
 
- Public Member Functions inherited from SimTK::ImpulseSolver
 ImpulseSolver (Real roll2slipTransitionSpeed, Real convergenceTol, int maxIters)
 
virtual ~ImpulseSolver ()
 
void setMaxRollingSpeed (Real roll2slipTransitionSpeed)
 
Real getMaxRollingSpeed () const
 
void setConvergenceTol (Real tol)
 
Real getConvergenceTol () const
 
void setMaxIterations (int maxIts)
 
int getMaxIterations () const
 
void clearStats () const
 
void clearStats (int phase) const
 

Additional Inherited Members

- Public Types inherited from SimTK::ImpulseSolver
enum  ContactType {
  TypeNA =-1,
  Observing =0,
  Known =1,
  Participating =2
}
 
enum  UniCond {
  UniNA =-1,
  UniOff =0,
  UniActive =1,
  UniKnown =2
}
 
enum  FricCond {
  FricNA =-1,
  FricOff =0,
  Sliding =1,
  Impending =2,
  Rolling =3
}
 
enum  BndCond {
  BndNA =-1,
  SlipLow =0,
  ImpendLow =1,
  Engaged =2,
  ImpendHigh =3,
  SlipHigh =4
}
 
- Static Public Member Functions inherited from SimTK::ImpulseSolver
static const char * getContactTypeName (ContactType ct)
 
static const char * getUniCondName (UniCond uc)
 
static const char * getFricCondName (FricCond fc)
 
static const char * getBndCondName (BndCond bc)
 
static void dumpUniContacts (const String &msg, const Array_< UniContactRT > &uniContacts)
 
- Static Public Attributes inherited from SimTK::ImpulseSolver
static const int MaxNumPhases = 3
 
- Protected Attributes inherited from SimTK::ImpulseSolver
Real m_maxRollingTangVel
 
Real m_convergenceTol
 
int m_maxIters
 
long long m_nSolves [MaxNumPhases]
 
long long m_nIters [MaxNumPhases]
 
long long m_nFail [MaxNumPhases]
 
long long m_nBilateralSolves
 
long long m_nBilateralIters
 
long long m_nBilateralFail
 

Detailed Description

Projected Gauss Seidel impulse solver.

Finds a solution to

    [A+D] (piExpand+piUnknown) = v
    subject to
    piExpand <= 0 (given)
    piUnknown_z <= 0         unilateral contact must push, not pull
    ||(piUnknown_x,piUnknown+y)|| <= -mu*pi_z   unilateral friction cone
    where pi=piExpand+piUnknown.
    piUnknown_speed <= 0           one-way ratchets
    lb <= piUnknown_bounded <= ub  torque-limited motor
    ||piUnknown_F|| <= mu*||piUnknown_N||  friction in bilateral constraint
    ||piUnknown_F|| <= mu*N                friction with known normal force N

When piUnknown_z[k] hits its upper limit of 0, we must have v_z[k] >= 0 (contact surfaces separating). We don't explicitly enforce that here; it depends on all diag(A)[z[k]] > 0. That means that if v_z[k]<0 we could improve the solution by making piUnknown_z[k] negative, so it wouldn't have hit the limit.

Constructor & Destructor Documentation

SimTK::PGSImpulseSolver::PGSImpulseSolver ( Real  roll2slipTransitionSpeed)
inlineexplicit

Member Function Documentation

bool SimTK::PGSImpulseSolver::solve ( int  phase,
const Array_< MultiplierIndex > &  participating,
const Matrix A,
const Vector D,
const Array_< MultiplierIndex > &  expanding,
Vector piExpand,
Vector verrStart,
Vector verrApplied,
Vector pi,
Array_< UncondRT > &  unconditional,
Array_< UniContactRT > &  uniContact,
Array_< UniSpeedRT > &  uniSpeed,
Array_< BoundedRT > &  bounded,
Array_< ConstraintLtdFrictionRT > &  consLtdFriction,
Array_< StateLtdFrictionRT > &  stateLtdFriction 
) const
overridevirtual

Solve with conditional constraints.

In the common underdetermined case (redundant contact) we will return the first solution encountered but it is unlikely to be the best possible solution.

Implements SimTK::ImpulseSolver.

bool SimTK::PGSImpulseSolver::solveBilateral ( const Array_< MultiplierIndex > &  participating,
const Matrix A,
const Vector D,
const Vector rhs,
Vector pi 
) const
overridevirtual

Solve with only unconditional constraints.

In the underdetermined case we return one of the possible solutions but it will not in general be the least squares one. In the overdetermined, inconsistent case we will iterate for a long time and may converge on the least-error solution but cannot guarantee that.

Implements SimTK::ImpulseSolver.


The documentation for this class was generated from the following file: