29 VectorToRotation::VectorToRotation(
const std::string &
name)
33 SIN(NULL,
"sotVectorToRotation(" + name +
")::output(vector)::sin"),
36 "sotVectorToRotation(" + name +
")::output(matrixRotation)::sout") {
37 signalRegistration(SIN << SOUT);
47 for (
unsigned int i = 0;
i <
size; ++
i) {
49 const double ca = cos(angles(i));
50 const double sa = sin(angles(i));
51 const unsigned int i_X = 0, i_Y = 1, i_Z = 2;
76 sotDEBUG(15) <<
"R" << i <<
" = " << Ra;
Eigen::Matrix< double, 3, 3 > MatrixRotation
SOT_CORE_DISABLE_WARNING_PUSH SOT_CORE_DISABLE_WARNING_DEPRECATED DYNAMICGRAPH_FACTORY_ENTITY_PLUGIN(VectorToRotation, "VectorToRotation")
#define SOT_CORE_DISABLE_WARNING_PUSH
#define SOT_CORE_DISABLE_WARNING_DEPRECATED
#define SOT_MEMBER_SIGNAL_1(sotFunction, sotArg1, sotArg1Type)
#define SOT_CORE_DISABLE_WARNING_POP