ScrewJoint.hh

Go to the documentation of this file.

/*
 * Copyright 2012 Nate Koenig, John Hsu
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *     http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 *
*/
/* Desc: A screw or primastic/rotational joint
 * Author: Nate Koenig, John Hsu
 * Date: 21 May 2003
 */

#ifndef _SCREWJOINT_HH_
#define _SCREWJOINT_HH_

#include "gazebo/physics/Joint.hh"
#include "gazebo/common/Console.hh"

namespace gazebo
{
  namespace physics
  {

    template<class T>
    class ScrewJoint : public T
    {
      public: explicit ScrewJoint(BasePtr _parent) : T(_parent)
              {this->AddType(Base::SCREW_JOINT);}

      public: virtual ~ScrewJoint()
              { }

      public: virtual unsigned int GetAngleCount() const
              {return 2;}

      public: virtual void Load(sdf::ElementPtr _sdf)
                 {
                   T::Load(_sdf);

                   if (_sdf->HasElement("thread_pitch"))
                   {
                     this->threadPitch =
                       _sdf->GetElement("thread_pitch")->GetValueDouble();
                   }
                   else
                   {
                     gzerr << "should not see this\n";
                     this->threadPitch = 1.0;
                   }

                   if (_sdf->HasElement("axis"))
                   {
                     sdf::ElementPtr axisElem = _sdf->GetElement("axis");
                     this->SetAxis(0, axisElem->GetValueVector3("xyz"));
                     if (axisElem->HasElement("limit"))
                     {
                       sdf::ElementPtr limitElem =
                         _sdf->GetElement("axis")->GetElement("limit");

                       // Perform this three step ordering to ensure the
                       // parameters are set properly. This is taken from
                       // the ODE wiki.
                       this->SetHighStop(0, limitElem->GetValueDouble("upper"));
                       this->SetLowStop(0, limitElem->GetValueDouble("lower"));
                       this->SetHighStop(0, limitElem->GetValueDouble("upper"));
                     }
                   }
                 }

      public: virtual void SetAnchor(int _index,
                                     const math::Vector3 &_anchor);

      public: virtual math::Vector3 GetAnchor(int _index) const;

      public: virtual void SetThreadPitch(int _index, double _threadPitch) = 0;

      protected: math::Vector3 fakeAnchor;

      protected: double threadPitch;
    };

    template<class T>
    void ScrewJoint<T>::SetAnchor(int /*_index*/,
                                  const math::Vector3 &_anchor)
    {this->fakeAnchor = _anchor;}

    template<class T>
    math::Vector3 ScrewJoint<T>::GetAnchor(int /*_index*/) const
    {return this->fakeAnchor;}
  }
}
#endif