link_data_map.h

Go to the documentation of this file.

#ifndef IIT_CT_INVERTEDPENDULUM_LINK_DATA_MAP_H_
#define IIT_CT_INVERTEDPENDULUM_LINK_DATA_MAP_H_

#include "declarations.h"

namespace iit {
namespace ct_InvertedPendulum {

template<typename T> class LinkDataMap {
private:
    T data[linksCount];
public:
    EIGEN_MAKE_ALIGNED_OPERATOR_NEW

    LinkDataMap() {};
    LinkDataMap(const T& defaultValue);
    LinkDataMap(const LinkDataMap& rhs);
    LinkDataMap& operator=(const LinkDataMap& rhs);
    LinkDataMap& operator=(const T& rhs);
          T& operator[](LinkIdentifiers which);
    const T& operator[](LinkIdentifiers which) const;
private:
    void copydata(const LinkDataMap& rhs);
    void assigndata(const T& commonValue);
};

template<typename T> inline
LinkDataMap<T>::LinkDataMap(const T& value) {
    assigndata(value);
}

template<typename T> inline
LinkDataMap<T>::LinkDataMap(const LinkDataMap& rhs)
{
    copydata(rhs);
}

template<typename T> inline
LinkDataMap<T>& LinkDataMap<T>::operator=(const LinkDataMap& rhs)
{
    if(&rhs != this) {
        copydata(rhs);
    }
    return *this;
}

template<typename T> inline
LinkDataMap<T>& LinkDataMap<T>::operator=(const T& value)
{
    assigndata(value);
    return *this;
}

template<typename T> inline
T& LinkDataMap<T>::operator[](LinkIdentifiers l) {
    return data[l];
}

template<typename T> inline
const T& LinkDataMap<T>::operator[](LinkIdentifiers l) const {
    return data[l];
}

template<typename T> inline
void LinkDataMap<T>::copydata(const LinkDataMap& rhs) {
    data[INVERTEDPENDULUMBASE] = rhs[INVERTEDPENDULUMBASE];
    data[LINK1] = rhs[LINK1];
}

template<typename T> inline
void LinkDataMap<T>::assigndata(const T& value) {
    data[INVERTEDPENDULUMBASE] = value;
    data[LINK1] = value;
}

template<typename T> inline
std::ostream& operator<<(std::ostream& out, const LinkDataMap<T>& map) {
    out
    << "   InvertedPendulumBase = "
    << map[INVERTEDPENDULUMBASE]
    << "   Link1 = "
    << map[LINK1]
    ;
    return out;
}

}
}
#endif