OdeLogicalJoint.h

Go to the documentation of this file.

// -*- mode:C++; tab-width:4; c-basic-offset:4; indent-tabs-mode:nil -*-
 
/* 
* Copyright (C) 2010 RobotCub Consortium, European Commission FP6 Project IST-004370
* Author: Vadim Tikhanoff, Paul Fitzpatrick
* email:   vadim.tikhanoff@iit.it, paulfitz@alum.mit.edu
* website: www.robotcub.org
* Permission is granted to copy, distribute, and/or modify this program
* under the terms of the GNU General Public License, version 2 or any
* later version published by the Free Software Foundation.
*
* A copy of the license can be found at
* http://www.robotcub.org/icub/license/gpl.txt
*
* This program 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
*/
 
#ifndef ICUBSIMULATION_ODELOGICALJOINT_INC
#define ICUBSIMULATION_ODELOGICALJOINT_INC
 
#include <ode/ode.h>
 
#include <string>
 
#include "pidfilter.h"
 
#include "LogicalJoint.h"
 
#include "RobotConfig.h"
 
class OdeLogicalJoint : public LogicalJoint {
public:
    OdeLogicalJoint();
 
    virtual ~OdeLogicalJoint();
 
    OdeLogicalJoint *nest(int len);
 
    OdeLogicalJoint *at(int index);
 
    void init(const char *unit, const char *type, int index, int sign, RobotConfig &conf);
 
    void init(OdeLogicalJoint& left, OdeLogicalJoint& right, OdeLogicalJoint& peer, int sgn);
 
    double getAngle() {
        return getAngleRaw()*sign;
    }
 
    double getVelocity() {
        return getVelocityRaw()*sign;
    }
 
    double getAngleRaw();
 
    double getVelocityRaw();
 
    double getSpeedSetpoint() {
        return speedSetpoint;
    }
 
    //test for torque
    double getTorque();
 
    void setTorque(double target);
 
    void setControlParameters(double vel, double acc);
 
    void setPosition(double target);
 
    void setVelocity(double target);
 
    void setVelocityRaw(double target);
 
    virtual bool isValid() {
        return (number != -1) || (verge != 0);
    }
 
    void controlModeChanged(int cm);
 
private:
    int number;
    std::string unit;
    dJointID *joint;
    dJointFeedback *feedback;
    dVector3 axis;
    dReal *speed;
    dReal *torque;
    double speedSetpoint;
    bool hinged;
    int universal;
    int sign;
    OdeLogicalJoint *sub;
    int subLength;
    bool active;
    double vel;
    double acc;
    PidFilter filter;
 
    double dryFriction;
    double maxTorque;
 
    OdeLogicalJoint *left, *right, *peer;
    int verge;
};
 
 
#endif