joint.h

Go to the documentation of this file.

/* This file is part of StepCore library.
   Copyright (C) 2007 Vladimir Kuznetsov <ks.vladimir@gmail.com>

   StepCore library is free software; you can redistribute it and/or modify
   it under the terms of the GNU General Public License as published by
   the Free Software Foundation; either version 2 of the License, or
   (at your option) any later version.

   StepCore library is distributed in the hope that it will be useful,
   but WITHOUT ANY WARRANTY; without even the implied warranty of
   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   GNU General Public License for more details.

   You should have received a copy of the GNU General Public License
   along with StepCore; if not, write to the Free Software
   Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
*/

#ifndef STEPCORE_JOINT_H
#define STEPCORE_JOINT_H

#include "world.h"

namespace StepCore
{

class Particle;
class RigidBody;

class Anchor: public Item, public Joint
{
    STEPCORE_OBJECT(Anchor)
        
public:
    explicit Anchor(Object* body = 0, const Vector2d& position = Vector2d::Zero(), double angle = 0);

    Object* body() const { return _body; }
    void setBody(Object* body);

    const Vector2d& position() const { return _position; }
    void setPosition(const Vector2d& position) { _position = position; }

    double angle() const { return _angle; }
    void setAngle(double angle) { _angle = angle; }

    int constraintsCount();
    void getConstraintsInfo(ConstraintsInfo* info, int offset);

    //void getConstraints(double* value, double* derivative);
    //void getJacobian(GmmSparseRowMatrix* value, GmmSparseRowMatrix* derivative, int offset);

protected:
    Object*  _body;
    Vector2d _position;
    double   _angle;

    Particle*  _p;
    RigidBody* _r;
};

class Pin: public Item, public Joint
{
    STEPCORE_OBJECT(Pin)

public:
    explicit Pin(Object* body = 0, const Vector2d& localPosition = Vector2d::Zero(),
                        const Vector2d& position = Vector2d::Zero());

    Object* body() const { return _body; }
    void setBody(Object* body);

    const Vector2d& localPosition() const { return _localPosition; }
    void setLocalPosition(const Vector2d& localPosition) { _localPosition = localPosition; }

    const Vector2d& position() const { return _position; }
    void setPosition(const Vector2d& position) { _position = position; }

    int constraintsCount();
    void getConstraintsInfo(ConstraintsInfo* info, int offset);

    //void getConstraints(double* value, double* derivative);
    //void getJacobian(GmmSparseRowMatrix* value, GmmSparseRowMatrix* derivative, int offset);

protected:
    Object*  _body;
    Vector2d _localPosition;
    Vector2d _position;

    Particle*  _p;
    RigidBody* _r;
};

class Stick: public Item, public Joint
{
    STEPCORE_OBJECT(Stick)

public:
    explicit Stick(double restLength = 1, 
               Object* body1 = 0, Object* body2 = 0,
               const Vector2d& localPosition1 = Vector2d::Zero(),
               const Vector2d& localPosition2 = Vector2d::Zero());

    double restLength() const { return _restLength; }
    void   setRestLength(double restLength) { _restLength = restLength; }

    Object* body1() const { return _body1; }
    void setBody1(Object* body1);

    Object* body2() const { return _body2; }
    void setBody2(Object* body2);

    Vector2d localPosition1() const { return _localPosition1; }
    void setLocalPosition1(const Vector2d& localPosition1) { _localPosition1 = localPosition1; }

    Vector2d localPosition2() const { return _localPosition2; }
    void setLocalPosition2(const Vector2d& localPosition2) { _localPosition2 = localPosition2; }

    Vector2d position1() const;
    Vector2d position2() const;

    Vector2d velocity1() const;
    Vector2d velocity2() const;

    Particle* particle1() const { return _p1; }
    Particle* particle2() const { return _p2; }
    RigidBody* rigidBody1() const { return _r1; }
    RigidBody* rigidBody2() const { return _r2; }

    int constraintsCount();
    void getConstraintsInfo(ConstraintsInfo* info, int offset);

protected:
    double   _restLength;
    Object*  _body1;
    Object*  _body2;
    Vector2d _localPosition1;
    Vector2d _localPosition2;

    Particle*  _p1;
    Particle*  _p2;
    RigidBody* _r1;
    RigidBody* _r2;
};

class Rope: public Stick
{
    STEPCORE_OBJECT(Rope)

public:
    void getConstraintsInfo(ConstraintsInfo* info, int offset);
};

} // namespace StepCore

#endif