dqrobotics / cpp

The DQ Robotics library in C++
https://dqrobotics.github.io
GNU Lesser General Public License v3.0
39 stars 13 forks source link

[BUG] The constructor of DQ does not work for pure dual quaternions #24

Closed maripaf closed 5 years ago

maripaf commented 5 years ago

Bug description

To Reproduce

Code

#include <iostream>
#include <Eigen/Dense>
#include <dqrobotics/DQ.h>
#include <iostream>

using namespace DQ_robotics;

int main()
{
    Eigen::VectorXd force(6);
    force << 1, 2, 3, 4, 5, 6;
    std::cout << DQ(force) << std::endl;
   return 0;
}

Output

1 2i 3j 4k +E( 5 6i 0j 0k )

Expected behavior

Expected output

0 1i 2j 3k +E( 0 4i 5j 6k )

Environment:

Additional context

mmmarinho commented 5 years ago

Fixed and tested in: https://github.com/dqrobotics/cpp-examples/blob/7c750a87bb7e7ed389593b1aa0f85ca6b87db244/cmake/simple_tests/simple_tests.cpp#L29