diff --git a/include/sot-dynamic-pinocchio/dynamic-pinocchio.h b/include/sot-dynamic-pinocchio/dynamic-pinocchio.h index 7861a4a1b5e81d307d9df673c1cb64a4723eec68..48ef5dcfedde9784639290d8712cbb8612000dc0 100644 --- a/include/sot-dynamic-pinocchio/dynamic-pinocchio.h +++ b/include/sot-dynamic-pinocchio/dynamic-pinocchio.h @@ -254,6 +254,7 @@ class SOTDYNAMIC_EXPORT DynamicPinocchio void cmd_createJacobianEndEffectorSignal( const std::string& sig,const std::string& j ); void cmd_createPositionSignal ( const std::string& sig,const std::string& j ); void cmd_createVelocitySignal ( const std::string& sig,const std::string& j ); + void cmd_createAccelerationSignal ( const std::string& sig,const std::string& j ); private: /// \brief map of joints in construction. diff --git a/src/sot-dynamic-pinocchio.cpp b/src/sot-dynamic-pinocchio.cpp index ef5cd914954df185b286d9cebb27267920f8495a..b7e47cbe0f68cece4376952ed2cec06a9dfe3e08 100644 --- a/src/sot-dynamic-pinocchio.cpp +++ b/src/sot-dynamic-pinocchio.cpp @@ -215,6 +215,12 @@ DynamicPinocchio( const std::string & name) "string (signal name)","string (joint name)"); addCommand("createVelocity", makeCommandVoid2(*this,&DynamicPinocchio::cmd_createVelocitySignal,docstring)); + + docstring = docCommandVoid2("Create an acceleration (vector) signal only for one joint.", + "string (signal name)","string (joint name)"); + addCommand("createAcceleration", + makeCommandVoid2(*this,&DynamicPinocchio::cmd_createAccelerationSignal,docstring)); + } @@ -564,7 +570,7 @@ createAccelerationSignal( const std::string& signame, const std::string& jointNa = new dg::SignalTimeDependent< dg::Vector,int > ( boost::bind(&DynamicPinocchio::computeGenericAcceleration,this,jointId,_1,_2), forwardKinematicsSINTERN, - "sotDynamicPinocchio("+name+")::output(matrixHomo)::"+signame ); + "sotDynamicPinocchio("+name+")::output(dg::Vector)::"+signame ); genericSignalRefs.push_back( sig ); signalRegistration( *sig ); @@ -1182,3 +1188,8 @@ void DynamicPinocchio::cmd_createVelocitySignal( const std::string& signalName, { createVelocitySignal(signalName, jointName); } +void DynamicPinocchio::cmd_createAccelerationSignal( const std::string& signalName, + const std::string& jointName ) +{ + createAccelerationSignal(signalName, jointName); +}