hpp-constraints  4.13.0
Definition of basic geometric constraints for motion planning
locked-joint.hh
Go to the documentation of this file.
1 // Copyright (c) 2015 - 2018, LAAS-CNRS
2 // Authors: Florent Lamiraux, Joseph Mirabel
3 //
4 
5 // Redistribution and use in source and binary forms, with or without
6 // modification, are permitted provided that the following conditions are
7 // met:
8 //
9 // 1. Redistributions of source code must retain the above copyright
10 // notice, this list of conditions and the following disclaimer.
11 //
12 // 2. Redistributions in binary form must reproduce the above copyright
13 // notice, this list of conditions and the following disclaimer in the
14 // documentation and/or other materials provided with the distribution.
15 //
16 // THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
17 // "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
18 // LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
19 // A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
20 // HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
21 // SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
22 // LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 // DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 // THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 // (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
26 // OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH
27 // DAMAGE.
28 
29 #ifndef HPP_CONSTRAINTS_LOCKED_JOINT_HH
30 #define HPP_CONSTRAINTS_LOCKED_JOINT_HH
31 
33 #include <hpp/pinocchio/joint.hh>
34 
35 namespace hpp {
36 namespace constraints {
37 
40 
67  public:
69  virtual ImplicitPtr_t copy() const;
70 
74  static LockedJointPtr_t create(const JointPtr_t& joint,
75  const LiegroupElement& value);
76 
83  static LockedJointPtr_t create(const JointPtr_t& joint, const size_type index,
84  vectorIn_t value);
85 
91  static LockedJointPtr_t create(const DevicePtr_t& dev, const size_type index,
92  vectorIn_t value);
93 
96  static LockedJointPtr_t createCopy(LockedJointConstPtr_t other);
97 
99  size_type rankInConfiguration() const;
100 
102  size_type rankInVelocity() const;
103 
105  size_type configSize() const;
106 
108  size_type numberDof() const;
109 
111  const LiegroupSpacePtr_t& configSpace() const;
112 
114  vectorIn_t value() const;
115 
117  void value(vectorIn_t value);
118 
123  void rightHandSideFromConfig(ConfigurationIn_t config)
125 
127  const JointPtr_t& joint() { return joint_; }
129  const std::string& jointName() const { return jointName_; }
131  std::ostream& print(std::ostream& os) const;
132 
133  protected:
137  LockedJoint(const JointPtr_t& joint, const LiegroupElement& value);
144  LockedJoint(const JointPtr_t& joint, const size_type index, vectorIn_t value);
150  LockedJoint(const DevicePtr_t& robot, const size_type index,
151  vectorIn_t value);
153  LockedJoint(const LockedJoint& other);
157  virtual bool isEqual(const Implicit& other, bool swapAndTest) const;
158 
159  void init(const LockedJointPtr_t& self);
160 
161  private:
162  std::string jointName_;
163  JointPtr_t joint_;
164  LiegroupSpacePtr_t configSpace_;
166  LockedJointWkPtr_t weak_;
167 
168  LockedJoint() {}
169  HPP_SERIALIZABLE();
170 }; // class LockedJoint
171 
173 inline std::ostream& operator<<(std::ostream& os, const LockedJoint& lj) {
174  return lj.print(os);
175 }
176 } // namespace constraints
177 } // namespace hpp
178 
179 BOOST_CLASS_EXPORT_KEY(hpp::constraints::LockedJoint)
180 #endif // HPP_CONSTRAINTS_LOCKED_JOINT_HH
pinocchio::vectorIn_t vectorIn_t
Definition: fwd.hh:59
Definition: active-set-differentiable-function.hh:36
pinocchio::LiegroupSpacePtr_t LiegroupSpacePtr_t
Definition: fwd.hh:68
Definition: locked-joint.hh:66
pinocchio::DevicePtr_t DevicePtr_t
Definition: fwd.hh:108
pinocchio::LiegroupElement LiegroupElement
Definition: fwd.hh:64
DifferentiableFunctionSet DifferentiableFunctionStack HPP_CONSTRAINTS_DEPRECATED
Definition: fwd.hh:114
Definition: explicit.hh:132
std::ostream & print(std::ostream &os) const
Print object in a stream.
pinocchio::ConfigurationIn_t ConfigurationIn_t
Definition: fwd.hh:105
pinocchio::JointPtr_t JointPtr_t
Definition: fwd.hh:49
const JointPtr_t & joint()
Return shared pointer to joint.
Definition: locked-joint.hh:127
ComparisonTypes_t operator<<(const ComparisonType &a, const ComparisonType &b)
Definition: comparison-types.hh:61
#define HPP_CONSTRAINTS_DLLAPI
Definition: config.hh:64
pinocchio::size_type size_type
Definition: fwd.hh:47
const std::string & jointName() const
Return the joint name.
Definition: locked-joint.hh:129
shared_ptr< const LockedJoint > LockedJointConstPtr_t
Definition: fwd.hh:206
shared_ptr< Implicit > ImplicitPtr_t
Definition: fwd.hh:173
Definition: implicit.hh:124
shared_ptr< LockedJoint > LockedJointPtr_t
Definition: fwd.hh:205