base::Point3 Transform::translate(const Point3& p) const { if (isIdentity) return p; if (isPureTranslationRotation) { if (hasTranslation) return p+trans; } else { return Point3(p.x+t(1,4),p.y+t(2,4),p.z+t(3,4)); // check!!! } return p; }