Lines Matching defs:orientation
54 const std::vector<Vec4d> &orientation,
58 if (orientation.empty () || orient_ts.empty ()) {
64 return Quaternd(orientation[0]);
73 if (i < 0) return Quaternd (orientation[0]);
78 if (i >= count) return Quaternd (orientation[count - 1]);
87 return Quaternd (orientation[i] * weight_start + orientation[i + 1] * weight_end);
249 const std::vector<Vec4d> &orientation,
252 if (pose_ts.empty () || orientation.empty () || translation.empty ()) {
258 Quaternd quat = interp_orientation (ts, orientation, pose_ts, index) +
283 std::vector<Vec4d> orientation;
291 orientation.push_back (Vec4d (pose->orientation[0],
292 pose->orientation[1],
293 pose->orientation[2],
294 pose->orientation[3]));
305 Quaternd quat = interp_orientation (ts, orientation, orient_ts, index) +
