group_command.hpp

Go to the documentation of this file.

#pragma once

#include "hebi_group_command.h"
#include "Eigen/Eigen"
#include "command.hpp"
#include <vector>

namespace hebi {

class GroupCommand final
{
  public:
    #ifndef DOXYGEN_OMIT_INTERNAL

    HebiGroupCommandPtr internal_;
    #endif // DOXYGEN_OMIT_INTERNAL

  private:
    const bool manage_pointer_lifetime_;
    const int number_of_modules_;
    std::vector<Command> commands_;

  public:
    GroupCommand(int number_of_modules);

    virtual ~GroupCommand() noexcept; /* annotating specified destructor as noexcept is best-practice */

    int size() const;

    Command& operator[](int index);

    void setPosition(const Eigen::VectorXd& position);
    void setVelocity(const Eigen::VectorXd& velocity);
    void setEffort(const Eigen::VectorXd& effort);
    void setSpringConstant(const Eigen::VectorXd& springConstant);

    Eigen::VectorXd getPosition() const;
    Eigen::VectorXd getVelocity() const;
    Eigen::VectorXd getEffort() const;
    Eigen::VectorXd getSpringConstant() const;

    void getPosition(Eigen::VectorXd& out) const;
    void getVelocity(Eigen::VectorXd& out) const;
    void getEffort(Eigen::VectorXd& out) const;
    void getSpringConstant(Eigen::VectorXd& out) const;

};

} // namespace hebi