Upgraded KDL to latest version

This commit is contained in:
Yorik van Havre
2015-10-12 19:35:53 -03:00
parent 85994d17b8
commit 9f4e7c4085
104 changed files with 3812 additions and 922 deletions

View File

@@ -23,7 +23,7 @@
namespace KDL
{
USING_PART_OF_NAMESPACE_EIGEN
using namespace Eigen;
JntArray::JntArray()
{
@@ -101,7 +101,7 @@ namespace KDL
void MultiplyJacobian(const Jacobian& jac, const JntArray& src, Twist& dest)
{
Eigen::Matrix<double,6,1> t=(jac.data*src.data).lazy();
Eigen::Matrix<double,6,1> t=jac.data.lazyProduct(src.data);
dest=Twist(Vector(t(0),t(1),t(2)),Vector(t(3),t(4),t(5)));
}