#include "DistIecJec.h"

MbD::DistIecJec::DistIecJec()
{
}

MbD::DistIecJec::DistIecJec(EndFrmcptr frmi, EndFrmcptr frmj) : KinematicIeJe(frmi, frmj)
{
}

void MbD::DistIecJec::calcPostDynCorrectorIteration()
{
	rIeJeO = frmJ->rOeO->minusFullColumn(frmI->rOeO);
	rIeJe = rIeJeO->length();
	this->calcPrivate();
}

void MbD::DistIecJec::calcPrivate()
{
	if (rIeJe == 0.0) return;
	uIeJeO = rIeJeO->times(1.0 / rIeJe);
	muIeJeO = uIeJeO->negated();
}

double MbD::DistIecJec::value()
{
	return rIeJe;
}