コード例 #1
0
ファイル: IKoptions.cpp プロジェクト: AkshayBabbar/drake
void IKoptions::setAdditionaltSamples(const RowVectorXd &t_samples)
{
  if(t_samples.size()>0)
  {
    set<double> unique_sort_t(t_samples.data(),t_samples.data()+t_samples.size());
    this->additional_tSamples.resize(unique_sort_t.size());
    int t_idx = 0;
    for(auto it = unique_sort_t.begin();it != unique_sort_t.end();it++)
    {
      this->additional_tSamples(t_idx) = *it;
      t_idx++;
    }
  }
  else
  {
    this->additional_tSamples.resize(0);
  }
}