Joint.cpp

Go to the documentation of this file.

#include "Joint.h"

#include <iostream>

#include "DebugMacro.h"
Joint::Joint(int jointID, double jointMin, double jointMax) : id(jointID), qMin(jointMin), qMax(jointMax) {
    q = 0;
}

Joint::Joint(int jointID, double jointMin, double jointMax, double q0) : id(jointID), qMin(jointMin), qMax(jointMax) {
    q = q0;
}
Joint::~Joint() {
    DEBUG_OUT(" Joint object deleted")
}
int Joint::getId() {
    return id;
}

double Joint::getQ() {
    return q;
}

void Joint::getStatus() {
    std::cout << "Joint ID " << id << " @ pos " << getQ() << " deg" << std::endl;
}