Cr8-xyz/blender
1
0
Fork 0
Code Issues Pull Requests Actions 1 Packages Projects Releases Wiki Activity

Fix for commit 41227 (Some opening comment tags (/*) were lost!).

Browse Source
This commit is contained in:
Bastien Montagne
2011-10-23 19:39:20 +00:00
parent 82c84f4b58
commit 8a6a3dbb54
7 changed files with 22 additions and 22 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
intern/itasc/ConstraintSet.cpp
View File

@@ -80,7 +80,7 @@ void ConstraintSet::modelUpdate(Frame& _external_pose,const Timestamp& timestamp
double ConstraintSet::getMaxTimestep(double& timestep)
{
e_scalar maxChidot = m_chidot.array().abs().maxCoeff();
e_scalar maxChidot = m_chidot.cwise().abs().maxCoeff();
if (timestep*maxChidot > m_maxDeltaChi) {
timestep = m_maxDeltaChi/maxChidot;
}
@@ -162,9 +162,9 @@ bool ConstraintSet::closeLoop(){
}else
m_B.row(i) = m_U.col(i)/m_S(i);
m_Jf_inv.noalias()=m_V*m_B;
m_Jf_inv=(m_V*m_B).lazy();
m_chi.noalias()+=m_Jf_inv*m_tdelta;
m_chi+=(m_Jf_inv*m_tdelta).lazy();
updateJacobian();
// m_externalPose-m_internalPose in end effector frame
// this is just to compare the pose, a different formula would work too