All Classes Namespaces Files Functions Variables Typedefs Enumerations Enumerator Friends Macros Groups Pages
JointState.hh
Go to the documentation of this file.
1 /*
2  * Copyright 2012 Nate Koenig
3  *
4  * Licensed under the Apache License, Version 2.0 (the "License");
5  * you may not use this file except in compliance with the License.
6  * You may obtain a copy of the License at
7  *
8  * http://www.apache.org/licenses/LICENSE-2.0
9  *
10  * Unless required by applicable law or agreed to in writing, software
11  * distributed under the License is distributed on an "AS IS" BASIS,
12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13  * See the License for the specific language governing permissions and
14  * limitations under the License.
15  *
16 */
17 /* Desc: A joint state
18  * Author: Nate Koenig
19  */
20 
21 #ifndef _JOINTSTATE_HH_
22 #define _JOINTSTATE_HH_
23 
24 #include <vector>
25 #include <string>
26 
27 #include "gazebo/physics/State.hh"
28 #include "gazebo/math/Pose.hh"
29 
30 namespace gazebo
31 {
32  namespace physics
33  {
36 
39  class JointState : public State
40  {
42  public: JointState();
43 
46  public: explicit JointState(JointPtr _joint);
47 
52  public: explicit JointState(const sdf::ElementPtr _sdf);
53 
55  public: virtual ~JointState();
56 
59  public: virtual void Load(const sdf::ElementPtr _elem);
60 
63  public: unsigned int GetAngleCount() const;
64 
69  public: math::Angle GetAngle(unsigned int _axis) const;
70 
73  public: const std::vector<math::Angle> &GetAngles() const;
74 
77  public: bool IsZero() const;
78 
82  public: JointState &operator=(const JointState &_state);
83 
87  public: JointState operator-(const JointState &_state) const;
88 
92  public: JointState operator+(const JointState &_state) const;
93 
98  public: friend std::ostream &operator<<(std::ostream &_out,
99  const gazebo::physics::JointState &_state)
100  {
101  _out << "<joint name='" << _state.GetName() << "'>\n";
102 
103  int i = 0;
104  for (std::vector<math::Angle>::const_iterator iter =
105  _state.angles.begin(); iter != _state.angles.end(); ++iter)
106  {
107  _out << "<angle axis='" << i << "'>" << (*iter) << "</angle>\n";
108  }
109 
110  _out << "</joint>\n";
111 
112  return _out;
113  }
114 
115  private: std::vector<math::Angle> angles;
116  };
118  }
119 }
120 #endif