This commit is contained in:
erwincoumans
2019-01-23 17:35:55 -08:00
2 changed files with 10 additions and 4 deletions

View File

@@ -92,8 +92,8 @@ struct TinyRendererVisualShapeConverterInternalData
SimpleCamera m_camera;
TinyRendererVisualShapeConverterInternalData()
: m_upAxis(2),
m_uidGenerator(1),
: m_uidGenerator(1),
m_upAxis(2),
m_swWidth(START_WIDTH),
m_swHeight(START_HEIGHT),
m_rgbColorBuffer(START_WIDTH, START_HEIGHT, TGAImage::RGB),

View File

@@ -486,7 +486,10 @@ int MultiBodyTree::MultiBodyImpl::calculateKinematics(const vecx &q, const vecx
transformZ(q(body.m_q_index + 2));
body.m_body_T_parent = T * body.m_body_T_parent_ref;
body.m_parent_pos_parent_body.setValue(0,0,0);
body.m_parent_pos_parent_body(0)=0;
body.m_parent_pos_parent_body(1)=0;
body.m_parent_pos_parent_body(2)=0;
body.m_parent_pos_parent_body = body.m_body_T_parent * body.m_parent_pos_parent_body;
if (type >= POSITION_VELOCITY)
@@ -850,7 +853,10 @@ int MultiBodyTree::MultiBodyImpl::calculateMassMatrix(const vecx &q, const bool
transformZ(q(body.m_q_index + 2));
body.m_body_T_parent = T * body.m_body_T_parent_ref;
body.m_parent_pos_parent_body.setValue(0, 0, 0);
body.m_parent_pos_parent_body(0)=0;
body.m_parent_pos_parent_body(1)=0;
body.m_parent_pos_parent_body(2)=0;
body.m_parent_pos_parent_body = body.m_body_T_parent * body.m_parent_pos_parent_body;
}
}