ActuatorDynamics.h

Go to the documentation of this file.

/**********************************************************************************************************************
This file is part of the Control Toolbox (https://github.com/ethz-adrl/control-toolbox), copyright by ETH Zurich.
Licensed under the BSD-2 license (see LICENSE file in main directory)
**********************************************************************************************************************/

#pragma once

#include <ct/rbd/state/JointState.h>

namespace ct {
namespace rbd {


template <size_t ACT_STATE_DIMS, size_t NJOINTS, typename SCALAR = double>
class ActuatorDynamics
{
public:
    EIGEN_MAKE_ALIGNED_OPERATOR_NEW

    static const size_t ACT_STATE_DIM = ACT_STATE_DIMS;
    static const size_t ACT_CONTROL_DIM = NJOINTS;

    typedef ct::core::StateVector<ACT_STATE_DIMS, SCALAR> act_state_vector_t;
    typedef ct::core::ControlVector<NJOINTS, SCALAR> act_control_vector_t;

    ActuatorDynamics(){};

    virtual ~ActuatorDynamics(){};

    virtual ActuatorDynamics<ACT_STATE_DIMS, NJOINTS, SCALAR>* clone() const = 0;

    virtual void computeActuatorDynamics(const JointState<NJOINTS, SCALAR>& robotJointState,
        const ct::core::StateVector<ACT_STATE_DIMS, SCALAR>& actuatorState,
        const SCALAR& t,
        const ct::core::ControlVector<NJOINTS, SCALAR>& control,
        ct::core::StateVector<ACT_STATE_DIMS, SCALAR>& derivative) = 0;

    virtual core::ControlVector<NJOINTS, SCALAR> computeControlOutput(
        const JointState<NJOINTS, SCALAR>& robotJointState,
        const act_state_vector_t& actState) = 0;

    virtual ct::core::StateVector<ACT_STATE_DIMS, SCALAR> computeStateFromOutput(
        const JointState<NJOINTS, SCALAR>& refRobotJointState,
        const core::ControlVector<NJOINTS, SCALAR>& refControl) = 0;
};


}  // namespace rbd
}  // namespace ct