本文整理汇总了C++中StateVector::rows方法的典型用法代码示例。如果您正苦于以下问题：C++ StateVector::rows方法的具体用法？C++ StateVector::rows怎么用？C++ StateVector::rows使用的例子？那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类StateVector的用法示例。
在下文中一共展示了StateVector::rows方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: toStateVector
bool LQRController::toStateVector(const std::vector<std::string> & names, const std::vector<double> & positions, const std::vector<double> & velocities, StateVector & v) const
{
const int N = names.size();
assert(model_);
const int n = model_->states();
if(v.rows() != n)
{
ROS_ERROR("Supplied state vector has wrong size");
return false;
}
if((int)positions.size()!=N or (int)velocities.size()!=N)
{
ROS_ERROR("Incoherent data supplied");
return false;
}
int count=1;
for(int i=0;i<N;i++)
{
const int index=jointIndex(names.at(i));
if(index>=0)
{
v(index,0)=positions.at(index);
v(index+n/2,0)=velocities.at(index);
count++;
}
}
if(count!=n)
ROS_INFO("The state was only partly specified");
return true;
}