LGD/hand_control
1
0
Fork 0
Code Issues Pull requests Releases Wiki Activity

suggestion des simplification

Browse source
This commit is contained in:
Louis-Guillaume DUBOIS 2015-06-07 13:26:55 +02:00
parent b535242410
commit fcaa41dca5
1 changed files with 3 additions and 0 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

3
src/estimator.cpp
View file

@ -34,6 +34,9 @@ class Callback {
indices.push_back(i); indices.push_back(i);
// v = eg_1 ^ eg_2 is the plan normal // v = eg_1 ^ eg_2 is the plan normal
//TODO !!! eg_3 is also the plan normal :-)
// the code hereunder should work :
// Eigen::Vector3f v = eg.col(2);
Eigen::Vector3f v = eg.col(0).cross(eg.col(1)); Eigen::Vector3f v = eg.col(0).cross(eg.col(1));
// norm(v) == 1 // norm(v) == 1
v.normalize(); v.normalize();