本文整理汇总了C++中IDList::toString方法的典型用法代码示例。如果您正苦于以下问题:C++ IDList::toString方法的具体用法?C++ IDList::toString怎么用?C++ IDList::toString使用的例子?那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类IDList
的用法示例。
在下文中一共展示了IDList::toString方法的1个代码示例,这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞,您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: estimateExternalWrenchAndInternalJoints
void ExternalWrenchesAndTorquesEstimator::estimateExternalWrenchAndInternalJoints(RobotJointStatus & joint_status, RobotSensorStatus & sensor_status)
{
//Temporary workaround: wholeBodyDynamicsStatesInterface needs all the DOF present in the dynamical model
if( sensors->getSensorNumber(wbi::SENSOR_ENCODER) != robot_estimation_model->getNrOfDOFs() )
{
IDList list = sensors->getSensorList(wbi::SENSOR_ENCODER);
std::cerr << "Available encoders: " << list.toString() << std::endl;
std::cerr << "yarpWholeBodyDynamicsEstimator::run() error: " <<
sensors->getSensorNumber(wbi::SENSOR_ENCODER) << " joint sensors are available, while " <<
robot_estimation_model->getNrOfDOFs() << " joints are present in the model " << std::endl;
assert(false);
return;
}
///< \todo improve robustness: what if a sensor dies or stop working? interface should warn the user
{
resizeAll(sensors->getSensorNumber(SENSOR_ENCODER));
resizeFTs(sensors->getSensorNumber(SENSOR_FORCE_TORQUE));
resizeIMUs(sensors->getSensorNumber(SENSOR_IMU));
///< Read encoders
omega_used_IMU = sensor_status.omega_imu;
domega_used_IMU = sensor_status.domega_imu;
ddp_used_IMU = sensor_status.proper_ddp_imu;
///< Read skin contacts
readSkinContacts();
///< Estimate joint torque sensors from force/torque measurements
estimateExternalForcesAndJointTorques(joint_status,sensor_status);
///< Filter obtained joint torque measures
// \todo reintroduce the filter ?
joint_status.setJointTorquesYARP(tauJ);// tauJFilt->filt(tauJ); ///< low pass filter
}
return;
}