tgBoxGround.cpp

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.
*/

//This Module
#include "tgBoxGround.h"

//Bullet Physics
#include "BulletCollision/CollisionShapes/btBoxShape.h"
#include "BulletDynamics/Dynamics/btRigidBody.h"
#include "LinearMath/btDefaultMotionState.h"
#include "LinearMath/btTransform.h"

// The C++ Standard Library
#include <cassert>
#include <iostream>

tgBoxGround::Config::Config( btVector3 eulerAngles,
                btScalar friction,
                btScalar restitution,
                btVector3 size,
                btVector3 origin ) :
m_eulerAngles(eulerAngles),
m_friction(friction),
m_restitution(restitution),
m_size(size),
m_origin(origin)                            
{
    assert((m_friction >= 0.0) && (m_friction <= 1.0));
    assert((m_restitution >= 0.0) && (m_restitution <= 1.0));
    assert((m_size[0] >= 0.0) && (m_size[1] >= 0.0) && (m_size[2] >= 0.0));
}

tgBoxGround::tgBoxGround() :
m_config(Config())
{
    // @todo make constructor aux to avoid repeated code
    const btVector3 groundDimensions(m_config.m_size);
    pGroundShape = new btBoxShape(groundDimensions);
       
}

tgBoxGround::tgBoxGround(const tgBoxGround::Config& config) :
m_config(config)
{
    const btVector3 groundDimensions(m_config.m_size);
    pGroundShape = new btBoxShape(groundDimensions);
       
}


btRigidBody* tgBoxGround::getGroundRigidBody() const
{
        std::cout << "Box Ground" << std::endl;
    const btScalar mass = 0.0;
    
    btTransform groundTransform;
    groundTransform.setIdentity();
    groundTransform.setOrigin(m_config.m_origin);
    
    btQuaternion orientation;
    orientation.setEuler(m_config.m_eulerAngles[0], // Yaw
                            m_config.m_eulerAngles[1], // Pitch
                            m_config.m_eulerAngles[2]); // Roll
    groundTransform.setRotation(orientation);
    
    // Using motionstate is recommended
    // It provides interpolation capabilities, and only synchronizes 'active' objects
    btDefaultMotionState* const pMotionState =
    new btDefaultMotionState(groundTransform);
    
    const btVector3 localInertia(0, 0, 0);

    btRigidBody::btRigidBodyConstructionInfo const rbInfo(mass, pMotionState, pGroundShape, localInertia);

    btRigidBody* const pGroundBody = new btRigidBody(rbInfo);
    
    return pGroundBody;
}