Add null space task for IK.

This commit is contained in:
yunfeibai
2016-09-29 17:12:51 -07:00
parent 0ee12475af
commit 94c7bbe8e3
3 changed files with 39 additions and 15 deletions

View File

@@ -131,6 +131,8 @@ public:
bool DebugCheckSVD( const MatrixRmn& U, const VectorRn& w, const MatrixRmn& V ) const;
// Compute inverse of a matrix, the result is written in R
void ComputeInverse( MatrixRmn& R) const;
// Debug matrix inverse computation
bool DebugCheckInverse( const MatrixRmn& MInv ) const;
// Some useful routines for experts who understand the inner workings of these classes.
inline static double DotArray( long length, const double* ptrA, long strideA, const double* ptrB, long strideB );