data_utils.h

Go to the documentation of this file.

#ifndef JPS_DATA_UTIL_H
#define JPS_DATA_UTIL_H

#include <jps_basis/data_type.h>

template <class T, class TF>
vec_E<T> transform_vec(const vec_E<T> &t, const TF &tf) {
  vec_E<T> new_t;
  for (const auto &it : t)
    new_t.push_back(tf * it);
  return new_t;
}

template <class T>
decimal_t total_distance(const vec_E<T>& vs){
  decimal_t dist = 0;
  for(unsigned int i = 1; i < vs.size(); i++)
    dist += (vs[i] - vs[i-1]).norm();

  return dist;
}

#define transform_vec3 transform_vec<Vec3f, Aff3f>
#define total_distance2f total_distance<Vec2f>
#define total_distance3f total_distance<Vec3f>
#define total_distance2i total_distance<Vec2i>
#define total_distance3i total_distance<Vec3i>
#endif