tgSpringCableActuator.h

Go to the documentation of this file.

/*
 * Copyright © 2012, United States Government, as represented by the
 * Administrator of the National Aeronautics and Space Administration.
 * All rights reserved.
 * 
 * The NASA Tensegrity Robotics Toolkit (NTRT) v1 platform is 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.
*/

#ifndef SRC_CORE_TG_SPRING_CABLE_ACTUATOR_H
#define SRC_CORE_TG_SPRING_CABLE_ACTUATOR_H

// This application
#include "tgModel.h"
#include "tgControllable.h"
#include "tgSubject.h"

#include <deque> // For history
// Forward declarations
class tgWorld;
class tgSpringCable;

// Should always be a child Model of a tgModel
class tgSpringCableActuator : public tgModel, public tgControllable,
                                public tgSubject<tgSpringCableActuator>
{
public: 
    
    struct Config
    {
    public:
        Config( double s = 1000.0,
        double d = 10.0,
        double p = 0.0,
        bool h = false,
        double mf = 1000.0,
        double tVel = 100.0,
        double mnAL = 0.1,
        double mnRL = 0.1,
        double rot = 0);
      
      void scale (double sf);
      
      // Muscle2P Parameters
      double stiffness;
      double damping;
      
      double pretension;
      
      // History Parameters
      bool hist;
              
      // Motor model parameters
      double maxTens;
      
      double targetVelocity;
      
      double minActualLength;
      
      double minRestLength;
      
      // Construction Parameters
      double rotation;  
    };
    
    struct SpringCableActuatorHistory
    {
        std::deque<double> lastLengths;
        
        std::deque<double> restLengths;

        std::deque<double> dampingHistory;

        std::deque<double> lastVelocities;
        
        std::deque<double> tensionHistory;
    };

    virtual ~tgSpringCableActuator();
    
    virtual void setup(tgWorld& world);
    
    virtual void teardown();
    
    virtual void step(double dt);
    
    virtual const double getStartLength() const;
    
    virtual const double getCurrentLength() const;
    
    virtual const double getTension() const;
    
    virtual const double getRestLength() const;
    
    virtual const double getVelocity() const;
    
    virtual const tgSpringCableActuator::SpringCableActuatorHistory& getHistory() const;
    
    const tgSpringCable* getSpringCable() const
    {
      return m_springCable;
    }
    
    const Config& getConfig() const
    {
        return m_config;
    }
    
protected: 
    
    tgSpringCableActuator(tgSpringCable* springCable,
                                                const tgTags& tags,
           tgSpringCableActuator::Config& config);
           
protected:
    tgSpringCable* m_springCable;

    Config m_config;
    
    SpringCableActuatorHistory * const m_pHistory;

    
    double m_restLength;
    

    double m_startLength;
    
    double m_prevVelocity;
private:

    void constructorAux();

    bool invariant() const;


};


#endif // SRC_CORE_TG_SPRING_CABLE_ACTUATOR_H