Пример #1
0
  void stampedTFDifferenceStampedTF(tf::StampedTransform &tf1,
                                    tf::StampedTransform &tf2,
                                    tf::StampedTransform &tfResult)
  {
    tfResult.setData(tf1.inverseTimes(tf2));

  }