MocapElement::MocapElement(){
    ofPoint zeros = ofPoint(0.0,0.0,0.0);
    for (int i = 0; i < historyDepth_; i++) {
        setPosition(zeros);
        setPositionFiltered(zeros);
        setVelocity(zeros);
        setAcceleration(zeros);
        setAccelerationTrajectory(0.0);
		setDistanceToTorso(0.0);
        setRelativePositionToTorso(zeros);
    }
}
ofxMocapElement::ofxMocapElement(int elementId, int depth){
    elementId_ = elementId;
    historyDepth_ = depth;
    ofPoint zeros = ofPoint(0.0,0.0,0.0);
    for (int i = 0; i < historyDepth_; i++) {
        setPosition(zeros);
        setPositionFiltered(zeros);
        setVelocity(zeros);
        setAcceleration(zeros);
        setAccelerationTrajectory(0.0);
		setDistanceToTorso(0.0);
        setRelativePositionToTorso(zeros);
    }
}