measured-6d-wrench.hpp

Go to the documentation of this file.

//
// Copyright (c) 2025 CNRS INRIA LORIA
//
// This file is part of tsid
// tsid is free software: you can redistribute it
// and/or modify it under the terms of the GNU Lesser General Public
// License as published by the Free Software Foundation, either version
// 3 of the License, or (at your option) any later version.
// tsid is distributed in the hope that it will be
// useful, but WITHOUT ANY WARRANTY; without even the implied warranty
// of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
// General Lesser Public License for more details. You should have
// received a copy of the GNU Lesser General Public License along with
// tsid If not, see
// <http://www.gnu.org/licenses/>.
//
 
#ifndef __invdyn_measured_6d_wrench_hpp__
#define __invdyn_measured_6d_wrench_hpp__
 
#include <pinocchio/multibody/data.hpp>
 
#include "tsid/contacts/measured-force-base.hpp"
 
namespace tsid {
namespace contacts {
class Measured6Dwrench : public MeasuredForceBase {
 public:
  EIGEN_MAKE_ALIGNED_OPERATOR_NEW
 
  typedef math::Index Index;
  typedef math::Vector6 Vector6;
  typedef robots::RobotWrapper RobotWrapper;
  typedef pinocchio::Data Data;
  typedef pinocchio::Data::Matrix6x Matrix6x;
 
  Measured6Dwrench(const std::string &name, RobotWrapper &robot,
                   const std::string &frameName);
 
  const Vector &computeJointTorques(Data &data) override;
 
  void setMeasuredContactForce(const Vector6 &fext);
 
  const Vector6 &getMeasuredContactForce() const;
 
  void useLocalFrame(bool local_frame);
 
 protected:
  std::string m_frame_name;
  Index m_frame_id;
  Vector6 m_fext;
  Matrix6x m_J;
  Matrix6x m_J_rotated;
  Vector m_computedTorques;
  bool m_local_frame;
};
}  // namespace contacts
}  // namespace tsid
 
#endif  // ifndef __invdyn_measured_6d_wrench_hpp__