T12SuperBallPayload.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 SUPERBALL_MODEL_H
#define SUPERBALL_MODEL_H

// This library
#include "core/tgModel.h"
#include "core/tgSubject.h"
#include "core/tgRod.h"
// The C++ Standard Library
#include <vector>

// Forward declarations
class tgBasicActuator;
class tgModelVisitor;
class tgStructure;
class tgWorld;

class T12SuperBallPayload : public tgSubject<T12SuperBallPayload>, public tgModel
{
public: 
                
    T12SuperBallPayload();
                
    virtual ~T12SuperBallPayload();
    
    virtual void setup(tgWorld& world);
    
    void teardown();
    
    virtual void step(double dt);
                
    virtual void onVisit(tgModelVisitor& r);
    
    const std::vector<tgBasicActuator*>& getAllMuscles() const;
    
private:
                
     void addNodes(tgStructure& s);
                
    static void addRods(tgStructure& s);
                
    void addMuscles(tgStructure& s);

    /*
     * Adds the 12 markers to the end of the rods so that we can visualize
     * them and track their position
     */
    void addMarkers(tgStructure& s);

    /*
                 * Moves all the rods (that are actually all the rigid bodies) according to the arguments.
                 * First rotates the structure around 3 axises given 3 angles.
                 * Moves the structure to the target point.
                 * Sets all the bars speed to the given speed vector.
                 * (muscles and markers are moved automatically since they are attached).
                 */
     void moveModel(btVector3 targetPositionVector,btVector3 rotationVector,btVector3 speedVector);

private:
                
    std::vector<tgBasicActuator*> allMuscles;
                std::vector<std::vector <tgBasicActuator *> > musclesPerNodes;
                std::vector<std::vector<std::vector<int> > > nodeNumberingSchema;

                std::vector<btVector3> nodePositions;
};

#endif  // SUPERBALL_MODEL_H