resolve segfault in testMex

ckguo · Feb 15, 2015 · c73381d · c73381d
1 parent e48db1e
commit c73381d
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/systems/plants/RigidBodyManipulator.cpp b/systems/plants/RigidBodyManipulator.cpp
@@ -1912,7 +1912,7 @@ void RigidBodyManipulator::forwardJacDot(const int body_or_frame_id, const Matri
 
 	MatrixXd tmp = bodies[body_ind]->dTdqdot*Tframe*pts;
 	MatrixXd Jdott = Map<MatrixXd>(tmp.data(),num_dof,3*n_pts);
-	Jdot = Jdott.transpose();
+	Jdot.block(0,0,3*n_pts,num_dof) = Jdott.transpose();
 
 	if (rotation_type==1) {