abstractRotation::abstractRotation(int x,int y):dimx(x),dimy(y){ resetRotation(); }
abstractRotation::abstractRotation():dimx(1),dimy(1){ resetRotation(); }
KinematicMotion::KinematicMotion() { translationVector = new double[3]; resetTranslation(); rotationMatrix = new double[9]; resetRotation(); }