public void Diff(CoordinateFrame diff)
{
if (diff != null && diff.GetCollection.Count > 0)
for (int i = 0; i < diff.GetCollection.Count; i++)
{
float x = _AngleContainer[i].X - diff.GetCollection[i].X;
float y = _AngleContainer[i].Y - diff.GetCollection[i].Y;
float z = _AngleContainer[i].Z - diff.GetCollection[i].Z;
_AngleContainer[i] = new EilerAngle(x, y, z);
}
}
public void AddAnglePoint(EilerAngle point)
{
_AngleContainer.Add(point);
}