bartvdbraak/blender
1
0
Fork 4
Code Issues 4 Pull Requests 1 Actions 1 Packages Projects Releases Wiki Activity

Fix Eigen3 unaligned array in iTaSC. The unaligned array cause crash when SSE2 is enabled. The source of unaligned array were: matrix passing by value in std::make_pair() and offset of matrix member in structure.

Browse Source
This commit is contained in:
Benoit Bolsee 2012-06-03 12:00:41 +00:00
parent 1aa27e240c
commit 9ec2139c81
3 changed files with 15 additions and 9 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
intern/itasc/kdl/segment.hpp
View File

@ -46,8 +46,8 @@ namespace KDL {
class Segment {
friend class Chain;
private:
Joint joint;
Inertia M;
Joint joint;
Frame f_tip;
public:

20
intern/itasc/kdl/tree.cpp
View File

@ -29,15 +29,18 @@ using namespace std;
Tree::Tree() :
nrOfJoints(0), nrOfSegments(0) {
segments.insert(make_pair("root", TreeElement::Root()));
TreeElement root;
std::pair<std::string, TreeElement> val("root", root);
segments.insert(val);
}
Tree::Tree(const Tree& in) {
segments.clear();
nrOfSegments = 0;
nrOfJoints = 0;
segments.insert(make_pair("root", TreeElement::Root()));
TreeElement root;
std::pair<std::string, TreeElement> val("root", root);
segments.insert(val);
this->addTree(in, "", "root");
}
@ -46,8 +49,9 @@ Tree& Tree::operator=(const Tree& in) {
segments.clear();
nrOfSegments = 0;
nrOfJoints = 0;
segments.insert(make_pair("root", TreeElement::Root()));
TreeElement root;
std::pair<std::string, TreeElement> val("root", root);
segments.insert(val);
this->addTree(in, "", "root");
return *this;
}
@ -60,8 +64,10 @@ bool Tree::addSegment(const Segment& segment, const std::string& segment_name,
return false;
pair<SegmentMap::iterator, bool> retval;
//insert new element
retval = segments.insert(make_pair(segment_name, TreeElement(segment,
parent, nrOfJoints)));
TreeElement elem(segment, parent, nrOfJoints);
std::pair<std::string, TreeElement> val(segment_name, elem);
retval = segments.insert(val);
//check if insertion succeeded
if (!retval.second)
return false;

2
intern/itasc/kdl/tree.hpp
View File

@ -43,7 +43,7 @@ namespace KDL
#endif
class TreeElement
{
private:
public:
TreeElement():q_nr(0)
{};
public: